Changes in uspace/lib/usbdev/src/recognise.c [ffa96c2:feeac0d] in mainline

File:

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

uspace/lib/usbdev/src/recognise.c

@@ -33 +33 @@
  * Functions for recognition of attached devices.
  */
+
+/** XXX Fix this */
+#define _DDF_DATA_IMPLANT
 
 #include <sys/types.h>
@@ -315 +318 @@
  */
 int usb_device_register_child_in_devman(usb_pipe_t *ctrl_pipe,
-    ddf_dev_t *parent, ddf_fun_t *fun, ddf_dev_ops_t *dev_ops)
+    ddf_dev_t *parent, ddf_dev_ops_t *dev_ops, void *dev_data,
+    ddf_fun_t **child_fun)
 {
-        if (ctrl_pipe == NULL)
+        if (child_fun == NULL || ctrl_pipe == NULL)
                 return EINVAL;
         
-        if (!dev_ops && ddf_fun_data_get(fun) != NULL) {
+        if (!dev_ops && dev_data) {
                 usb_log_warning("Using standard fun ops with arbitrary "
                     "driver data. This does not have to work.\n");
@@ -330 +334 @@
             (size_t) atomic_preinc(&device_name_index);
         
+        ddf_fun_t *child = NULL;
         int rc;
         
@@ -343 +348 @@
         }
         
-        rc = ddf_fun_set_name(fun, child_name);
-        if (rc != EOK)
+        child = ddf_fun_create(parent, fun_inner, child_name);
+        if (child == NULL) {
+                rc = ENOMEM;
                 goto failure;
+        }
         
         if (dev_ops != NULL)
-                ddf_fun_set_ops(fun, dev_ops);
+                ddf_fun_set_ops(child, dev_ops);
         else
-                ddf_fun_set_ops(fun, &child_ops);
+                ddf_fun_set_ops(child, &child_ops);
+        
+        ddf_fun_data_implant(child, dev_data);
         
         /*
@@ -356 +365 @@
          * driver data if there is no other data
          */
-        if (ddf_fun_data_get(fun) == NULL) {
+        if (!dev_data) {
                 usb_hub_attached_device_t *new_device = ddf_fun_data_alloc(
-                    fun, sizeof(usb_hub_attached_device_t));
+                    child, sizeof(usb_hub_attached_device_t));
                 if (!new_device) {
                         rc = ENOMEM;
@@ -365 +374 @@
                 
                 new_device->address = ctrl_pipe->wire->address;
-                new_device->fun = fun;
+                new_device->fun = child;
         }
         
@@ -375 +384 @@
         
         list_foreach(match_ids.ids, link, match_id_t, match_id) {
-                rc = ddf_fun_add_match_id(fun, match_id->id, match_id->score);
+                rc = ddf_fun_add_match_id(child, match_id->id, match_id->score);
                 if (rc != EOK) {
                         clean_match_ids(&match_ids);
@@ -384 +393 @@
         clean_match_ids(&match_ids);
         
-        rc = ddf_fun_bind(fun);
+        rc = ddf_fun_bind(child);
         if (rc != EOK)
                 goto failure;
         
+        *child_fun = child;
         return EOK;
         
 failure:
+        if (child != NULL) {
+                /* This takes care of match_id deallocation as well. */
+                ddf_fun_destroy(child);
+        }
+        
         return rc;
 }