pmic: Add support for the Dialog DA9053 PMIC

[u-boot] / drivers / usb / gadget / designware_udc.c

diff --git a/drivers/usb/gadget/designware_udc.c b/drivers/usb/gadget/designware_udc.c
index aee44aa06479bfe0cf0bfe9b5d3dc4ee46ac457e..7e9ccdeeb830b4f5b4ad46b28676e187c99e0c77 100644 (file)
--- a/drivers/usb/gadget/designware_udc.c
+++ b/drivers/usb/gadget/designware_udc.c
@@ -202,6 +202,7 @@ static int usbgetpckfromfifo(int epNum, u8 *bufp, u32 len)
        u32 i, nw, nb;
        u32 *wrdp;
        u8 *bytp;
+       u32 tmp[128];
 
        if (readl(&udc_regs_p->dev_stat) & DEV_STAT_RXFIFO_EMPTY)
                return -1;
@@ -209,7 +210,12 @@ static int usbgetpckfromfifo(int epNum, u8 *bufp, u32 len)
        nw = len / sizeof(u32);
        nb = len % sizeof(u32);
 
-       wrdp = (u32 *)bufp;
+       /* use tmp buf if bufp is not word aligned */
+       if ((int)bufp & 0x3)
+               wrdp = (u32 *)&tmp[0];
+       else
+               wrdp = (u32 *)bufp;
+
        for (i = 0; i < nw; i++) {
                writel(readl(fifo_ptr), wrdp);
                wrdp++;
@@ -223,6 +229,10 @@ static int usbgetpckfromfifo(int epNum, u8 *bufp, u32 len)
        }
        readl(&outep_regs_p[epNum].write_done);
 
+       /* copy back tmp buffer to bufp if bufp is not word aligned */
+       if ((int)bufp & 0x3)
+               memcpy(bufp, tmp, len);
+
        return 0;
 }
 
