Changes in uspace/lib/usbdev/src/recognise.c [77ad86c:162726b] in mainline

File:

• uspace/lib/usbdev/src/recognise.c (modified) (11 diffs)

uspace/lib/usbdev/src/recognise.c

@@ -33 +33 @@
  * Functions for recognition of attached devices.
  */
-
 #include <sys/types.h>
 #include <fibril_synch.h>
-#include <usb/debug.h>
-#include <usb/dev/hub.h>
 #include <usb/dev/pipes.h>
 #include <usb/dev/recognise.h>
@@ -47 +44 @@
 #include <assert.h>
 
+/** Index to append after device name for uniqueness. */
+static size_t device_name_index = 0;
+/** Mutex guard for device_name_index. */
+static FIBRIL_MUTEX_INITIALIZE(device_name_index_mutex);
+
 /** DDF operations of child devices. */
-static ddf_dev_ops_t child_ops = {
+ddf_dev_ops_t child_ops = {
         .interfaces[USB_DEV_IFACE] = &usb_iface_hub_child_impl
 };
@@ -62 +64 @@
 #define BCD_ARGS(a) BCD_INT((a)), BCD_FRAC((a))
 
+/* FIXME: make this dynamic */
+#define MATCH_STRING_MAX 256
+
 /** Add formatted match id.
  *
@@ -70 +75 @@
  */
 static int usb_add_match_id(match_id_list_t *matches, int score,
-    const char *match_str)
+    const char *format, ...)
 {
-        assert(matches);
-
-        match_id_t *match_id = create_match_id();
+        char *match_str = NULL;
+        match_id_t *match_id = NULL;
+        int rc;
+        
+        match_str = malloc(MATCH_STRING_MAX + 1);
+        if (match_str == NULL) {
+                rc = ENOMEM;
+                goto failure;
+        }
+
+        /*
+         * FIXME: replace with dynamic allocation of exact size
+         */
+        va_list args;
+        va_start(args, format   );
+        vsnprintf(match_str, MATCH_STRING_MAX, format, args);
+        match_str[MATCH_STRING_MAX] = 0;
+        va_end(args);
+
+        match_id = create_match_id();
         if (match_id == NULL) {
-                return ENOMEM;
+                rc = ENOMEM;
+                goto failure;
         }
 
@@ -84 +107 @@
 
         return EOK;
+        
+failure:
+        if (match_str != NULL) {
+                free(match_str);
+        }
+        if (match_id != NULL) {
+                match_id->id = NULL;
+                delete_match_id(match_id);
+        }
+        
+        return rc;
 }
 
