mirror of
https://mirrors.bfsu.edu.cn/git/linux.git
synced 2024-11-26 05:34:13 +08:00
fotg210-udc: Improve device initialization
Reset the device explicitly to get into a known state and also set the chip enable bit. Additionally, mask interrupts which aren't handled. Signed-off-by: Fabian Vogt <fabian@ritter-vogt.de> Signed-off-by: Linus Walleij <linus.walleij@linaro.org> Link: https://lore.kernel.org/r/20230123073508.2350402-4-linus.walleij@linaro.org Signed-off-by: Greg Kroah-Hartman <gregkh@linuxfoundation.org>
This commit is contained in:
parent
76d62981b5
commit
c5d4297f0c
@ -7,6 +7,7 @@
|
||||
* Author : Yuan-Hsin Chen <yhchen@faraday-tech.com>
|
||||
*/
|
||||
|
||||
#include <linux/delay.h>
|
||||
#include <linux/dma-mapping.h>
|
||||
#include <linux/err.h>
|
||||
#include <linux/interrupt.h>
|
||||
@ -1023,6 +1024,11 @@ static int fotg210_udc_start(struct usb_gadget *g,
|
||||
dev_err(fotg210->dev, "can't bind to phy\n");
|
||||
}
|
||||
|
||||
/* chip enable */
|
||||
value = ioread32(fotg210->reg + FOTG210_DMCR);
|
||||
value |= DMCR_CHIP_EN;
|
||||
iowrite32(value, fotg210->reg + FOTG210_DMCR);
|
||||
|
||||
/* enable device global interrupt */
|
||||
value = ioread32(fotg210->reg + FOTG210_DMCR);
|
||||
value |= DMCR_GLINT_EN;
|
||||
@ -1039,6 +1045,15 @@ static void fotg210_init(struct fotg210_udc *fotg210)
|
||||
iowrite32(GMIR_MHC_INT | GMIR_MOTG_INT | GMIR_INT_POLARITY,
|
||||
fotg210->reg + FOTG210_GMIR);
|
||||
|
||||
/* mask interrupts for groups other than 0-2 */
|
||||
iowrite32(~(DMIGR_MINT_G0 | DMIGR_MINT_G1 | DMIGR_MINT_G2),
|
||||
fotg210->reg + FOTG210_DMIGR);
|
||||
|
||||
/* udc software reset */
|
||||
iowrite32(DMCR_SFRST, fotg210->reg + FOTG210_DMCR);
|
||||
/* Better wait a bit, but without a datasheet, no idea how long. */
|
||||
usleep_range(100, 200);
|
||||
|
||||
/* disable device global interrupt */
|
||||
value = ioread32(fotg210->reg + FOTG210_DMCR);
|
||||
value &= ~DMCR_GLINT_EN;
|
||||
|
@ -58,6 +58,8 @@
|
||||
|
||||
/* Device Mask of Interrupt Group Register (0x130) */
|
||||
#define FOTG210_DMIGR 0x130
|
||||
#define DMIGR_MINT_G2 (1 << 2)
|
||||
#define DMIGR_MINT_G1 (1 << 1)
|
||||
#define DMIGR_MINT_G0 (1 << 0)
|
||||
|
||||
/* Device Mask of Interrupt Source Group 0(0x134) */
|
||||
|
Loading…
Reference in New Issue
Block a user