1de31213fSSimon Glass /* 2de31213fSSimon Glass * (C) Copyright 2015 Google, Inc 3de31213fSSimon Glass * Written by Simon Glass <sjg@chromium.org> 4de31213fSSimon Glass * 50566e240SSimon Glass * usb_match_device() modified from Linux kernel v4.0. 60566e240SSimon Glass * 7de31213fSSimon Glass * SPDX-License-Identifier: GPL-2.0+ 8de31213fSSimon Glass */ 9de31213fSSimon Glass 10de31213fSSimon Glass #include <common.h> 11de31213fSSimon Glass #include <dm.h> 12de31213fSSimon Glass #include <errno.h> 13de31213fSSimon Glass #include <usb.h> 14de31213fSSimon Glass #include <dm/device-internal.h> 15de31213fSSimon Glass #include <dm/lists.h> 16de31213fSSimon Glass #include <dm/root.h> 17de31213fSSimon Glass #include <dm/uclass-internal.h> 18de31213fSSimon Glass 19de31213fSSimon Glass DECLARE_GLOBAL_DATA_PTR; 20de31213fSSimon Glass 21de31213fSSimon Glass extern bool usb_started; /* flag for the started/stopped USB status */ 22de31213fSSimon Glass static bool asynch_allowed; 23de31213fSSimon Glass 24de31213fSSimon Glass int usb_disable_asynch(int disable) 25de31213fSSimon Glass { 26de31213fSSimon Glass int old_value = asynch_allowed; 27de31213fSSimon Glass 28de31213fSSimon Glass asynch_allowed = !disable; 29de31213fSSimon Glass return old_value; 30de31213fSSimon Glass } 31de31213fSSimon Glass 32de31213fSSimon Glass int submit_int_msg(struct usb_device *udev, unsigned long pipe, void *buffer, 33de31213fSSimon Glass int length, int interval) 34de31213fSSimon Glass { 35de31213fSSimon Glass struct udevice *bus = udev->controller_dev; 36de31213fSSimon Glass struct dm_usb_ops *ops = usb_get_ops(bus); 37de31213fSSimon Glass 38de31213fSSimon Glass if (!ops->interrupt) 39de31213fSSimon Glass return -ENOSYS; 40de31213fSSimon Glass 41de31213fSSimon Glass return ops->interrupt(bus, udev, pipe, buffer, length, interval); 42de31213fSSimon Glass } 43de31213fSSimon Glass 44de31213fSSimon Glass int submit_control_msg(struct usb_device *udev, unsigned long pipe, 45de31213fSSimon Glass void *buffer, int length, struct devrequest *setup) 46de31213fSSimon Glass { 47de31213fSSimon Glass struct udevice *bus = udev->controller_dev; 48de31213fSSimon Glass struct dm_usb_ops *ops = usb_get_ops(bus); 49de31213fSSimon Glass 50de31213fSSimon Glass if (!ops->control) 51de31213fSSimon Glass return -ENOSYS; 52de31213fSSimon Glass 53de31213fSSimon Glass return ops->control(bus, udev, pipe, buffer, length, setup); 54de31213fSSimon Glass } 55de31213fSSimon Glass 56de31213fSSimon Glass int submit_bulk_msg(struct usb_device *udev, unsigned long pipe, void *buffer, 57de31213fSSimon Glass int length) 58de31213fSSimon Glass { 59de31213fSSimon Glass struct udevice *bus = udev->controller_dev; 60de31213fSSimon Glass struct dm_usb_ops *ops = usb_get_ops(bus); 61de31213fSSimon Glass 62de31213fSSimon Glass if (!ops->bulk) 63de31213fSSimon Glass return -ENOSYS; 64de31213fSSimon Glass 65de31213fSSimon Glass return ops->bulk(bus, udev, pipe, buffer, length); 66de31213fSSimon Glass } 67de31213fSSimon Glass 68de31213fSSimon Glass int usb_alloc_device(struct usb_device *udev) 69de31213fSSimon Glass { 70de31213fSSimon Glass struct udevice *bus = udev->controller_dev; 71de31213fSSimon Glass struct dm_usb_ops *ops = usb_get_ops(bus); 72de31213fSSimon Glass 73de31213fSSimon Glass /* This is only requird by some controllers - current XHCI */ 74de31213fSSimon Glass if (!ops->alloc_device) 75de31213fSSimon Glass return 0; 76de31213fSSimon Glass 77de31213fSSimon Glass return ops->alloc_device(bus, udev); 78de31213fSSimon Glass } 79de31213fSSimon Glass 80de31213fSSimon Glass int usb_stop(void) 81de31213fSSimon Glass { 82de31213fSSimon Glass struct udevice *bus; 83de31213fSSimon Glass struct uclass *uc; 84de31213fSSimon Glass int err = 0, ret; 85de31213fSSimon Glass 86de31213fSSimon Glass /* De-activate any devices that have been activated */ 87de31213fSSimon Glass ret = uclass_get(UCLASS_USB, &uc); 88de31213fSSimon Glass if (ret) 89de31213fSSimon Glass return ret; 90de31213fSSimon Glass uclass_foreach_dev(bus, uc) { 91de31213fSSimon Glass ret = device_remove(bus); 92de31213fSSimon Glass if (ret && !err) 93de31213fSSimon Glass err = ret; 94de31213fSSimon Glass } 95de31213fSSimon Glass 96095fdef0SSimon Glass #ifdef CONFIG_SANDBOX 97095fdef0SSimon Glass struct udevice *dev; 98095fdef0SSimon Glass 99095fdef0SSimon Glass /* Reset all enulation devices */ 100095fdef0SSimon Glass ret = uclass_get(UCLASS_USB_EMUL, &uc); 101095fdef0SSimon Glass if (ret) 102095fdef0SSimon Glass return ret; 103095fdef0SSimon Glass 104095fdef0SSimon Glass uclass_foreach_dev(dev, uc) 105095fdef0SSimon Glass usb_emul_reset(dev); 106095fdef0SSimon Glass #endif 107de31213fSSimon Glass usb_stor_reset(); 108de31213fSSimon Glass usb_hub_reset(); 109de31213fSSimon Glass usb_started = 0; 110de31213fSSimon Glass 111de31213fSSimon Glass return err; 112de31213fSSimon Glass } 113de31213fSSimon Glass 114de31213fSSimon Glass static int usb_scan_bus(struct udevice *bus, bool recurse) 115de31213fSSimon Glass { 116de31213fSSimon Glass struct usb_bus_priv *priv; 117de31213fSSimon Glass struct udevice *dev; 118de31213fSSimon Glass int ret; 119de31213fSSimon Glass 120de31213fSSimon Glass priv = dev_get_uclass_priv(bus); 121de31213fSSimon Glass 122de31213fSSimon Glass assert(recurse); /* TODO: Support non-recusive */ 123de31213fSSimon Glass 124de31213fSSimon Glass ret = usb_scan_device(bus, 0, USB_SPEED_FULL, &dev); 125de31213fSSimon Glass if (ret) 126de31213fSSimon Glass return ret; 127de31213fSSimon Glass 128de31213fSSimon Glass return priv->next_addr; 129de31213fSSimon Glass } 130de31213fSSimon Glass 131de31213fSSimon Glass int usb_init(void) 132de31213fSSimon Glass { 133de31213fSSimon Glass int controllers_initialized = 0; 134de31213fSSimon Glass struct udevice *bus; 135de31213fSSimon Glass struct uclass *uc; 136de31213fSSimon Glass int count = 0; 137de31213fSSimon Glass int ret; 138de31213fSSimon Glass 139de31213fSSimon Glass asynch_allowed = 1; 140de31213fSSimon Glass usb_hub_reset(); 141de31213fSSimon Glass 142de31213fSSimon Glass ret = uclass_get(UCLASS_USB, &uc); 143de31213fSSimon Glass if (ret) 144de31213fSSimon Glass return ret; 145de31213fSSimon Glass 146de31213fSSimon Glass uclass_foreach_dev(bus, uc) { 147de31213fSSimon Glass /* init low_level USB */ 148*134692afSHans de Goede printf("USB%d: ", count); 149de31213fSSimon Glass count++; 150de31213fSSimon Glass ret = device_probe(bus); 151de31213fSSimon Glass if (ret == -ENODEV) { /* No such device. */ 152de31213fSSimon Glass puts("Port not available.\n"); 153de31213fSSimon Glass controllers_initialized++; 154de31213fSSimon Glass continue; 155de31213fSSimon Glass } 156de31213fSSimon Glass 157de31213fSSimon Glass if (ret) { /* Other error. */ 158de31213fSSimon Glass printf("probe failed, error %d\n", ret); 159de31213fSSimon Glass continue; 160de31213fSSimon Glass } 161de31213fSSimon Glass /* 162de31213fSSimon Glass * lowlevel init is OK, now scan the bus for devices 163de31213fSSimon Glass * i.e. search HUBs and configure them 164de31213fSSimon Glass */ 165de31213fSSimon Glass controllers_initialized++; 166de31213fSSimon Glass printf("scanning bus %d for devices... ", bus->seq); 167de31213fSSimon Glass debug("\n"); 168de31213fSSimon Glass ret = usb_scan_bus(bus, true); 169de31213fSSimon Glass if (ret < 0) 170de31213fSSimon Glass printf("failed, error %d\n", ret); 171de31213fSSimon Glass else if (!ret) 172de31213fSSimon Glass printf("No USB Device found\n"); 173de31213fSSimon Glass else 174de31213fSSimon Glass printf("%d USB Device(s) found\n", ret); 175de31213fSSimon Glass usb_started = true; 176de31213fSSimon Glass } 177de31213fSSimon Glass 178de31213fSSimon Glass debug("scan end\n"); 179de31213fSSimon Glass /* if we were not able to find at least one working bus, bail out */ 180de31213fSSimon Glass if (!count) 181de31213fSSimon Glass printf("No controllers found\n"); 182de31213fSSimon Glass else if (controllers_initialized == 0) 183de31213fSSimon Glass printf("USB error: all controllers failed lowlevel init\n"); 184de31213fSSimon Glass 185de31213fSSimon Glass return usb_started ? 0 : -1; 186de31213fSSimon Glass } 187de31213fSSimon Glass 188de31213fSSimon Glass int usb_reset_root_port(void) 189de31213fSSimon Glass { 190de31213fSSimon Glass return -ENOSYS; 191de31213fSSimon Glass } 192de31213fSSimon Glass 193de31213fSSimon Glass static struct usb_device *find_child_devnum(struct udevice *parent, int devnum) 194de31213fSSimon Glass { 195de31213fSSimon Glass struct usb_device *udev; 196de31213fSSimon Glass struct udevice *dev; 197de31213fSSimon Glass 198de31213fSSimon Glass if (!device_active(parent)) 199de31213fSSimon Glass return NULL; 200de31213fSSimon Glass udev = dev_get_parentdata(parent); 201de31213fSSimon Glass if (udev->devnum == devnum) 202de31213fSSimon Glass return udev; 203de31213fSSimon Glass 204de31213fSSimon Glass for (device_find_first_child(parent, &dev); 205de31213fSSimon Glass dev; 206de31213fSSimon Glass device_find_next_child(&dev)) { 207de31213fSSimon Glass udev = find_child_devnum(dev, devnum); 208de31213fSSimon Glass if (udev) 209de31213fSSimon Glass return udev; 210de31213fSSimon Glass } 211de31213fSSimon Glass 212de31213fSSimon Glass return NULL; 213de31213fSSimon Glass } 214de31213fSSimon Glass 215de31213fSSimon Glass struct usb_device *usb_get_dev_index(struct udevice *bus, int index) 216de31213fSSimon Glass { 217de31213fSSimon Glass struct udevice *hub; 218de31213fSSimon Glass int devnum = index + 1; /* Addresses are allocated from 1 on USB */ 219de31213fSSimon Glass 220de31213fSSimon Glass device_find_first_child(bus, &hub); 221de31213fSSimon Glass if (device_get_uclass_id(hub) == UCLASS_USB_HUB) 222de31213fSSimon Glass return find_child_devnum(hub, devnum); 223de31213fSSimon Glass 224de31213fSSimon Glass return NULL; 225de31213fSSimon Glass } 226de31213fSSimon Glass 227de31213fSSimon Glass int usb_post_bind(struct udevice *dev) 228de31213fSSimon Glass { 229de31213fSSimon Glass /* Scan the bus for devices */ 230de31213fSSimon Glass return dm_scan_fdt_node(dev, gd->fdt_blob, dev->of_offset, false); 231de31213fSSimon Glass } 232de31213fSSimon Glass 233de31213fSSimon Glass int usb_port_reset(struct usb_device *parent, int portnr) 234de31213fSSimon Glass { 235de31213fSSimon Glass unsigned short portstatus; 236de31213fSSimon Glass int ret; 237de31213fSSimon Glass 238de31213fSSimon Glass debug("%s: start\n", __func__); 239de31213fSSimon Glass 240de31213fSSimon Glass if (parent) { 241de31213fSSimon Glass /* reset the port for the second time */ 242de31213fSSimon Glass assert(portnr > 0); 243de31213fSSimon Glass debug("%s: reset %d\n", __func__, portnr - 1); 244de31213fSSimon Glass ret = legacy_hub_port_reset(parent, portnr - 1, &portstatus); 245de31213fSSimon Glass if (ret < 0) { 246de31213fSSimon Glass printf("\n Couldn't reset port %i\n", portnr); 247de31213fSSimon Glass return ret; 248de31213fSSimon Glass } 249de31213fSSimon Glass } else { 250de31213fSSimon Glass debug("%s: reset root\n", __func__); 251de31213fSSimon Glass usb_reset_root_port(); 252de31213fSSimon Glass } 253de31213fSSimon Glass 254de31213fSSimon Glass return 0; 255de31213fSSimon Glass } 256de31213fSSimon Glass 257de31213fSSimon Glass int usb_legacy_port_reset(struct usb_device *parent, int portnr) 258de31213fSSimon Glass { 259de31213fSSimon Glass return usb_port_reset(parent, portnr); 260de31213fSSimon Glass } 261de31213fSSimon Glass 262fbeceb26SSimon Glass int usb_setup_ehci_gadget(struct ehci_ctrl **ctlrp) 263fbeceb26SSimon Glass { 264fbeceb26SSimon Glass struct usb_platdata *plat; 265fbeceb26SSimon Glass struct udevice *dev; 266fbeceb26SSimon Glass int ret; 267fbeceb26SSimon Glass 268fbeceb26SSimon Glass /* Find the old device and remove it */ 269fbeceb26SSimon Glass ret = uclass_find_device_by_seq(UCLASS_USB, 0, true, &dev); 270fbeceb26SSimon Glass if (ret) 271fbeceb26SSimon Glass return ret; 272fbeceb26SSimon Glass ret = device_remove(dev); 273fbeceb26SSimon Glass if (ret) 274fbeceb26SSimon Glass return ret; 275fbeceb26SSimon Glass 276fbeceb26SSimon Glass plat = dev_get_platdata(dev); 277fbeceb26SSimon Glass plat->init_type = USB_INIT_DEVICE; 278fbeceb26SSimon Glass ret = device_probe(dev); 279fbeceb26SSimon Glass if (ret) 280fbeceb26SSimon Glass return ret; 281fbeceb26SSimon Glass *ctlrp = dev_get_priv(dev); 282fbeceb26SSimon Glass 283fbeceb26SSimon Glass return 0; 284fbeceb26SSimon Glass } 285fbeceb26SSimon Glass 2860566e240SSimon Glass /* returns 0 if no match, 1 if match */ 2870566e240SSimon Glass int usb_match_device(const struct usb_device_descriptor *desc, 2880566e240SSimon Glass const struct usb_device_id *id) 2890566e240SSimon Glass { 2900566e240SSimon Glass if ((id->match_flags & USB_DEVICE_ID_MATCH_VENDOR) && 2910566e240SSimon Glass id->idVendor != le16_to_cpu(desc->idVendor)) 2920566e240SSimon Glass return 0; 2930566e240SSimon Glass 2940566e240SSimon Glass if ((id->match_flags & USB_DEVICE_ID_MATCH_PRODUCT) && 2950566e240SSimon Glass id->idProduct != le16_to_cpu(desc->idProduct)) 2960566e240SSimon Glass return 0; 2970566e240SSimon Glass 2980566e240SSimon Glass /* No need to test id->bcdDevice_lo != 0, since 0 is never 2990566e240SSimon Glass greater than any unsigned number. */ 3000566e240SSimon Glass if ((id->match_flags & USB_DEVICE_ID_MATCH_DEV_LO) && 3010566e240SSimon Glass (id->bcdDevice_lo > le16_to_cpu(desc->bcdDevice))) 3020566e240SSimon Glass return 0; 3030566e240SSimon Glass 3040566e240SSimon Glass if ((id->match_flags & USB_DEVICE_ID_MATCH_DEV_HI) && 3050566e240SSimon Glass (id->bcdDevice_hi < le16_to_cpu(desc->bcdDevice))) 3060566e240SSimon Glass return 0; 3070566e240SSimon Glass 3080566e240SSimon Glass if ((id->match_flags & USB_DEVICE_ID_MATCH_DEV_CLASS) && 3090566e240SSimon Glass (id->bDeviceClass != desc->bDeviceClass)) 3100566e240SSimon Glass return 0; 3110566e240SSimon Glass 3120566e240SSimon Glass if ((id->match_flags & USB_DEVICE_ID_MATCH_DEV_SUBCLASS) && 3130566e240SSimon Glass (id->bDeviceSubClass != desc->bDeviceSubClass)) 3140566e240SSimon Glass return 0; 3150566e240SSimon Glass 3160566e240SSimon Glass if ((id->match_flags & USB_DEVICE_ID_MATCH_DEV_PROTOCOL) && 3170566e240SSimon Glass (id->bDeviceProtocol != desc->bDeviceProtocol)) 3180566e240SSimon Glass return 0; 3190566e240SSimon Glass 3200566e240SSimon Glass return 1; 3210566e240SSimon Glass } 3220566e240SSimon Glass 3230566e240SSimon Glass /* returns 0 if no match, 1 if match */ 3240566e240SSimon Glass int usb_match_one_id_intf(const struct usb_device_descriptor *desc, 3250566e240SSimon Glass const struct usb_interface_descriptor *int_desc, 3260566e240SSimon Glass const struct usb_device_id *id) 3270566e240SSimon Glass { 3280566e240SSimon Glass /* The interface class, subclass, protocol and number should never be 3290566e240SSimon Glass * checked for a match if the device class is Vendor Specific, 3300566e240SSimon Glass * unless the match record specifies the Vendor ID. */ 3310566e240SSimon Glass if (desc->bDeviceClass == USB_CLASS_VENDOR_SPEC && 3320566e240SSimon Glass !(id->match_flags & USB_DEVICE_ID_MATCH_VENDOR) && 3330566e240SSimon Glass (id->match_flags & (USB_DEVICE_ID_MATCH_INT_CLASS | 3340566e240SSimon Glass USB_DEVICE_ID_MATCH_INT_SUBCLASS | 3350566e240SSimon Glass USB_DEVICE_ID_MATCH_INT_PROTOCOL | 3360566e240SSimon Glass USB_DEVICE_ID_MATCH_INT_NUMBER))) 3370566e240SSimon Glass return 0; 3380566e240SSimon Glass 3390566e240SSimon Glass if ((id->match_flags & USB_DEVICE_ID_MATCH_INT_CLASS) && 3400566e240SSimon Glass (id->bInterfaceClass != int_desc->bInterfaceClass)) 3410566e240SSimon Glass return 0; 3420566e240SSimon Glass 3430566e240SSimon Glass if ((id->match_flags & USB_DEVICE_ID_MATCH_INT_SUBCLASS) && 3440566e240SSimon Glass (id->bInterfaceSubClass != int_desc->bInterfaceSubClass)) 3450566e240SSimon Glass return 0; 3460566e240SSimon Glass 3470566e240SSimon Glass if ((id->match_flags & USB_DEVICE_ID_MATCH_INT_PROTOCOL) && 3480566e240SSimon Glass (id->bInterfaceProtocol != int_desc->bInterfaceProtocol)) 3490566e240SSimon Glass return 0; 3500566e240SSimon Glass 3510566e240SSimon Glass if ((id->match_flags & USB_DEVICE_ID_MATCH_INT_NUMBER) && 3520566e240SSimon Glass (id->bInterfaceNumber != int_desc->bInterfaceNumber)) 3530566e240SSimon Glass return 0; 3540566e240SSimon Glass 3550566e240SSimon Glass return 1; 3560566e240SSimon Glass } 3570566e240SSimon Glass 3580566e240SSimon Glass /* returns 0 if no match, 1 if match */ 3590566e240SSimon Glass int usb_match_one_id(struct usb_device_descriptor *desc, 3600566e240SSimon Glass struct usb_interface_descriptor *int_desc, 3610566e240SSimon Glass const struct usb_device_id *id) 3620566e240SSimon Glass { 3630566e240SSimon Glass if (!usb_match_device(desc, id)) 3640566e240SSimon Glass return 0; 3650566e240SSimon Glass 3660566e240SSimon Glass return usb_match_one_id_intf(desc, int_desc, id); 3670566e240SSimon Glass } 3680566e240SSimon Glass 3690566e240SSimon Glass /** 3700566e240SSimon Glass * usb_find_and_bind_driver() - Find and bind the right USB driver 3710566e240SSimon Glass * 3720566e240SSimon Glass * This only looks at certain fields in the descriptor. 3730566e240SSimon Glass */ 3740566e240SSimon Glass static int usb_find_and_bind_driver(struct udevice *parent, 3750566e240SSimon Glass struct usb_device_descriptor *desc, 3760566e240SSimon Glass struct usb_interface_descriptor *iface, 3770566e240SSimon Glass int bus_seq, int devnum, 3780566e240SSimon Glass struct udevice **devp) 3790566e240SSimon Glass { 3800566e240SSimon Glass struct usb_driver_entry *start, *entry; 3810566e240SSimon Glass int n_ents; 3820566e240SSimon Glass int ret; 3830566e240SSimon Glass char name[30], *str; 3840566e240SSimon Glass 3850566e240SSimon Glass *devp = NULL; 3860566e240SSimon Glass debug("%s: Searching for driver\n", __func__); 3870566e240SSimon Glass start = ll_entry_start(struct usb_driver_entry, usb_driver_entry); 3880566e240SSimon Glass n_ents = ll_entry_count(struct usb_driver_entry, usb_driver_entry); 3890566e240SSimon Glass for (entry = start; entry != start + n_ents; entry++) { 3900566e240SSimon Glass const struct usb_device_id *id; 3910566e240SSimon Glass struct udevice *dev; 3920566e240SSimon Glass const struct driver *drv; 3930566e240SSimon Glass struct usb_dev_platdata *plat; 3940566e240SSimon Glass 3950566e240SSimon Glass for (id = entry->match; id->match_flags; id++) { 3960566e240SSimon Glass if (!usb_match_one_id(desc, iface, id)) 3970566e240SSimon Glass continue; 3980566e240SSimon Glass 3990566e240SSimon Glass drv = entry->driver; 4000566e240SSimon Glass /* 4010566e240SSimon Glass * We could pass the descriptor to the driver as 4020566e240SSimon Glass * platdata (instead of NULL) and allow its bind() 4030566e240SSimon Glass * method to return -ENOENT if it doesn't support this 4040566e240SSimon Glass * device. That way we could continue the search to 4050566e240SSimon Glass * find another driver. For now this doesn't seem 4060566e240SSimon Glass * necesssary, so just bind the first match. 4070566e240SSimon Glass */ 4080566e240SSimon Glass ret = device_bind(parent, drv, drv->name, NULL, -1, 4090566e240SSimon Glass &dev); 4100566e240SSimon Glass if (ret) 4110566e240SSimon Glass goto error; 4120566e240SSimon Glass debug("%s: Match found: %s\n", __func__, drv->name); 4130566e240SSimon Glass dev->driver_data = id->driver_info; 4140566e240SSimon Glass plat = dev_get_parent_platdata(dev); 4150566e240SSimon Glass plat->id = *id; 4160566e240SSimon Glass *devp = dev; 4170566e240SSimon Glass return 0; 4180566e240SSimon Glass } 4190566e240SSimon Glass } 4200566e240SSimon Glass 421449230f0SSimon Glass /* Bind a generic driver so that the device can be used */ 422449230f0SSimon Glass snprintf(name, sizeof(name), "generic_bus_%x_dev_%x", bus_seq, devnum); 423449230f0SSimon Glass str = strdup(name); 424449230f0SSimon Glass if (!str) 425449230f0SSimon Glass return -ENOMEM; 426449230f0SSimon Glass ret = device_bind_driver(parent, "usb_dev_generic_drv", str, devp); 427449230f0SSimon Glass 4280566e240SSimon Glass error: 4290566e240SSimon Glass debug("%s: No match found: %d\n", __func__, ret); 4300566e240SSimon Glass return ret; 4310566e240SSimon Glass } 4320566e240SSimon Glass 4330566e240SSimon Glass /** 4340566e240SSimon Glass * usb_find_child() - Find an existing device which matches our needs 4350566e240SSimon Glass * 4360566e240SSimon Glass * 4370566e240SSimon Glass */ 4380566e240SSimon Glass static int usb_find_child(struct udevice *parent, 4390566e240SSimon Glass struct usb_device_descriptor *desc, 4400566e240SSimon Glass struct usb_interface_descriptor *iface, 4410566e240SSimon Glass struct udevice **devp) 4420566e240SSimon Glass { 4430566e240SSimon Glass struct udevice *dev; 4440566e240SSimon Glass 4450566e240SSimon Glass *devp = NULL; 4460566e240SSimon Glass for (device_find_first_child(parent, &dev); 4470566e240SSimon Glass dev; 4480566e240SSimon Glass device_find_next_child(&dev)) { 4490566e240SSimon Glass struct usb_dev_platdata *plat = dev_get_parent_platdata(dev); 4500566e240SSimon Glass 4510566e240SSimon Glass /* If this device is already in use, skip it */ 4520566e240SSimon Glass if (device_active(dev)) 4530566e240SSimon Glass continue; 4540566e240SSimon Glass debug(" %s: name='%s', plat=%d, desc=%d\n", __func__, 4550566e240SSimon Glass dev->name, plat->id.bDeviceClass, desc->bDeviceClass); 4560566e240SSimon Glass if (usb_match_one_id(desc, iface, &plat->id)) { 4570566e240SSimon Glass *devp = dev; 4580566e240SSimon Glass return 0; 4590566e240SSimon Glass } 4600566e240SSimon Glass } 4610566e240SSimon Glass 4620566e240SSimon Glass return -ENOENT; 4630566e240SSimon Glass } 4640566e240SSimon Glass 465de31213fSSimon Glass int usb_scan_device(struct udevice *parent, int port, 466de31213fSSimon Glass enum usb_device_speed speed, struct udevice **devp) 467de31213fSSimon Glass { 468de31213fSSimon Glass struct udevice *dev; 469de31213fSSimon Glass bool created = false; 470de31213fSSimon Glass struct usb_dev_platdata *plat; 471de31213fSSimon Glass struct usb_bus_priv *priv; 472de31213fSSimon Glass struct usb_device *parent_udev; 473de31213fSSimon Glass int ret; 474de31213fSSimon Glass ALLOC_CACHE_ALIGN_BUFFER(struct usb_device, udev, 1); 475de31213fSSimon Glass struct usb_interface_descriptor *iface = &udev->config.if_desc[0].desc; 476de31213fSSimon Glass 477de31213fSSimon Glass *devp = NULL; 478de31213fSSimon Glass memset(udev, '\0', sizeof(*udev)); 479de31213fSSimon Glass ret = usb_get_bus(parent, &udev->controller_dev); 480de31213fSSimon Glass if (ret) 481de31213fSSimon Glass return ret; 482de31213fSSimon Glass priv = dev_get_uclass_priv(udev->controller_dev); 483de31213fSSimon Glass 484de31213fSSimon Glass /* 485de31213fSSimon Glass * Somewhat nasty, this. We create a local device and use the normal 486de31213fSSimon Glass * USB stack to read its descriptor. Then we know what type of device 487de31213fSSimon Glass * to create for real. 488de31213fSSimon Glass * 489de31213fSSimon Glass * udev->dev is set to the parent, since we don't have a real device 490de31213fSSimon Glass * yet. The USB stack should not access udev.dev anyway, except perhaps 491de31213fSSimon Glass * to find the controller, and the controller will either be @parent, 492de31213fSSimon Glass * or some parent of @parent. 493de31213fSSimon Glass * 494de31213fSSimon Glass * Another option might be to create the device as a generic USB 495de31213fSSimon Glass * device, then morph it into the correct one when we know what it 496de31213fSSimon Glass * should be. This means that a generic USB device would morph into 497de31213fSSimon Glass * a network controller, or a USB flash stick, for example. However, 498de31213fSSimon Glass * we don't support such morphing and it isn't clear that it would 499de31213fSSimon Glass * be easy to do. 500de31213fSSimon Glass * 501de31213fSSimon Glass * Yet another option is to split out the USB stack parts of udev 502de31213fSSimon Glass * into something like a 'struct urb' (as Linux does) which can exist 503de31213fSSimon Glass * independently of any device. This feels cleaner, but calls for quite 504de31213fSSimon Glass * a big change to the USB stack. 505de31213fSSimon Glass * 506de31213fSSimon Glass * For now, the approach is to set up an empty udev, read its 507de31213fSSimon Glass * descriptor and assign it an address, then bind a real device and 508de31213fSSimon Glass * stash the resulting information into the device's parent 509de31213fSSimon Glass * platform data. Then when we probe it, usb_child_pre_probe() is called 510de31213fSSimon Glass * and it will pull the information out of the stash. 511de31213fSSimon Glass */ 512de31213fSSimon Glass udev->dev = parent; 513de31213fSSimon Glass udev->speed = speed; 514de31213fSSimon Glass udev->devnum = priv->next_addr + 1; 515de31213fSSimon Glass udev->portnr = port; 516de31213fSSimon Glass debug("Calling usb_setup_device(), portnr=%d\n", udev->portnr); 517de31213fSSimon Glass parent_udev = device_get_uclass_id(parent) == UCLASS_USB_HUB ? 518de31213fSSimon Glass dev_get_parentdata(parent) : NULL; 519de31213fSSimon Glass ret = usb_setup_device(udev, priv->desc_before_addr, parent_udev, port); 520de31213fSSimon Glass debug("read_descriptor for '%s': ret=%d\n", parent->name, ret); 521de31213fSSimon Glass if (ret) 522de31213fSSimon Glass return ret; 523de31213fSSimon Glass ret = usb_find_child(parent, &udev->descriptor, iface, &dev); 524de31213fSSimon Glass debug("** usb_find_child returns %d\n", ret); 5250566e240SSimon Glass if (ret) { 5260566e240SSimon Glass if (ret != -ENOENT) 5270566e240SSimon Glass return ret; 5280566e240SSimon Glass ret = usb_find_and_bind_driver(parent, &udev->descriptor, iface, 5290566e240SSimon Glass udev->controller_dev->seq, 5300566e240SSimon Glass udev->devnum, &dev); 5310566e240SSimon Glass if (ret) 5320566e240SSimon Glass return ret; 5330566e240SSimon Glass created = true; 5340566e240SSimon Glass } 5350566e240SSimon Glass plat = dev_get_parent_platdata(dev); 5360566e240SSimon Glass debug("%s: Probing '%s', plat=%p\n", __func__, dev->name, plat); 5370566e240SSimon Glass plat->devnum = udev->devnum; 5380566e240SSimon Glass plat->speed = udev->speed; 5390566e240SSimon Glass plat->slot_id = udev->slot_id; 5400566e240SSimon Glass plat->portnr = port; 5410566e240SSimon Glass debug("** device '%s': stashing slot_id=%d\n", dev->name, 5420566e240SSimon Glass plat->slot_id); 5430566e240SSimon Glass priv->next_addr++; 5440566e240SSimon Glass ret = device_probe(dev); 5450566e240SSimon Glass if (ret) { 5460566e240SSimon Glass debug("%s: Device '%s' probe failed\n", __func__, dev->name); 5470566e240SSimon Glass priv->next_addr--; 5480566e240SSimon Glass if (created) 5490566e240SSimon Glass device_unbind(dev); 5500566e240SSimon Glass return ret; 5510566e240SSimon Glass } 5520566e240SSimon Glass *devp = dev; 553de31213fSSimon Glass 5540566e240SSimon Glass return 0; 555de31213fSSimon Glass } 556de31213fSSimon Glass 557de31213fSSimon Glass int usb_child_post_bind(struct udevice *dev) 558de31213fSSimon Glass { 559de31213fSSimon Glass struct usb_dev_platdata *plat = dev_get_parent_platdata(dev); 560de31213fSSimon Glass const void *blob = gd->fdt_blob; 561de31213fSSimon Glass int val; 562de31213fSSimon Glass 563de31213fSSimon Glass if (dev->of_offset == -1) 564de31213fSSimon Glass return 0; 565de31213fSSimon Glass 566de31213fSSimon Glass /* We only support matching a few things */ 567de31213fSSimon Glass val = fdtdec_get_int(blob, dev->of_offset, "usb,device-class", -1); 568de31213fSSimon Glass if (val != -1) { 569de31213fSSimon Glass plat->id.match_flags |= USB_DEVICE_ID_MATCH_DEV_CLASS; 570de31213fSSimon Glass plat->id.bDeviceClass = val; 571de31213fSSimon Glass } 572de31213fSSimon Glass val = fdtdec_get_int(blob, dev->of_offset, "usb,interface-class", -1); 573de31213fSSimon Glass if (val != -1) { 574de31213fSSimon Glass plat->id.match_flags |= USB_DEVICE_ID_MATCH_INT_CLASS; 575de31213fSSimon Glass plat->id.bInterfaceClass = val; 576de31213fSSimon Glass } 577de31213fSSimon Glass 578de31213fSSimon Glass return 0; 579de31213fSSimon Glass } 580de31213fSSimon Glass 581de31213fSSimon Glass int usb_get_bus(struct udevice *dev, struct udevice **busp) 582de31213fSSimon Glass { 583de31213fSSimon Glass struct udevice *bus; 584de31213fSSimon Glass 585de31213fSSimon Glass *busp = NULL; 586de31213fSSimon Glass for (bus = dev; bus && device_get_uclass_id(bus) != UCLASS_USB; ) 587de31213fSSimon Glass bus = bus->parent; 588de31213fSSimon Glass if (!bus) { 589de31213fSSimon Glass /* By design this cannot happen */ 590de31213fSSimon Glass assert(bus); 591de31213fSSimon Glass debug("USB HUB '%s' does not have a controller\n", dev->name); 592de31213fSSimon Glass return -EXDEV; 593de31213fSSimon Glass } 594de31213fSSimon Glass *busp = bus; 595de31213fSSimon Glass 596de31213fSSimon Glass return 0; 597de31213fSSimon Glass } 598de31213fSSimon Glass 599de31213fSSimon Glass int usb_child_pre_probe(struct udevice *dev) 600de31213fSSimon Glass { 601de31213fSSimon Glass struct udevice *bus; 602de31213fSSimon Glass struct usb_device *udev = dev_get_parentdata(dev); 603de31213fSSimon Glass struct usb_dev_platdata *plat = dev_get_parent_platdata(dev); 604de31213fSSimon Glass int ret; 605de31213fSSimon Glass 606de31213fSSimon Glass ret = usb_get_bus(dev, &bus); 607de31213fSSimon Glass if (ret) 608de31213fSSimon Glass return ret; 609de31213fSSimon Glass udev->controller_dev = bus; 610de31213fSSimon Glass udev->dev = dev; 611de31213fSSimon Glass udev->devnum = plat->devnum; 612de31213fSSimon Glass udev->slot_id = plat->slot_id; 613de31213fSSimon Glass udev->portnr = plat->portnr; 614de31213fSSimon Glass udev->speed = plat->speed; 615de31213fSSimon Glass debug("** device '%s': getting slot_id=%d\n", dev->name, plat->slot_id); 616de31213fSSimon Glass 617de31213fSSimon Glass ret = usb_select_config(udev); 618de31213fSSimon Glass if (ret) 619de31213fSSimon Glass return ret; 620de31213fSSimon Glass 621de31213fSSimon Glass return 0; 622de31213fSSimon Glass } 623de31213fSSimon Glass 624de31213fSSimon Glass UCLASS_DRIVER(usb) = { 625de31213fSSimon Glass .id = UCLASS_USB, 626de31213fSSimon Glass .name = "usb", 627de31213fSSimon Glass .flags = DM_UC_FLAG_SEQ_ALIAS, 628de31213fSSimon Glass .post_bind = usb_post_bind, 629de31213fSSimon Glass .per_child_auto_alloc_size = sizeof(struct usb_device), 630de31213fSSimon Glass .per_device_auto_alloc_size = sizeof(struct usb_bus_priv), 631de31213fSSimon Glass .child_post_bind = usb_child_post_bind, 632de31213fSSimon Glass .child_pre_probe = usb_child_pre_probe, 633de31213fSSimon Glass .per_child_platdata_auto_alloc_size = sizeof(struct usb_dev_platdata), 634de31213fSSimon Glass }; 635449230f0SSimon Glass 636449230f0SSimon Glass UCLASS_DRIVER(usb_dev_generic) = { 637449230f0SSimon Glass .id = UCLASS_USB_DEV_GENERIC, 638449230f0SSimon Glass .name = "usb_dev_generic", 639449230f0SSimon Glass }; 640449230f0SSimon Glass 641449230f0SSimon Glass U_BOOT_DRIVER(usb_dev_generic_drv) = { 642449230f0SSimon Glass .id = UCLASS_USB_DEV_GENERIC, 643449230f0SSimon Glass .name = "usb_dev_generic_drv", 644449230f0SSimon Glass }; 645