Changes in uspace/drv/bus/usb/ehci/res.c [5a6cc679:b7fd2a0] in mainline

File:

• uspace/drv/bus/usb/ehci/res.c (modified) (9 diffs)

uspace/drv/bus/usb/ehci/res.c

@@ -45 +45 @@
 #include <pci_dev_iface.h>
 
-#include "hc.h"
 #include "res.h"
 #include "ehci_regs.h"
@@ -74 +73 @@
             eecp + USBLEGSUP_OFFSET, &usblegsup);
         if (ret != EOK) {
-                usb_log_error("Failed to read USBLEGSUP: %s.", str_error(ret));
-                return ret;
-        }
-        usb_log_debug2("USBLEGSUP: %" PRIx32 ".", usblegsup);
+                usb_log_error("Failed to read USBLEGSUP: %s.\n", str_error(ret));
+                return ret;
+        }
+        usb_log_debug2("USBLEGSUP: %" PRIx32 ".\n", usblegsup);
 
         /* Request control from firmware/BIOS by writing 1 to highest
          * byte. (OS Control semaphore)*/
-        usb_log_debug("Requesting OS control.");
+        usb_log_debug("Requesting OS control.\n");
         ret = pci_config_space_write_8(parent_sess,
             eecp + USBLEGSUP_OFFSET + 3, 1);
         if (ret != EOK) {
-                usb_log_error("Failed to request OS EHCI control: %s.",
+                usb_log_error("Failed to request OS EHCI control: %s.\n",
                     str_error(ret));
                 return ret;
@@ -103 +102 @@
 
         if ((usblegsup & USBLEGSUP_BIOS_CONTROL) == 0) {
-                usb_log_info("BIOS released control after %zu usec.", wait);
+                usb_log_info("BIOS released control after %zu usec.\n", wait);
                 return EOK;
         }
@@ -109 +108 @@
         /* BIOS failed to hand over control, this should not happen. */
         usb_log_warning( "BIOS failed to release control after "
-            "%zu usecs, force it.", wait);
+            "%zu usecs, force it.\n", wait);
         ret = pci_config_space_write_32(parent_sess,
             eecp + USBLEGSUP_OFFSET, USBLEGSUP_OS_CONTROL);
         if (ret != EOK) {
-                usb_log_error("Failed to force OS control: %s.",
+                usb_log_error("Failed to force OS control: %s.\n",
                     str_error(ret));
                 return ret;
@@ -130 +129 @@
                     eecp + USBLEGCTLSTS_OFFSET, &usblegctlsts);
                 if (ret != EOK) {
-                        usb_log_error("Failed to get USBLEGCTLSTS: %s.",
+                        usb_log_error("Failed to get USBLEGCTLSTS: %s.\n",
                             str_error(ret));
                         return ret;
                 }
-                usb_log_debug2("USBLEGCTLSTS: %" PRIx32 ".", usblegctlsts);
+                usb_log_debug2("USBLEGCTLSTS: %" PRIx32 ".\n", usblegctlsts);
                 /*
                  * Zero SMI enables in legacy control register.
@@ -143 +142 @@
                     eecp + USBLEGCTLSTS_OFFSET, 0xe0000000);
                 if (ret != EOK) {
-                        usb_log_error("Failed to zero USBLEGCTLSTS: %s",
+                        usb_log_error("Failed to zero USBLEGCTLSTS: %s\n",
                             str_error(ret));
                         return ret;
@@ -153 +152 @@
                     eecp + USBLEGCTLSTS_OFFSET, &usblegctlsts);
                 if (ret != EOK) {
-                        usb_log_error("Failed to get USBLEGCTLSTS 2: %s.",
+                        usb_log_error("Failed to get USBLEGCTLSTS 2: %s.\n",
                             str_error(ret));
                         return ret;
                 }
-                usb_log_debug2("Zeroed USBLEGCTLSTS: %" PRIx32 ".",
+                usb_log_debug2("Zeroed USBLEGCTLSTS: %" PRIx32 ".\n",
                     usblegctlsts);
         }
@@ -165 +164 @@
             eecp + USBLEGSUP_OFFSET, &usblegsup);
         if (ret != EOK) {
-                usb_log_error("Failed to read USBLEGSUP: %s.",
-                    str_error(ret));
-                return ret;
-        }
-        usb_log_debug2("USBLEGSUP: %" PRIx32 ".", usblegsup);
+                usb_log_error("Failed to read USBLEGSUP: %s.\n",
+                    str_error(ret));
+                return ret;
+        }
+        usb_log_debug2("USBLEGSUP: %" PRIx32 ".\n", usblegsup);
         return ret;
 }
 
-errno_t disable_legacy(hc_device_t *hcd)
+errno_t disable_legacy(ddf_dev_t *device)
 {
-        hc_t *hc = hcd_to_hc(hcd);
-
-        async_sess_t *parent_sess = ddf_dev_parent_sess_get(hcd->ddf_dev);
+        assert(device);
+
+        async_sess_t *parent_sess = ddf_dev_parent_sess_get(device);
         if (parent_sess == NULL)
                 return ENOMEM;
 
-        usb_log_debug("Disabling EHCI legacy support.");
-
-        const uint32_t hcc_params = EHCI_RD(hc->caps->hccparams);
-        usb_log_debug2("Value of hcc params register: %x.", hcc_params);
+        usb_log_debug("Disabling EHCI legacy support.\n");
+
+        hw_res_list_parsed_t res;
+        hw_res_list_parsed_init(&res);
+        errno_t ret = hw_res_get_list_parsed(parent_sess, &res, 0);
+        if (ret != EOK) {
+                usb_log_error("Failed to get resource list: %s\n",
+                    str_error(ret));
+                goto clean;
+        }
+
+        if (res.mem_ranges.count < 1) {
+                usb_log_error("Incorrect mem range count: %zu",
+                    res.mem_ranges.count);
+                ret = EINVAL;
+                goto clean;
+        }
+
+        /* Map EHCI registers */
+        void *regs = NULL;
+        ret = pio_enable_range(&res.mem_ranges.ranges[0], &regs);
+        if (ret != EOK) {
+                usb_log_error("Failed to map registers %p: %s.\n",
+                    RNGABSPTR(res.mem_ranges.ranges[0]), str_error(ret));
+                goto clean;
+        }
+
+        usb_log_debug("Registers mapped at: %p.\n", regs);
+
+        ehci_caps_regs_t *ehci_caps = regs;
+
+        const uint32_t hcc_params = EHCI_RD(ehci_caps->hccparams);
+        usb_log_debug2("Value of hcc params register: %x.\n", hcc_params);
 
         /* Read value of EHCI Extended Capabilities Pointer
@@ -190 +218 @@
         const uint32_t eecp =
             (hcc_params >> EHCI_CAPS_HCC_EECP_SHIFT) & EHCI_CAPS_HCC_EECP_MASK;
-        usb_log_debug2("Value of EECP: %x.", eecp);
-
-        int ret = disable_extended_caps(parent_sess, eecp);
-        if (ret != EOK) {
-                usb_log_error("Failed to disable extended capabilities: %s.",
+        usb_log_debug2("Value of EECP: %x.\n", eecp);
+
+        ret = disable_extended_caps(parent_sess, eecp);
+        if (ret != EOK) {
+                usb_log_error("Failed to disable extended capabilities: %s.\n",
                     str_error(ret));
                     goto clean;
         }
 clean:
-        async_hangup(parent_sess);
+        //TODO unmap registers
+        hw_res_list_parsed_clean(&res);
         return ret;
 }