as3525v2: add partial usb init code

git-svn-id: svn://svn.rockbox.org/rockbox/trunk@26157 a1c6a512-1295-4272-9138-f99709370657
This commit is contained in:
Amaury Pouly 2010-05-19 08:33:50 +00:00
parent 3356effcdf
commit cc61f03915
2 changed files with 282 additions and 12 deletions

View file

@ -48,6 +48,9 @@ struct usb_endpoint
static struct usb_endpoint endpoints[USB_NUM_ENDPOINTS*2];
#endif
static unsigned int usb_num_in_ep = 0;
static unsigned int usb_num_out_ep = 0;
void usb_attach(void)
{
usb_enable(true);
@ -102,6 +105,51 @@ static void as3525v2_connect(void)
usb_delay();
}
static void usb_enable_common_interrupts(void)
{
/* Clear any pending otg interrupt */
USB_GOTGINT = 0xffffffff;
/* Clear any pending interrupt */
USB_GINTSTS = 0Xffffffff;
/* Enable interrupts */
USB_GINTMSK |= USB_GINTMSK_modemismatch |
USB_GINTMSK_otgintr |
USB_GINTMSK_rxstsqlvl | /* for dma */
USB_GINTMSK_conidstschng |
USB_GINTMSK_wkupintr |
USB_GINTMSK_disconnect |
USB_GINTMSK_usbsuspend |
USB_GINTMSK_sessreqintr;
}
static void usb_flush_tx_fifos(int nums)
{
unsigned int i = 0;
USB_GRSTCTL = (USB_GRSTCTL & (~USB_GRSTCTL_txfnum_bits))
| (nums << USB_GRSTCTL_txfnum_bit_pos)
| USB_GRSTCTL_txfflsh_flush;
while(USB_GRSTCTL & USB_GRSTCTL_txfflsh_flush && i < 0x300)
i++;
if(USB_GRSTCTL & USB_GRSTCTL_txfflsh_flush)
panicf("usb: hang of flush tx fifos (%x)", nums);
/* wait 3 phy clocks */
sleep(1);
}
static void usb_flush_rx_fifo(void)
{
unsigned int i = 0;
USB_GRSTCTL |= USB_GRSTCTL_rxfflsh_flush;
while(USB_GRSTCTL & USB_GRSTCTL_rxfflsh_flush && i < 0x300)
i++;
if(USB_GRSTCTL & USB_GRSTCTL_rxfflsh_flush)
panicf("usb: hang of flush rx fifo");
/* wait 3 phy clocks */
sleep(1);
}
static void core_reset(void)
{
unsigned int i = 0;
@ -118,26 +166,137 @@ static void core_reset(void)
i++;
if(USB_GRSTCTL & USB_GRSTCTL_csftrst)
{
logf("oops, usb core soft reset hang :(");
}
panicf("oops, usb core soft reset hang :(");
/* Wait for 3 PHY Clocks */
/*mdelay(100);*/
sleep(1);
logf("%ld endpoints", USB_GHWCFG2_NUM_EP);
for(i = 0; i < USB_GHWCFG2_NUM_EP; i++)
logf(" EP%d: IN=%ld OUT=%ld", i, USB_GHWCFG1_IN_EP(i), USB_GHWCFG1_OUT_EP(i));
/* Check hardware capabilityies */
if(USB_GHWCFG2_ARCH != USB_INT_DMA_ARCH)
panicf("usb: wrong architecture (%ld)", USB_GHWCFG2_ARCH);
if(USB_GHWCFG2_HS_PHY_TYPE != USB_PHY_TYPE_UTMI)
panicf("usb: wrong HS phy type (%ld)", USB_GHWCFG2_HS_PHY_TYPE);
if(USB_GHWCFG2_FS_PHY_TYPE != USB_PHY_TYPE_UNSUPPORTED)
panicf("usb: wrong FS phy type (%ld)", USB_GHWCFG2_FS_PHY_TYPE);
if(USB_GHWCFG2_DYN_FIFO != 1)
panicf("usb: no dynamic fifo");
if(USB_GHWCFG4_UTMI_PHY_DATA_WIDTH != 0x2)
panicf("usb: wrong utmi data width (%ld)", USB_GHWCFG4_UTMI_PHY_DATA_WIDTH);
if(USB_GHWCFG4_DED_FIFO_EN != 1) /* it seems to be multiple tx fifo support */
panicf("usb: no multiple tx fifo");
logf("hwcfg1: %08lx", USB_GHWCFG1);
logf("hwcfg2: %08lx", USB_GHWCFG2);
logf("hwcfg3: %08lx", USB_GHWCFG3);
logf("hwcfg4: %08lx", USB_GHWCFG4);
logf("%ld in ep", USB_GHWCFG4_NUM_IN_EP);
logf("tot fifo sz: %ld", USB_GHWCFG3_DFIFO_LEN);
logf("rx fifo sz: %ld", USB_GRXFSIZ);
logf("tx fifo sz: %ld", USB_GNPTXFSIZ >> 16); /* there is no perio ep so print only non-perio */
logf("%ld endpoints", USB_GHWCFG2_NUM_EP);
usb_num_in_ep = 0;
usb_num_out_ep = 0;
for(i = 0; i < USB_GHWCFG2_NUM_EP; i++)
{
if(USB_GHWCFG1_IN_EP(i))
usb_num_in_ep++;
if(USB_GHWCFG1_OUT_EP(i))
usb_num_out_ep++;
logf(" EP%d: IN=%ld OUT=%ld", i, USB_GHWCFG1_IN_EP(i), USB_GHWCFG1_OUT_EP(i));
}
if(usb_num_in_ep != USB_GHWCFG4_NUM_IN_EP)
panicf("usb: num in ep mismatch(%d,%lu)", usb_num_in_ep, USB_GHWCFG4_NUM_IN_EP);
logf("%d in ep, %d out ep", usb_num_in_ep, usb_num_out_ep);
logf("initial:");
logf(" tot fifo sz: %ld", USB_GHWCFG3_DFIFO_LEN);
logf(" rx fifo sz: %ld", USB_GRXFSIZ);
logf(" tx fifo sz: %ld", USB_GET_FIFOSIZE_DEPTH(USB_GNPTXFSIZ)); /* there is no perio ep so print only non-perio */
for(i = 1; i <= USB_GHWCFG4_NUM_IN_EP; i++)
{
logf(" dieptx fifo sd (%2u): %ld", i, USB_GET_FIFOSIZE_DEPTH(USB_DIEPTXFSIZ(i)));
}
/* Setup FIFOs */
/* Organize FIFO as follow (unsure):
* 0 -> rxfsize : RX fifo
* rxfsize -> rxfsize + nptxfsize : TX fifo for first IN ep
* rxfsize + nptxfsize -> rxfsize + 2 * nptxfsize : TX fifo for second IN ep
* rxfsize + 2 * nptxfsize -> rxfsize + 3 * nptxfsize : TX fifo for third IN ep
* ...
*/
unsigned short adr = USB_GRXFSIZ;
unsigned short depth = USB_GET_FIFOSIZE_DEPTH(USB_GNPTXFSIZ);
USB_GNPTXFSIZ = USB_MAKE_FIFOSIZE_DATA(adr, depth);
adr += depth;
for(i = 1; i <= USB_GHWCFG4_NUM_IN_EP; i++)
{
depth = USB_GET_FIFOSIZE_DEPTH(USB_DIEPTXFSIZ(i));
USB_DIEPTXFSIZ(i) = USB_MAKE_FIFOSIZE_DATA(adr, depth);
adr += depth;
}
logf("used:");
logf(" rx fifo: [%04x,+%4lx]", 0, USB_GRXFSIZ);
logf(" nptx fifo: [%04lx,+%4lx]", USB_GET_FIFOSIZE_START_ADR(USB_GNPTXFSIZ),
USB_GET_FIFOSIZE_DEPTH(USB_GNPTXFSIZ));
for(i = 1; i <= USB_GHWCFG4_NUM_IN_EP; i++)
{
logf(" dieptx fifo(%2u): [%04lx,+%4lx]", i,
USB_GET_FIFOSIZE_START_ADR(USB_DIEPTXFSIZ(i)),
USB_GET_FIFOSIZE_DEPTH(USB_DIEPTXFSIZ(i)));
}
/* flush the fifos */
usb_flush_tx_fifos(0x10); /* flush all */
usb_flush_rx_fifo();
/* flush learning queue */
USB_GRSTCTL |= USB_GRSTCTL_intknqflsh;
/* Clear all pending device interrupts */
USB_DIEPMSK = 0;
USB_DOEPMSK = 0;
USB_DAINT = 0xffffffff;
USB_DAINTMSK = 0;
for(i = 0; i <= usb_num_in_ep; i++)
{
/* disable endpoint if enabled */
if(USB_DIEPCTL(i) & USB_DEPCTL_epena)
USB_DIEPCTL(i) = USB_DEPCTL_epdis | USB_DEPCTL_snak;
else
USB_DIEPCTL(i) = 0;
USB_DIEPTSIZ(i) = 0;
USB_DIEPDMA(i) = 0;
USB_DIEPINT(i) = 0xff;
}
for(i = 0; i <= usb_num_out_ep; i++)
{
/* disable endpoint if enabled */
if(USB_DOEPCTL(i) & USB_DEPCTL_epena)
USB_DOEPCTL(i) = USB_DEPCTL_epdis | USB_DEPCTL_snak;
else
USB_DOEPCTL(i) = 0;
USB_DOEPTSIZ(i) = 0;
USB_DOEPDMA(i) = 0;
USB_DOEPINT(i) = 0xff;
}
}
static void core_dev_init(void)
{
/* Restart the phy clock */
USB_PCGCCTL = 0;
/* Set phy speed : high speed */
USB_DCFG = (USB_DCFG & (~USB_DCFG_devspd_bits)) | USB_DCFG_devspd_hs_phy_hs;
/* Set periodic frame interval */
USB_DCFG = (USB_DCFG & (~USB_DCFG_perfrint_bits)) | (USB_DCFG_FRAME_INTERVAL_80 << USB_DCFG_perfrint_bit_pos);
/* Configure data fifo size */
}
static void core_init(void)
@ -169,6 +328,12 @@ static void core_init(void)
USB_GAHBCFG |= USB_GAHBCFG_dma_enable;
/* Disable HNP and SRP, not sure it's useful because we already forced dev mode */
USB_GUSBCFG &= ~(USB_GUSBCFG_SRP_cap | USB_GUSBCFG_HNP_cap);
/* enable basic interrupts */
usb_enable_common_interrupts();
/* perform device model specific init */
core_dev_init();
}
void usb_drv_init(void)

