Changes in uspace/drv/ehci-hcd/pci.c [c060090:17d1542] in mainline

File:

• uspace/drv/ehci-hcd/pci.c (modified) (8 diffs)

uspace/drv/ehci-hcd/pci.c

@@ -87 +87 @@
 } while(0)
 
-static int pci_read32(const ddf_dev_t *dev, int address, uint32_t *value)
+static int pci_read32(ddf_dev_t *dev, int address, uint32_t *value)
 {
         PCI_READ(32);
 }
-static int pci_read16(const ddf_dev_t *dev, int address, uint16_t *value)
+static int pci_read16(ddf_dev_t *dev, int address, uint16_t *value)
 {
         PCI_READ(16);
 }
-static int pci_read8(const ddf_dev_t *dev, int address, uint8_t *value)
+static int pci_read8(ddf_dev_t *dev, int address, uint8_t *value)
 {
         PCI_READ(8);
@@ -115 +115 @@
 } while(0)
 
-static int pci_write32(const ddf_dev_t *dev, int address, uint32_t value)
+static int pci_write32(ddf_dev_t *dev, int address, uint32_t value)
 {
         PCI_WRITE(32);
 }
-static int pci_write16(const ddf_dev_t *dev, int address, uint16_t value)
+static int pci_write16(ddf_dev_t *dev, int address, uint16_t value)
 {
         PCI_WRITE(16);
 }
-static int pci_write8(const ddf_dev_t *dev, int address, uint8_t value)
+static int pci_write8(ddf_dev_t *dev, int address, uint8_t value)
 {
         PCI_WRITE(8);
@@ -136 +136 @@
  * @return Error code.
  */
-int pci_get_my_registers(const ddf_dev_t *dev,
+int pci_get_my_registers(ddf_dev_t *dev,
     uintptr_t *mem_reg_address, size_t *mem_reg_size, int *irq_no)
 {
@@ -206 +206 @@
  * @return Error code.
  */
-int pci_enable_interrupts(const ddf_dev_t *device)
+int pci_enable_interrupts(ddf_dev_t *device)
 {
         const int parent_phone =
@@ -223 +223 @@
  * @return Error code.
  */
-int pci_disable_legacy(
-    const ddf_dev_t *device, uintptr_t reg_base, size_t reg_size, int irq)
+int pci_disable_legacy(ddf_dev_t *device)
 {
         assert(device);
@@ -237 +236 @@
         } else (void)0
 
-        /* Map EHCI registers */
+        uintptr_t reg_base = 0;
+        size_t reg_size = 0;
+        int irq = 0;
+
+        int ret = pci_get_my_registers(device, &reg_base, &reg_size, &irq);
+        CHECK_RET_RETURN(ret, "Failed(%d) to get EHCI registers.\n", ret);
+
+        usb_log_info("EHCI: Memory registers:%p size: %zu irq:%d.\n",
+            (void *) reg_base, reg_size, irq);
+
+
+        /* map EHCI registers */
         void *regs = NULL;
-        int ret = pio_enable((void*)reg_base, reg_size, &regs);
+        ret = pio_enable((void*)reg_base, reg_size, &regs);
         CHECK_RET_RETURN(ret, "Failed(%d) to map registers %p.\n",
             ret, (void *) reg_base);
@@ -306 +316 @@
                         CHECK_RET_RETURN(ret,
                             "Failed(%d) zero USBLEGCTLSTS.\n", ret);
-                        udelay(10);
                         ret = pci_read32(
                             device, eecp + USBLEGCTLSTS_OFFSET, &usblegctlsts);
@@ -341 +350 @@
         usb_log_debug("USBCMD value: %x.\n", *usbcmd);
         if (*usbcmd & USBCMD_RUN) {
+                *usbcmd = 0;
+                /* Wait until hc is halted */
+                while ((*usbsts & USBSTS_HALTED) != 0);
                 *usbsts = 0x3f; /* ack all interrupts */
                 *usbint = 0; /* disable all interrutps */
                 *usbconf = 0; /* relase control of RH ports */
-
-                *usbcmd = 0;
-                /* Wait until hc is halted */
-                while ((*usbsts & USBSTS_HALTED) == 0);
                 usb_log_info("EHCI turned off.\n");
         } else {