Ignore:
File:
1 edited

Legend:

Unmodified
Added
Removed
  • uspace/drv/bus/usb/usbmid/explore.c

    r87a3df7f rfeeac0d  
    3434 * Exploration of available interfaces in the USB device.
    3535 */
    36 #include <ddf/driver.h>
    3736#include <errno.h>
    3837#include <str_error.h>
     
    7170 * @param config_descriptor_size Size of configuration descriptor in bytes.
    7271 * @param list List where to add the interfaces.
    73  * @return EOK on success, ENOMEM if out of memory.
    74  */
    75 static int create_interfaces(usb_mid_t *mid, const uint8_t *config_descriptor,
    76     size_t config_descriptor_size)
     72 */
     73static void create_interfaces(const uint8_t *config_descriptor,
     74    size_t config_descriptor_size, list_t *list)
    7775{
    7876        const usb_dp_parser_data_t data = {
     
    103101
    104102                /* Skip alternate interfaces. */
    105                 if (interface_in_list(&mid->interface_list,
    106                     interface->interface_number)) {
     103                if (interface_in_list(list, interface->interface_number)) {
    107104                        /* TODO: add the alternatives and create match ids
    108105                         * for them. */
    109106                        continue;
    110107                }
    111 
    112                 /* Create the function */
    113                 ddf_fun_t *fun = ddf_fun_create(mid->dev, fun_inner, NULL);
    114                 if (fun == NULL)
    115                         goto error;
    116 
    117                 usbmid_interface_t *iface = ddf_fun_data_alloc(fun,
    118                     sizeof(usbmid_interface_t));
    119                 if (iface == NULL)
    120                         goto error;
     108                usbmid_interface_t *iface = malloc(sizeof(usbmid_interface_t));
     109                if (iface == NULL) {
     110                        //TODO: Do something about that failure.
     111                        break;
     112                }
    121113
    122114                link_initialize(&iface->link);
    123                 iface->fun = fun;
     115                iface->fun = NULL;
    124116                iface->interface_no = interface->interface_number;
    125117                iface->interface = interface;
    126118
    127                 list_append(&iface->link, &mid->interface_list);
    128         }
    129 
    130         return EOK;
    131 error:
    132         while (!list_empty(&mid->interface_list)) {
    133                 link_t *link = list_first(&mid->interface_list);
    134                 usbmid_interface_t *iface = list_get_instance(link,
    135                     usbmid_interface_t, link);
    136 
    137                 ddf_fun_destroy(iface->fun);
    138         }
    139 
    140         return ENOMEM;
     119                list_append(&iface->link, list);
     120        }
    141121}
    142122
     
    185165        }
    186166
    187         usb_mid->dev = dev->ddf_dev;
    188 
    189167        /* Create control function. */
    190168        usb_mid->ctl_fun = ddf_fun_create(dev->ddf_dev, fun_exposed, "ctl");
     
    204182        }
    205183
     184
    206185        /* Create interface children. */
    207186        list_initialize(&usb_mid->interface_list);
    208         create_interfaces(usb_mid, config_descriptor_raw, config_descriptor_size);
     187        create_interfaces(config_descriptor_raw, config_descriptor_size,
     188            &usb_mid->interface_list);
    209189
    210190        /* Start child function for every interface. */
Note: See TracChangeset for help on using the changeset viewer.