View file

@ -50,19 +50,47 @@
#define USB_GHWCFG3 (*(volatile unsigned long *)(USB_BASE + 0x04C)) /** User HW Config3 Register */
#define USB_GHWCFG4 (*(volatile unsigned long *)(USB_BASE + 0x050)) /** User HW Config4 Register */
/* 1<=ep<=15, don't use ep=0 !!! */
/** Device IN Endpoint Transmit FIFO (ep) Size Register */
#define USB_DIEPTXFSIZ(ep) (*(volatile unsigned long *)(USB_BASE + 0x100 + 4 * (ep)))
#define USB_MAKE_FIFOSIZE_DATA(startadr, depth) \
(((startadr) & 0xffff) | ((depth) << 16))
#define USB_GET_FIFOSIZE_DEPTH(data) \
((data) >> 16)
#define USB_GET_FIFOSIZE_START_ADR(data) \
((data) & 0xffff)
#define USB_GRSTCTL_csftrst (1 << 0) /** Core soft reset */
#define USB_GRSTCTL_hsftrst (1 << 1) /** Hclk soft reset */
#define USB_GRSTCTL_intknqflsh (1 << 3) /** In Token Sequence Learning Queue Flush */
#define USB_GRSTCTL_txfnum_bit_pos 6 /** TxFIFO Number */
#define USB_GRSTCTL_txfnum_bits (0x1f << 6)
#define USB_GRSTCTL_txfflsh_flush (1 << 5) /** TxFIFO Flush */
#define USB_GRSTCTL_rxfflsh_flush (1 << 4) /** RxFIFO Flush */
#define USB_GRSTCTL_ahbidle (1 << 31) /** AHB idle state*/
#define USB_GHWCFG1_IN_EP(ep) ((USB_GHWCFG1 >> ((ep) *2)) & 0x1) /** 1 if EP(ep) has in cap */
#define USB_GHWCFG1_OUT_EP(ep) ((USB_GHWCFG1 >> ((ep) *2 + 1)) & 0x1)/** 1 if EP(ep) has out cap */
#define USB_GHWCFG2_ARCH ((USB_GHWCFG2 >> 3) & 0x3) /** Architecture */
#define USB_GHWCFG2_HS_PHY_TYPE ((USB_GHWCFG2 >> 6) & 0x3) /** High speed PHY type */
#define USB_GHWCFG2_FS_PHY_TYPE ((USB_GHWCFG2 >> 8) & 0x3) /** Full speed PHY type */
#define USB_GHWCFG2_NUM_EP ((USB_GHWCFG2 >> 10) & 0xf) /** Number of endpoints */
#define USB_GHWCFG2_DYN_FIFO ((USB_GHWCFG2 >> 19) & 0x1) /** Dynamic FIFO */
#define USB_PHY_TYPE_UNSUPPORTED 0
#define USB_PHY_TYPE_UTMI 1
#define USB_INT_DMA_ARCH 2
#define USB_GHWCFG3_DFIFO_LEN (USB_GHWCFG3 >> 16) /** Total fifo size */
#define USB_GHWCFG4_UTMI_PHY_DATA_WIDTH ((USB_GHWCFG4 >> 14) & 0x3)
#define USB_GHWCFG4_DED_FIFO_EN ((USB_GHWCFG4 >> 25) & 0x1)
#define USB_GHWCFG4_NUM_IN_EP ((USB_GHWCFG4 >> 26) & 0xf) /** Number of IN endpoints */
#define USB_GHWCFG2_NUM_EP ((USB_GHWCFG2 >> 10) & 0xf) /** Number of endpoints */
#define USB_GUSBCFG_ulpi_utmi_sel (1 << 4) /** select ulpi:1 or utmi:0 */
#define USB_GUSBCFG_phy_if (1 << 3) /** select utmi bus width ? */
#define USB_GUSBCFG_SRP_cap 0x100
@ -72,6 +100,40 @@
#define USB_GAHBCFG_INT_DMA_BURST_INCR 1 /** note: the linux patch has several other value, this is one picked for internal dma */
#define USB_GAHBCFG_dma_enable (1 << 5)
#define USB_GINTMSK_usb_rst 0x00001000 /*!< USB Reset Mask */
#define USB_GINTMSK_EnumDone 0x00000200 /*!< Enumeration Done Mask */
#define USB_GINTMSK_ErlySusp 0x00000400 /*!< Early Suspend Mask */
#define USB_GINTMSK_USBSusp 0x00000800 /*!< USB Suspend Mask */
#define USB_GINTMSK_SOF 0x00000008 /*!< Start of (micro)Frame Mask */
#define USB_GINTMSK_NPTxFEmp 0x00000020 /*!< Non-periodic TxFIFO Empty Mask */
#define USB_GINTMSK_wkupintr (1 << 31)
#define USB_GINTMSK_sessreqintr (1 << 30)
#define USB_GINTMSK_disconnect (1 << 29)
#define USB_GINTMSK_conidstschng (1 << 28)
#define USB_GINTMSK_ptxfempty (1 << 26)
#define USB_GINTMSK_hcintr (1 << 25)
#define USB_GINTMSK_portintr (1 << 24)
#define USB_GINTMSK_incomplisoout (1 << 21)
#define USB_GINTMSK_incomplisoin (1 << 20)
#define USB_GINTMSK_outepintr (1 << 19)
#define USB_GINTMSK_inepintr (1 << 18)
#define USB_GINTMSK_epmismatch (1 << 17)
#define USB_GINTMSK_eopframe (1 << 15)
#define USB_GINTMSK_isooutdrop (1 << 14)
#define USB_GINTMSK_enumdone (1 << 13)
#define USB_GINTMSK_usbreset (1 << 12)
#define USB_GINTMSK_usbsuspend (1 << 11)
#define USB_GINTMSK_erlysuspend (1 << 10)
#define USB_GINTMSK_i2cintr (1 << 9)
#define USB_GINTMSK_goutnakeff (1 << 7)
#define USB_GINTMSK_ginnakeff (1 << 6)
#define USB_GINTMSK_nptxfempty (1 << 5)
#define USB_GINTMSK_rxstsqlvl (1 << 4)
#define USB_GINTMSK_sofintr (1 << 3)
#define USB_GINTMSK_otgintr (1 << 2)
#define USB_GINTMSK_modemismatch (1 << 1)
/**
* Device Registers Base Addresses
*/
@ -86,6 +148,49 @@
#define USB_DTKNQR2 (*(volatile unsigned long *)(USB_DEVICE + 0x24)) /** Device IN Token Sequence Learning Queue Register 2 */
#define USB_DTKNQP (*(volatile unsigned long *)(USB_DEVICE + 0x28)) /** Device IN Token Queue Pop register */
#define USB_DCFG_devspd_bits 0x3
#define USB_DCFG_devspd_hs_phy_hs 0 /** High speed PHY running at high speed */
#define USB_DCFG_devspd_hs_phy_fs 1 /** High speed PHY running at full speed */
#define USB_DCFG_perfrint_bit_pos 11 /** Periodic Frame Interval */
#define USB_DCFG_perfrint_bits (0x3 << USB_DCFG_perfrint_bit_pos)
#define USB_DCFG_FRAME_INTERVAL_80 0
#define USB_DCFG_FRAME_INTERVAL_85 1
#define USB_DCFG_FRAME_INTERVAL_90 2
#define USB_DCFG_FRAME_INTERVAL_95 3
/* 0<=ep<=15, you can use ep=0 */
/** Device IN Endpoint (ep) Control Register */
#define USB_DIEPCTL(ep) (*(volatile unsigned long *)(USB_DEVICE + 0x100 + (ep) * 0x20))
/** Device IN Endpoint (ep) Interrupt Register */
#define USB_DIEPINT(ep) (*(volatile unsigned long *)(USB_DEVICE + 0x100 + (ep) * 0x20 + 0x8))
/** Device IN Endpoint (ep) Transfer Size Register */
#define USB_DIEPTSIZ(ep) (*(volatile unsigned long *)(USB_DEVICE + 0x100 + (ep) * 0x20 + 0x10))
/** Device IN Endpoint (ep) DMA Address Register */
#define USB_DIEPDMA(ep) (*(volatile unsigned long *)(USB_DEVICE + 0x100 + (ep) * 0x20 + 0x14))
/** Device IN Endpoint (ep) Transmit FIFO Status Register */
#define USB_DTXFSTS(ep) (*(volatile unsigned long *)(USB_DEVICE + 0x100 + (ep) * 0x20 + 0x18))
/** Device OUT Endpoint (ep) Control Register */
#define USB_DOEPCTL(ep) (*(volatile unsigned long *)(USB_DEVICE + 0x300 + (ep) * 0x20))
/** Device OUT Endpoint (ep) Frame number Register */
#define USB_DOEPFN(ep) (*(volatile unsigned long *)(USB_DEVICE + 0x300 + (ep) * 0x20 + 0x4))
/** Device Endpoint (ep) Interrupt Register */
#define USB_DOEPINT(ep) (*(volatile unsigned long *)(USB_DEVICE + 0x300 + (ep) * 0x20 + 0x8))
/** Device OUT Endpoint (ep) Transfer Size Register */
#define USB_DOEPTSIZ(ep) (*(volatile unsigned long *)(USB_DEVICE + 0x300 + (ep) * 0x20 + 0x10))
/** Device Endpoint (ep) DMA Address Register */
#define USB_DOEPDMA(ep) (*(volatile unsigned long *)(USB_DEVICE + 0x300 + (ep) * 0x20 + 0x14))
#define USB_PCGCCTL (*(volatile unsigned long *)(USB_BASE + 0xE00)) /** Power and Clock Gating Control Register */
#define USB_DEPCTL_epena (1 << 31) /** Endpoint enable */
#define USB_DEPCTL_epdis (1 << 30) /** Endpoint disable */
#define USB_DEPCTL_snak (1 << 27) /** Set NAK */
#define USB_DEPCTL_cnak (1 << 28) /** Clear NAK */
/**
* Parameters
*/
#endif /* __USB_DRV_AS3525v2_H__ */