@@ -497,16 +507,24 @@ static void dw_udc_epn_tx(int ep)
 {
        struct usb_endpoint_instance *endpoint = dw_find_ep(ep);
 
+       if (!endpoint)
+               return;
+
        /*
         * We need to transmit a terminating zero-length packet now if
         * we have sent all of the data in this URB and the transfer
         * size was an exact multiple of the packet size.
         */
-       if (endpoint && endpoint->tx_urb && endpoint->tx_urb->actual_length) {
-               if (endpoint->last == endpoint->tx_packetSize) {
-                       /* handle zero length packet here */
-                       writel(0x0, &inep_regs_p[ep].write_done);
-               }
+       if (endpoint->tx_urb &&
+           (endpoint->last == endpoint->tx_packetSize) &&
+           (endpoint->tx_urb->actual_length - endpoint->sent -
+            endpoint->last == 0)) {
+               /* handle zero length packet here */
+               writel(0x0, &inep_regs_p[ep].write_done);
+
+       }
+
+       if (endpoint->tx_urb && endpoint->tx_urb->actual_length) {
                /* retire the data that was just sent */
                usbd_tx_complete(endpoint);
                /*
@@ -548,8 +566,6 @@ int udc_init(void)
 
        readl(&plug_regs_p->plug_pending);
 
-       udc_disconnect();
-
        for (i = 0; i < UDC_INIT_MDELAY; i++)
                udelay(1000);
 
@@ -560,11 +576,15 @@ int udc_init(void)
        writel(~0x0, &udc_regs_p->dev_int_mask);
        writel(~0x0, &udc_regs_p->endp_int_mask);
 
+#ifndef CONFIG_USBD_HS
        writel(DEV_CONF_FS_SPEED | DEV_CONF_REMWAKEUP | DEV_CONF_SELFPOW |
-              /* Dev_Conf_SYNCFRAME | */
               DEV_CONF_PHYINT_16, &udc_regs_p->dev_conf);
+#else
+       writel(DEV_CONF_HS_SPEED | DEV_CONF_REMWAKEUP | DEV_CONF_SELFPOW |
+                       DEV_CONF_PHYINT_16, &udc_regs_p->dev_conf);
+#endif
 
-       writel(0x0, &udc_regs_p->dev_cntl);
+       writel(DEV_CNTL_SOFTDISCONNECT, &udc_regs_p->dev_cntl);
 
        /* Clear all interrupts pending */
        writel(DEV_INT_MSK, &udc_regs_p->dev_int);
@@ -572,6 +592,11 @@ int udc_init(void)
        return 0;
 }
 
+int is_usbd_high_speed(void)
+{
+       return (readl(&udc_regs_p->dev_stat) & DEV_STAT_ENUM) ? 0 : 1;
+}
+
 /*
  * udc_setup_ep - setup endpoint
  * Associate a physical endpoint with endpoint_instance
@@ -588,6 +613,9 @@ void udc_setup_ep(struct usb_device_instance *device,
        char *tt;
        u32 endp_intmask;
 
+       if ((ep != 0) && (udc_device->device_state < STATE_ADDRESSED))
+               return;
+
        tt = getenv("usbtty");
        if (!tt)
                tt = "generic";
@@ -647,9 +675,6 @@ void udc_setup_ep(struct usb_device_instance *device,
                writel(packet_size | ((buffer_size / sizeof(int)) << 16),
                       &out_p->endp_maxpacksize);
 
-               writel((packet_size << 19) | ENDP_EPTYPE_CNTL,
-                      &udc_regs_p->udc_endp_reg[ep_num]);
-
        } else if ((ep_addr & USB_ENDPOINT_DIR_MASK) == USB_DIR_IN) {
                /* Setup the IN endpoint */
                writel(0x0, &in_p->endp_status);
@@ -708,7 +733,17 @@ void udc_setup_ep(struct usb_device_instance *device,
 /* Turn on the USB connection by enabling the pullup resistor */
 void udc_connect(void)
 {
-       u32 plug_st;
+       u32 plug_st, dev_cntl;
+
+       dev_cntl = readl(&udc_regs_p->dev_cntl);
+       dev_cntl |= DEV_CNTL_SOFTDISCONNECT;
+       writel(dev_cntl, &udc_regs_p->dev_cntl);
+
+       udelay(1000);
+
+       dev_cntl = readl(&udc_regs_p->dev_cntl);
+       dev_cntl &= ~DEV_CNTL_SOFTDISCONNECT;
+       writel(dev_cntl, &udc_regs_p->dev_cntl);
 
        plug_st = readl(&plug_regs_p->plug_state);
        plug_st &= ~(PLUG_STATUS_PHY_RESET | PLUG_STATUS_PHY_MODE);
@@ -720,6 +755,8 @@ void udc_disconnect(void)
 {
        u32 plug_st;
 
+       writel(DEV_CNTL_SOFTDISCONNECT, &udc_regs_p->dev_cntl);
+
        plug_st = readl(&plug_regs_p->plug_state);
        plug_st |= (PLUG_STATUS_PHY_RESET | PLUG_STATUS_PHY_MODE);
        writel(plug_st, &plug_regs_p->plug_state);
@@ -775,7 +812,7 @@ void udc_startup_events(struct usb_device_instance *device)
 /*
  * Plug detection interrupt handling
  */
-void dw_udc_plug_irq(void)
+static void dw_udc_plug_irq(void)
 {
        if (readl(&plug_regs_p->plug_state) & PLUG_STATUS_ATTACHED) {
                /*
@@ -789,11 +826,6 @@ void dw_udc_plug_irq(void)
                UDCDBG("device attached and powered");
                udc_state_transition(udc_device->device_state, STATE_POWERED);
        } else {
-               /*
-                * USB cable detached
-                * Reset the PHY and switch the mode.
-                */
-               udc_disconnect();
                writel(~0x0, &udc_regs_p->dev_int_mask);
 
                UDCDBG("device detached or unpowered");
@@ -804,18 +836,23 @@ void dw_udc_plug_irq(void)
 /*
  * Device interrupt handling
  */
-void dw_udc_dev_irq(void)
+static void dw_udc_dev_irq(void)
 {
        if (readl(&udc_regs_p->dev_int) & DEV_INT_USBRESET) {
                writel(~0x0, &udc_regs_p->endp_int_mask);
 
-               udc_connect();
-
                writel(readl(&inep_regs_p[0].endp_cntl) | ENDP_CNTL_FLUSH,
                       &inep_regs_p[0].endp_cntl);
 
                writel(DEV_INT_USBRESET, &udc_regs_p->dev_int);
 
+               /*
+                * This endpoint0 specific register can be programmed only
+                * after the phy clock is initialized
+                */
+               writel((EP0_MAX_PACKET_SIZE << 19) | ENDP_EPTYPE_CNTL,
+                               &udc_regs_p->udc_endp_reg[0]);
+
                UDCDBG("device reset in progess");
                udc_state_transition(udc_device->device_state, STATE_DEFAULT);
        }
@@ -869,7 +906,7 @@ void dw_udc_dev_irq(void)
 /*
  * Endpoint interrupt handling
  */
-void dw_udc_endpoint_irq(void)
+static void dw_udc_endpoint_irq(void)
 {
        while (readl(&udc_regs_p->endp_int) & ENDP0_INT_CTRLOUT) {
 
@@ -902,7 +939,7 @@ void dw_udc_endpoint_irq(void)
                writel(ENDP0_INT_CTRLIN, &udc_regs_p->endp_int);
        }
 
-       while (readl(&udc_regs_p->endp_int) & ENDP_INT_NONISOOUT_MSK) {
+       if (readl(&udc_regs_p->endp_int) & ENDP_INT_NONISOOUT_MSK) {
                u32 epnum = 0;
                u32 ep_int = readl(&udc_regs_p->endp_int) &
                    ENDP_INT_NONISOOUT_MSK;