Changes in uspace/drv/bus/usb/uhcirh/port.c [612af1a0:5203e256] in mainline

File:

• uspace/drv/bus/usb/uhcirh/port.c (modified) (9 diffs)

uspace/drv/bus/usb/uhcirh/port.c

@@ -37 +37 @@
 #include <str_error.h>
 #include <async.h>
-#include <devman.h>
 
 #include <usb/usb.h>    /* usb_address_t */
+#include <usb/dev/hub.h>    /* usb_hc_new_device_wrapper */
 #include <usb/debug.h>
 
 #include "port.h"
 
-#define MAX_ERROR_COUNT 5
-
 static int uhci_port_check(void *port);
-static int uhci_port_reset_enable(void *arg);
+static int uhci_port_reset_enable(int portno, void *arg);
 static int uhci_port_new_device(uhci_port_t *port, usb_speed_t speed);
 static int uhci_port_remove_device(uhci_port_t *port);
@@ -102 +100 @@
         port->number = number;
         port->wait_period_usec = usec;
-        port->attached_device.fun = NULL;
-        port->attached_device.address = -1;
+        port->attached_device = 0;
         port->rh = rh;
 
@@ -153 +150 @@
         assert(instance);
 
-        unsigned allowed_failures = MAX_ERROR_COUNT;
-#define CHECK_RET_FAIL(ret, msg...) \
-        if (ret != EOK) { \
-                usb_log_error(msg); \
-                if (!(allowed_failures-- > 0)) { \
-                        usb_log_fatal( \
-                           "Maximum number of failures reached, " \
-                           "bailing out.\n"); \
-                        return ret; \
-                } \
-                continue; \
-        } else (void)0
-
         while (1) {
                 async_usleep(instance->wait_period_usec);
@@ -183 +167 @@
                     instance->id_string, port_status);
 
-                int ret = usb_hc_connection_open(&instance->hc_connection);
-                CHECK_RET_FAIL(ret, "%s: Failed to connect to HC %s.\n",
-                    instance->id_string, str_error(ret));
-
                 /* Remove any old device */
-                if (instance->attached_device.fun) {
+                if (instance->attached_device) {
+                        usb_log_debug2("%s: Removing device.\n",
+                            instance->id_string);
                         uhci_port_remove_device(instance);
                 }
 
+                int ret =
+                    usb_hc_connection_open(&instance->hc_connection);
+                if (ret != EOK) {
+                        usb_log_error("%s: Failed to connect to HC.",
+                            instance->id_string);
+                        continue;
+                }
+
                 if ((port_status & STATUS_CONNECTED) != 0) {
-                        /* New device, this will take care of WC bits */
+                        /* New device */
                         const usb_speed_t speed =
                             ((port_status & STATUS_LOW_SPEED) != 0) ?
@@ -206 +196 @@
 
                 ret = usb_hc_connection_close(&instance->hc_connection);
-                CHECK_RET_FAIL(ret, "%s: Failed to disconnect from hc: %s.\n",
-                    instance->id_string, str_error(ret));
+                if (ret != EOK) {
+                        usb_log_error("%s: Failed to disconnect.",
+                            instance->id_string);
+                }
         }
         return EOK;
@@ -220 +212 @@
  * Resets and enables the ub port.
  */
-int uhci_port_reset_enable(void *arg)
+int uhci_port_reset_enable(int portno, void *arg)
 {
         uhci_port_t *port = arg;
@@ -264 +256 @@
         usb_log_debug("%s: Detected new device.\n", port->id_string);
 
-        int ret, count = MAX_ERROR_COUNT;
+        int ret, count = 0;
+        usb_address_t dev_addr;
         do {
                 ret = usb_hc_new_device_wrapper(port->rh, &port->hc_connection,
-                    speed, uhci_port_reset_enable, port,
-                    &port->attached_device.address, NULL, NULL,
-                    &port->attached_device.fun);
-        } while (ret != EOK && count-- > 0);
+                    speed, uhci_port_reset_enable, port->number, port,
+                    &dev_addr, &port->attached_device, NULL, NULL, NULL);
+        } while (ret != EOK && ++count < 4);
 
         if (ret != EOK) {
@@ -279 +271 @@
         }
 
-        usb_log_info("%s: New device, address %d (handle %" PRIun ").\n",
-            port->id_string, port->attached_device.address,
-            port->attached_device.fun->handle);
+        usb_log_info("New device at port %u, address %d (handle %" PRIun ").\n",
+            port->number, dev_addr, port->attached_device);
         return EOK;
 }
@@ -287 +278 @@
 /** Remove device.
  *
- * @param[in] port Port instance to use.
- * @return Error code.
+ * @param[in] port Memory structure to use.
+ * @return Error code.
+ *
+ * Does not work, DDF does not support device removal.
+ * Does not even free used USB address (it would be dangerous if tis driver
+ * is still running).
  */
 int uhci_port_remove_device(uhci_port_t *port)
 {
-        assert(port);
-        /* There is nothing to remove. */
-        if (port->attached_device.fun == NULL) {
-                usb_log_warning("%s: Removed a ghost device.\n",
-                    port->id_string);
-                assert(port->attached_device.address == -1);
-                return EOK;
-        }
-
-        usb_log_debug("%s: Removing device.\n", port->id_string);
-
-        /* Stop driver first */
-        int ret = ddf_fun_unbind(port->attached_device.fun);
-        if (ret != EOK) {
-                usb_log_error("%s: Failed to remove child function: %s.\n",
-                   port->id_string, str_error(ret));
-                return ret;
-        }
-        ddf_fun_destroy(port->attached_device.fun);
-        port->attached_device.fun = NULL;
-
-        /* Driver stopped, free used address */
-        ret = usb_hc_unregister_device(&port->hc_connection,
-            port->attached_device.address);
-        if (ret != EOK) {
-                usb_log_error("%s: Failed to unregister address of removed "
-                    "device: %s.\n", port->id_string, str_error(ret));
-                return ret;
-        }
-        port->attached_device.address = -1;
-
-        usb_log_info("%s: Removed attached device.\n", port->id_string);
-        return EOK;
+        usb_log_error("%s: Don't know how to remove device %" PRIun ".\n",
+            port->id_string, port->attached_device);
+        port->attached_device = 0;
+        return ENOTSUP;
 }
 /*----------------------------------------------------------------------------*/