6 files changed, 187 insertions, 108 deletions

diff --git a/firmware/target/arm/imx31/gigabeat-s/system-target.h b/firmware/target/arm/imx31/gigabeat-s/system-target.h
index 847e6cfc51..b99b31d1b4 100644
--- a/firmware/target/arm/imx31/gigabeat-s/system-target.h
+++ b/firmware/target/arm/imx31/gigabeat-s/system-target.h
@@ -31,6 +31,14 @@
 #define CPUFREQ_MAX CPU_FREQ
 #endif
 
+/* For USB driver - no accuracy assurance */
+static inline void udelay(unsigned int usecs)
+{
+    unsigned int x;
+    for (x = 0; x < 300*usecs; x++)
+        asm volatile ("");
+}
+
 #if 0
 static inline void udelay(unsigned int usecs)
 {
diff --git a/firmware/target/arm/imx31/gigabeat-s/usb-imx31.c b/firmware/target/arm/imx31/gigabeat-s/usb-imx31.c
index cd8b513ecd..c0d7cb8d2a 100644
--- a/firmware/target/arm/imx31/gigabeat-s/usb-imx31.c
+++ b/firmware/target/arm/imx31/gigabeat-s/usb-imx31.c
@@ -29,6 +29,7 @@
 #include "usb-target.h"
 #include "clkctl-imx31.h"
 #include "power-imx31.h"
+#include "avic-imx31.h"
 #include "mc13783.h"
 
 static int usb_status = USB_EXTRACTED;
@@ -75,11 +76,7 @@ bool usb_plugged(void)
 
 void usb_init_device(void)
 {
-    imx31_clkctl_module_clock_gating(CG_USBOTG, CGM_ON_ALL);
-
-    enable_transceiver(true);
-
-    /* Module will be turned off later after firmware init */
+    /* Do one-time inits */
     usb_drv_startup();
 
     /* Initially poll */
@@ -91,19 +88,37 @@ void usb_init_device(void)
 
 void usb_enable(bool on)
 {
+    /* Module clock should be on since since this could be called with
+     * OFF initially and writing module registers would hardlock otherwise. */
+    imx31_clkctl_module_clock_gating(CG_USBOTG, CGM_ON_ALL);
+    enable_transceiver(true);
+
     if (on)
     {
-        imx31_clkctl_module_clock_gating(CG_USBOTG, CGM_ON_ALL);
-        enable_transceiver(true);
         usb_core_init();
     }
     else
     {
-        /* Module clock should be on since this could be called first */
-        imx31_clkctl_module_clock_gating(CG_USBOTG, CGM_ON_ALL);
-        enable_transceiver(true);
         usb_core_exit();
         enable_transceiver(false);
         imx31_clkctl_module_clock_gating(CG_USBOTG, CGM_OFF);
     }
 }
+
+void usb_attach(void)
+{
+    usb_enable(true);
+}
+
+static void __attribute__((interrupt("IRQ"))) USB_OTG_HANDLER(void)
+{
+    usb_drv_int(); /* Call driver handler */
+}
+
+void usb_drv_int_enable(bool enable)
+{
+    if (enable)
+        avic_enable_int(USB_OTG, IRQ, 7, USB_OTG_HANDLER);
+    else    
+        avic_disable_int(USB_OTG);
+}
diff --git a/firmware/target/arm/powermgmt-ascodec.c b/firmware/target/arm/powermgmt-ascodec.c
index ab9fd7b490..6ee6209823 100644
--- a/firmware/target/arm/powermgmt-ascodec.c
+++ b/firmware/target/arm/powermgmt-ascodec.c
@@ -27,6 +27,8 @@
 #include "adc.h"
 #include "powermgmt.h"
 #include "power.h"
+#include "usb-target.h"
+#include "usb.h"
 
 /*===========================================================================
  * These parameters may be defined per target:
@@ -132,6 +134,10 @@ static inline void charger_plugged(void)
 {
     batt_threshold = BATT_FULL_VOLTAGE; /* Start with topped value. */
     battery_voltage_sync();
+#if defined(USB_STATUS_BY_EVENT) && defined(USB_DETECT_BY_DRV)
+    /* Charger pin detect is USB pin detect */
+    usb_connect_event(true);
+#endif
 }
 
 static inline void charger_control(void)
@@ -186,6 +192,10 @@ static inline void charger_unplugged(void)
     disable_charger();
     if (charge_state >= CHARGE_STATE_ERROR)
         charge_state = DISCHARGING; /* Reset error */
+#if defined(USB_STATUS_BY_EVENT) && defined(USB_DETECT_BY_DRV)
+    /* Charger pin detect is USB pin detect */
+    usb_connect_event(false);
+#endif
 }
 
 /* Main charging algorithm - called from powermgmt.c */
