Changeset 1f1fa64 in mainline for uspace/drv/bus/usb/usbmid/explore.c

Timestamp:

2014-07-28T21:53:11Z (10 years ago)

Author:

Agnieszka Tabaka <nufcia@…>

Branches:

lfn, master, serial, ticket/834-toolchain-update, topic/msim-upgrade, topic/simplify-dev-export

Children:

c3b25985, f2f4c00

Parents:

cbfece7 (diff), 7eb6c96 (diff)
Note: this is a merge changeset, the changes displayed below correspond to the merge itself.
Use the (diff) links above to see all the changes relative to each parent.

Message:

Make MAC address change possible on ethip side. Merge mainline changes.

File:

• uspace/drv/bus/usb/usbmid/explore.c (modified) (5 diffs)

uspace/drv/bus/usb/usbmid/explore.c

@@ -34 +34 @@
  * Exploration of available interfaces in the USB device.
  */
+#include <ddf/driver.h>
 #include <errno.h>
 #include <str_error.h>
@@ -70 +71 @@
  * @param config_descriptor_size Size of configuration descriptor in bytes.
  * @param list List where to add the interfaces.
- */
-static void create_interfaces(const uint8_t *config_descriptor,
-    size_t config_descriptor_size, list_t *list)
+ * @return EOK on success, ENOMEM if out of memory.
+ */
+static int create_interfaces(usb_mid_t *mid, const uint8_t *config_descriptor,
+    size_t config_descriptor_size)
 {
         const usb_dp_parser_data_t data = {
@@ -101 +103 @@
 
                 /* Skip alternate interfaces. */
-                if (interface_in_list(list, interface->interface_number)) {
+                if (interface_in_list(&mid->interface_list,
+                    interface->interface_number)) {
                         /* TODO: add the alternatives and create match ids
                          * for them. */
                         continue;
                 }
-                usbmid_interface_t *iface = malloc(sizeof(usbmid_interface_t));
-                if (iface == NULL) {
-                        //TODO: Do something about that failure.
-                        break;
-                }
+
+                /* Create the function */
+                ddf_fun_t *fun = ddf_fun_create(mid->dev, fun_inner, NULL);
+                if (fun == NULL)
+                        goto error;
+
+                usbmid_interface_t *iface = ddf_fun_data_alloc(fun,
+                    sizeof(usbmid_interface_t));
+                if (iface == NULL)
+                        goto error;
 
                 link_initialize(&iface->link);
-                iface->fun = NULL;
+                iface->fun = fun;
                 iface->interface_no = interface->interface_number;
                 iface->interface = interface;
 
-                list_append(&iface->link, list);
-        }
+                list_append(&iface->link, &mid->interface_list);
+        }
+
+        return EOK;
+error:
+        while (!list_empty(&mid->interface_list)) {
+                link_t *link = list_first(&mid->interface_list);
+                usbmid_interface_t *iface = list_get_instance(link,
+                    usbmid_interface_t, link);
+
+                ddf_fun_destroy(iface->fun);
+        }
+
+        return ENOMEM;
 }
 
@@ -165 +185 @@
         }
 
+        usb_mid->dev = dev->ddf_dev;
+
         /* Create control function. */
         usb_mid->ctl_fun = ddf_fun_create(dev->ddf_dev, fun_exposed, "ctl");
@@ -182 +204 @@
         }
 
-
         /* Create interface children. */
         list_initialize(&usb_mid->interface_list);
-        create_interfaces(config_descriptor_raw, config_descriptor_size,
-            &usb_mid->interface_list);
+        create_interfaces(usb_mid, config_descriptor_raw, config_descriptor_size);
 
         /* Start child function for every interface. */