@@ -95 +129 @@
 #define ADD_MATCHID_OR_RETURN(match_ids, score, format, ...) \
         do { \
-                char *str = NULL; \
-                int __rc = asprintf(&str, format, ##__VA_ARGS__); \
-                if (__rc > 0) { \
-                        __rc = usb_add_match_id((match_ids), (score), str); \
-                } \
+                int __rc = usb_add_match_id((match_ids), (score), \
+                    format, ##__VA_ARGS__); \
                 if (__rc != EOK) { \
-                        free(str); \
                         return __rc; \
                 } \
@@ -120 +150 @@
     match_id_list_t *matches)
 {
-        if (desc_interface == NULL || matches == NULL) {
+        if (desc_interface == NULL) {
+                return EINVAL;
+        }
+        if (matches == NULL) {
                 return EINVAL;
         }
@@ -281 +314 @@
     match_id_list_t *matches)
 {
-        assert(ctrl_pipe);
         int rc;
         /*
@@ -304 +336 @@
 /** Probe for device kind and register it in devman.
  *
- * @param[in] ctrl_pipe Control pipe to the device.
+ * @param[in] address Address of the (unknown) attached device.
+ * @param[in] hc_handle Handle of the host controller.
  * @param[in] parent Parent device.
- * @param[in] dev_ops Child device ops. Default child_ops will be used if NULL.
+ * @param[in] dev_ops Child device ops.
  * @param[in] dev_data Arbitrary pointer to be stored in the child
  *      as @c driver_data.
@@ -312 +345 @@
  *      will be written.
  * @return Error code.
- *
- */
-int usb_device_register_child_in_devman(usb_pipe_t *ctrl_pipe,
-    ddf_dev_t *parent, ddf_dev_ops_t *dev_ops, void *dev_data,
-    ddf_fun_t **child_fun)
+ */
+int usb_device_register_child_in_devman(usb_address_t address,
+    devman_handle_t hc_handle, ddf_dev_t *parent,
+    ddf_dev_ops_t *dev_ops, void *dev_data, ddf_fun_t **child_fun)
 {
-        if (child_fun == NULL || ctrl_pipe == NULL)
-                return EINVAL;
-        
-        if (!dev_ops && dev_data) {
-                usb_log_warning("Using standard fun ops with arbitrary "
-                    "driver data. This does not have to work.\n");
-        }
-        
-        /** Index to append after device name for uniqueness. */
-        static atomic_t device_name_index = {0};
-        const size_t this_device_name_index =
-            (size_t) atomic_preinc(&device_name_index);
-        
+        size_t this_device_name_index;
+
+        fibril_mutex_lock(&device_name_index_mutex);
+        this_device_name_index = device_name_index;
+        device_name_index++;
+        fibril_mutex_unlock(&device_name_index_mutex);
+
         ddf_fun_t *child = NULL;
+        char *child_name = NULL;
         int rc;
-        
+        usb_device_connection_t dev_connection;
+        usb_pipe_t ctrl_pipe;
+
+        rc = usb_device_connection_initialize(&dev_connection, hc_handle, address);
+        if (rc != EOK) {
+                goto failure;
+        }
+
+        rc = usb_pipe_initialize_default_control(&ctrl_pipe,
+            &dev_connection);
+        if (rc != EOK) {
+                goto failure;
+        }
+        rc = usb_pipe_probe_default_control(&ctrl_pipe);
+        if (rc != EOK) {
+                goto failure;
+        }
+
         /*
          * TODO: Once the device driver framework support persistent
          * naming etc., something more descriptive could be created.
          */
-        char child_name[12];  /* The format is: "usbAB_aXYZ", length 11 */
-        rc = snprintf(child_name, sizeof(child_name),
-            "usb%02zu_a%d", this_device_name_index, ctrl_pipe->wire->address);
+        rc = asprintf(&child_name, "usb%02zu_a%d",
+            this_device_name_index, address);
         if (rc < 0) {
                 goto failure;
         }
-        
+
         child = ddf_fun_create(parent, fun_inner, child_name);
         if (child == NULL) {
@@ -350 +393 @@
                 goto failure;
         }
-        
-        if (dev_ops != NULL)
+
+        if (dev_ops != NULL) {
                 child->ops = dev_ops;
-        else
+        } else {
                 child->ops = &child_ops;
-        
+        }
+
         child->driver_data = dev_data;
-        /*
-         * Store the attached device in fun
-         * driver data if there is no other data
-         */
-        if (!dev_data) {
-                usb_hub_attached_device_t *new_device = ddf_fun_data_alloc(
-                    child, sizeof(usb_hub_attached_device_t));
-                if (!new_device) {
-                        rc = ENOMEM;
-                        goto failure;
-                }
-                
-                new_device->address = ctrl_pipe->wire->address;
-                new_device->fun = child;
-        }
-        
-        rc = usb_device_create_match_ids(ctrl_pipe, &child->match_ids);
-        if (rc != EOK)
-                goto failure;
-        
+
+        rc = usb_device_create_match_ids(&ctrl_pipe, &child->match_ids);
+        if (rc != EOK) {
+                goto failure;
+        }
+
         rc = ddf_fun_bind(child);
-        if (rc != EOK)
-                goto failure;
-        
-        *child_fun = child;
+        if (rc != EOK) {
+                goto failure;
+        }
+
+        if (child_fun != NULL) {
+                *child_fun = child;
+        }
+
         return EOK;
-        
+
 failure:
         if (child != NULL) {
-                /* We know nothing about the data if it came from outside. */
-                if (dev_data)
-                        child->driver_data = NULL;
-                
+                child->name = NULL;
                 /* This takes care of match_id deallocation as well. */
                 ddf_fun_destroy(child);
         }
-        
+        if (child_name != NULL) {
+                free(child_name);
+        }
+
         return rc;
 }
 
+
 /**
  * @}