diff --git a/firmware/target/arm/usb-drv-arc.c b/firmware/target/arm/usb-drv-arc.c
index 1cdc0f9e90..99845c2a49 100644
--- a/firmware/target/arm/usb-drv-arc.c
+++ b/firmware/target/arm/usb-drv-arc.c
@@ -9,7 +9,7 @@
  *
  * Driver for ARC USBOTG Device Controller
  *
- * Copyright (C) 2007 by Bjรถrn Stenberg
+ * Copyright (C) 2007 by Bj๖rn Stenberg
  *
  * This program is free software; you can redistribute it and/or
  * modify it under the terms of the GNU General Public License
@@ -33,11 +33,6 @@
 //#define LOGF_ENABLE
 #include "logf.h"
 
-#if CONFIG_CPU == IMX31L
-#include "avic-imx31.h"
-static void __attribute__((interrupt("IRQ"))) USB_OTG_HANDLER(void);
-#endif
-
 /* USB device mode registers (Little Endian) */
 
 #define REG_ID               (*(volatile unsigned int *)(USB_BASE+0x000))
@@ -326,8 +321,8 @@ struct transfer_descriptor {
     unsigned int reserved;
 } __attribute__ ((packed));
 
-static struct transfer_descriptor td_array[NUM_ENDPOINTS*2]
-    USBDEVBSS_ATTR __attribute__((aligned(32)));
+static struct transfer_descriptor td_array[USB_NUM_ENDPOINTS*2]
+    USB_DEVBSS_ATTR __attribute__((aligned(32)));
 
 /* manual: 32.13.1 Endpoint Queue Head (dQH) */
 struct queue_head {
@@ -342,17 +337,10 @@ struct queue_head {
     unsigned int wait;              /* for softwate use, indicates if the transfer is blocking */
 } __attribute__((packed));
 
-#if CONFIG_CPU == IMX31L
-static struct queue_head qh_array[NUM_ENDPOINTS*2]
-    QHARRAY_ATTR __attribute__((aligned (2048)));
-#else
-/* This still needs to be 2048 byte aligned, but QHARRAY_ATTR should take
-   care of that */
-static struct queue_head qh_array[NUM_ENDPOINTS*2]
-    QHARRAY_ATTR __attribute__((aligned (4)));
-#endif
+static struct queue_head qh_array[USB_NUM_ENDPOINTS*2]
+    USB_QHARRAY_ATTR;
 
-static struct wakeup transfer_completion_signal[NUM_ENDPOINTS*2]
+static struct wakeup transfer_completion_signal[USB_NUM_ENDPOINTS*2]
     SHAREDBSS_ATTR;
 
 static const unsigned int pipe2mask[] = {
@@ -363,7 +351,7 @@ static const unsigned int pipe2mask[] = {
     0x10, 0x100000,
 };
 
-static char ep_allocation[NUM_ENDPOINTS];
+static char ep_allocation[USB_NUM_ENDPOINTS];
 
 /*-------------------------------------------------------------------------*/
 static void transfer_completed(void);
@@ -378,52 +366,46 @@ static void init_control_queue_heads(void);
 static void init_bulk_queue_heads(void);
 static void init_endpoints(void);
 /*-------------------------------------------------------------------------*/
-
-bool usb_drv_powered(void)
+static void usb_drv_stop(void)
 {
-    return (REG_OTGSC & OTGSC_B_SESSION_VALID) ? true : false;
+    /* disable interrupts */
+    REG_USBINTR = 0;
+    /* stop usb controller (disconnect) */
+    REG_USBCMD &= ~USBCMD_RUN;
 }
 
-/* One-time driver startup init */
-void usb_drv_startup(void)
+void usb_drv_reset(void)
 {
-#if CONFIG_CPU == IMX31L && defined(BOOTLOADER)
-    /* This is the bootloader - activate the OTG controller or cold
-     * connect later could/will fail */
+    int oldlevel = disable_irq_save();
     REG_USBCMD &= ~USBCMD_RUN;
+    restore_irq(oldlevel);
 
+#ifdef USB_PORTSCX_PHY_TYPE
+    /* If a PHY type is specified, set it now */
+    REG_PORTSC1 = (REG_PORTSC1 & ~PORTSCX_PHY_TYPE_SEL) | USB_PORTSCX_PHY_TYPE;
+#endif
     sleep(HZ/20);
     REG_USBCMD |= USBCMD_CTRL_RESET;
     while (REG_USBCMD & USBCMD_CTRL_RESET);
+}
 
-    /* Set to ULPI */
-    REG_PORTSC1 = (REG_PORTSC1 & ~PORTSCX_PHY_TYPE_SEL) | PORTSCX_PTS_ULPI;
-    sleep(HZ/10);
-#endif
-
+/* One-time driver startup init */
+void usb_drv_startup(void)
+{
     /* Initialize all the signal objects once */
     int i;
-    for(i=0;i<NUM_ENDPOINTS*2;i++) {
+    for(i=0;i<USB_NUM_ENDPOINTS*2;i++) {
         wakeup_init(&transfer_completion_signal[i]);
     }
 }
 
 /* manual: 32.14.1 Device Controller Initialization */
-void usb_drv_init(void)
+static void _usb_drv_init(bool attach)
 {
-    REG_USBCMD &= ~USBCMD_RUN;
-    sleep(HZ/20);
-    REG_USBCMD |= USBCMD_CTRL_RESET;
-    while (REG_USBCMD & USBCMD_CTRL_RESET);
-
+    usb_drv_reset();
 
     REG_USBMODE = USBMODE_CTRL_MODE_DEVICE;
 
-#if CONFIG_CPU == IMX31L
-    /* Set to ULPI */
-    REG_PORTSC1 = (REG_PORTSC1 & ~PORTSCX_PHY_TYPE_SEL) | PORTSCX_PTS_ULPI;
-#endif
-
 #ifdef USB_NO_HIGH_SPEED
     /* Force device to full speed */
     /* See 32.9.5.9.2 */
@@ -436,69 +418,76 @@ void usb_drv_init(void)
     REG_ENDPOINTLISTADDR = (unsigned int)qh_array;
     REG_DEVICEADDR = 0;
 
-    /* enable USB interrupts */
-    REG_USBINTR =
-        USBINTR_INT_EN |
-        USBINTR_ERR_INT_EN |
-        USBINTR_PTC_DETECT_EN |
-        USBINTR_RESET_EN |
-        USBINTR_SYS_ERR_EN;
-
-#if CONFIG_CPU == IMX31L
-    avic_enable_int(USB_OTG, IRQ, 7, USB_OTG_HANDLER);
-#else
-    /* enable USB IRQ in CPU */
-    CPU_INT_EN = USB_MASK;
+#ifdef USB_DETECT_BY_DRV
+    if (!attach) {
+        /* enable RESET interrupt */
+        REG_USBINTR = USBINTR_RESET_EN;
+    }
+    else
 #endif
+    {
+        /* enable USB interrupts */
+        REG_USBINTR =
+            USBINTR_INT_EN |
+            USBINTR_ERR_INT_EN |
+            USBINTR_PTC_DETECT_EN |
+            USBINTR_RESET_EN;
+    }
+
+    usb_drv_int_enable(true);
 
     /* go go go */
     REG_USBCMD |= USBCMD_RUN;
 
-
     logf("usb_drv_init() finished");
     logf("usb id %x", REG_ID);
     logf("usb dciversion %x", REG_DCIVERSION);
     logf("usb dccparams %x", REG_DCCPARAMS);
 
     /* now a bus reset will occur. see bus_reset() */
+    (void)attach;
 }
 
-void usb_drv_exit(void)
+/** With USB_DETECT_BY_DRV, attach is distinct from init, otherwise eqivalent. **/
+
+/* USB_DETECT_BY_DRV - enable bus reset detection only
+ * else fully enable driver */
+void usb_drv_init(void)
 {
-    /* disable interrupts */
-    REG_USBINTR = 0;
+    _usb_drv_init(false);
+}
 
-    /* stop usb controller */
-    REG_USBCMD &= ~USBCMD_RUN;
+#ifdef USB_DETECT_BY_DRV
+/* fully enable driver */
+void usb_drv_attach(void)
+{
+    sleep(HZ/10);
+    _usb_drv_init(true);
+}
+#endif /* USB_DETECT_BY_DRV */
+
+void usb_drv_exit(void)
+{
+    usb_drv_stop();
 
     /* TODO : is one of these needed to save power ?
     REG_PORTSC1 |= PORTSCX_PHY_LOW_POWER_SPD;
     REG_USBCMD |= USBCMD_CTRL_RESET;
     */
 
-#if CONFIG_CPU == IMX31L
-    avic_disable_int(USB_OTG);
-#else
-    CPU_INT_DIS = USB_MASK;
-#endif
-
-    cancel_cpu_boost();
+    usb_drv_int_enable(false);
 }
 
-#if CONFIG_CPU == IMX31L
-static void __attribute__((interrupt("IRQ"))) USB_OTG_HANDLER(void)
-#else
 void usb_drv_int(void)
-#endif
 {
-    unsigned int status = REG_USBSTS;
+    unsigned int usbintr = REG_USBINTR; /* Only watch enabled ints */
+    unsigned int status = REG_USBSTS & usbintr;
 
 #if 0
     if (status & USBSTS_INT) logf("int: usb ioc");
     if (status & USBSTS_ERR) logf("int: usb err");
     if (status & USBSTS_PORT_CHANGE) logf("int: portchange");
     if (status & USBSTS_RESET) logf("int: reset");
-    if (status & USBSTS_SYS_ERR) logf("int: syserr");
 #endif
 
     /* usb transaction interrupt */
@@ -523,8 +512,18 @@ void usb_drv_int(void)
     /* reset interrupt */
     if (status & USBSTS_RESET) {
         REG_USBSTS = USBSTS_RESET;
-        bus_reset();
-        usb_core_bus_reset(); /* tell mom */
+#ifdef USB_DETECT_BY_DRV
+        if (UNLIKELY(usbintr == USBINTR_RESET_EN)) {
+            /* USB detected - detach and inform */
+            usb_drv_stop();
+            usb_drv_usb_detect_event();
+        }
+        else
+#endif
+        {
+            bus_reset();
+            usb_core_bus_reset(); /* tell mom */
+        }
     }
 
     /* port change */
@@ -588,7 +587,14 @@ int usb_drv_port_speed(void)
 
 bool usb_drv_connected(void)
 {
-    return ((REG_PORTSC1 & PORTSCX_CURRENT_CONNECT_STATUS) !=0);
+    return (REG_PORTSC1 &
+        (PORTSCX_PORT_SUSPEND | PORTSCX_CURRENT_CONNECT_STATUS))
+            == PORTSCX_CURRENT_CONNECT_STATUS;
+}
+
+bool usb_drv_powered(void)
+{
+    return (REG_OTGSC & OTGSC_B_SESSION_VALID) ? true : false;
 }
 
 void usb_drv_set_address(int address)
@@ -628,10 +634,7 @@ void usb_drv_set_test_mode(int mode)
             REG_PORTSC1 |= PORTSCX_PTC_FORCE_EN;
             break;
     }
-    REG_USBCMD &= ~USBCMD_RUN;
-    sleep(HZ/20);
-    REG_USBCMD |= USBCMD_CTRL_RESET;
-    while (REG_USBCMD & USBCMD_CTRL_RESET);
+    usb_drv_reset();
     REG_USBCMD |= USBCMD_RUN;
 }
 
@@ -735,7 +738,7 @@ void usb_drv_cancel_all_transfers(void)
     while (REG_ENDPTFLUSH);
 
     memset(td_array, 0, sizeof td_array);
-    for(i=0;i<NUM_ENDPOINTS*2;i++) {
+    for(i=0;i<USB_NUM_ENDPOINTS*2;i++) {
         if(qh_array[i].wait) {
             qh_array[i].wait=0;
             qh_array[i].status=DTD_STATUS_HALTED;
@@ -750,7 +753,7 @@ int usb_drv_request_endpoint(int dir)
 
     bit=(dir & USB_DIR_IN)? 2:1;
 
-    for (i=1; i < NUM_ENDPOINTS; i++) {
+    for (i=1; i < USB_NUM_ENDPOINTS; i++) {
         if((ep_allocation[i] & bit)!=0)
             continue;
         ep_allocation[i] |= bit;
@@ -819,7 +822,7 @@ static void transfer_completed(void)
     unsigned int mask = REG_ENDPTCOMPLETE;
     REG_ENDPTCOMPLETE = mask;
 
-    for (ep=0; ep<NUM_ENDPOINTS; ep++) {
+    for (ep=0; ep<USB_NUM_ENDPOINTS; ep++) {
         int dir;
         for (dir=0; dir<2; dir++) {
             int pipe = ep * 2 + dir;
@@ -869,13 +872,8 @@ static void bus_reset(void)
             logf("usb: double reset");
             return;
         }
-#if CONFIG_CPU == IMX31L
-        int x;
-        for (x = 0; x < 30000; x++)
-            asm volatile ("");
-#else
+
         udelay(100);
-#endif
     }
     if (REG_ENDPTPRIME) {
         logf("usb: short reset timeout");
@@ -917,7 +915,7 @@ static void init_bulk_queue_heads(void)
     /* TODO: this should take ep_allocation into account */
 
     /*** bulk ***/
-    for(i=1;i<NUM_ENDPOINTS;i++) {
+    for(i=1;i<USB_NUM_ENDPOINTS;i++) {
         qh_array[i*2].max_pkt_length = rx_packetsize << QH_MAX_PKT_LEN_POS | QH_ZLT_SEL;
         qh_array[i*2].dtd.next_td_ptr = QH_NEXT_TERMINATE;
         qh_array[i*2+1].max_pkt_length = tx_packetsize << QH_MAX_PKT_LEN_POS | QH_ZLT_SEL;
@@ -930,7 +928,7 @@ static void init_endpoints(void)
     int i;
     /* TODO: this should take ep_allocation into account */
     /* bulk */
-    for(i=1;i<NUM_ENDPOINTS;i++) {
+    for(i=1;i<USB_NUM_ENDPOINTS;i++) {
         REG_ENDPTCTRL(i) =
             EPCTRL_RX_DATA_TOGGLE_RST | EPCTRL_RX_ENABLE |
             EPCTRL_TX_DATA_TOGGLE_RST | EPCTRL_TX_ENABLE |
diff --git a/firmware/target/arm/usb-fw-pp502x.c b/firmware/target/arm/usb-fw-pp502x.c
index a41ef9a598..8a6d78675f 100644
--- a/firmware/target/arm/usb-fw-pp502x.c
+++ b/firmware/target/arm/usb-fw-pp502x.c
@@ -25,13 +25,13 @@
  ****************************************************************************/
 #include "config.h"
 #include "system.h"
+#include "usb-target.h"
 #include "usb.h"
 #include "button.h"
 #include "ata.h"
 #include "string.h"
 #include "usb_core.h"
 #include "usb_drv.h"
-#include "usb-target.h"
 
 void usb_init_device(void)
 {
@@ -94,6 +94,31 @@ void usb_enable(bool on)
     }
 }
 
+void usb_attach(void)
+{
+#ifdef USB_DETECT_BY_DRV
+    usb_drv_attach();
+#else
+    usb_enable(true);
+#endif
+}
+
+#ifdef USB_DETECT_BY_DRV
+/* Cannot tell charger pin from USB pin */
+static int usb_status = USB_EXTRACTED;
+
+void usb_connect_event(bool inserted)
+{
+    usb_status = inserted ? USB_INSERTED : USB_EXTRACTED;
+    usb_status_event(inserted ? USB_POWERED : USB_UNPOWERED);
+}
+
+/* Called during the bus reset interrupt when in detect mode */
+void usb_drv_usb_detect_event(void)
+{
+    usb_status_event(USB_INSERTED);
+}
+#else /* !USB_DETECT_BY_DRV */
 static bool usb_pin_detect(void)
 {
     bool retval = false;
@@ -110,12 +135,12 @@ static bool usb_pin_detect(void)
         retval = true;
 
 #elif defined(SANSA_C200)
-    /* GPIO H bit 1 is usb detect */
+    /* GPIO H bit 1 is usb/charger detect */
     if (GPIOH_INPUT_VAL & 0x02)
         retval = true;
 
 #elif defined(SANSA_E200)
-    /* GPIO B bit 4 is usb detect */
+    /* GPIO B bit 4 is usb/charger detect */
     if (GPIOB_INPUT_VAL & 0x10)
         retval = true;
 
@@ -137,16 +162,32 @@ static bool usb_pin_detect(void)
 
     return retval;
 }
+#endif /* USB_DETECT_BY_DRV */
 
-/* detect host or charger (INSERTED or POWERED) */
+void usb_drv_int_enable(bool enable)
+{
+    /* enable/disable USB IRQ in CPU */
+    if(enable) {
+        CPU_INT_EN = USB_MASK;
+    }
+    else {
+        CPU_INT_DIS = USB_MASK;
+    }
+}
+
+/* detect host or charger (INSERTED or EXTRACTED) */
 int usb_detect(void)
 {
+#ifdef USB_DETECT_BY_DRV
+    return usb_status;
+#else
     if(usb_pin_detect()) {
         return USB_INSERTED;
     }
     else {
         return USB_EXTRACTED;
     }
+#endif
 }
 
 #if defined(IPOD_COLOR) || defined(IPOD_4G) \
diff --git a/firmware/target/arm/usb-target.h b/firmware/target/arm/usb-target.h
index cdf6776cc1..913ad805ce 100644
--- a/firmware/target/arm/usb-target.h
+++ b/firmware/target/arm/usb-target.h
@@ -23,4 +23,11 @@
 
 void usb_init_device(void);
 
+#ifndef BOOTLOADER
+#if defined(SANSA_C200) || defined(SANSA_E200)
+#define USB_STATUS_BY_EVENT /* No USB tick */
+void usb_connect_event(bool inserted);
+#endif
+#endif /* BOOTLOADER */
+
 #endif