Loading...
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28 29 30 31 32 33 34 35 36 37 38 39 40 41 42 43 44 45 46 47 48 49 50 51 52 53 54 55 56 57 58 59 60 61 62 63 64 65 66 67 68 69 70 71 72 73 74 75 76 77 78 79 80 81 82 83 84 85 86 87 88 89 90 91 92 93 94 95 96 97 98 99 100 101 102 103 104 105 106 107 108 109 110 111 112 113 114 115 116 117 118 119 120 121 122 123 124 125 126 127 128 129 130 131 132 133 134 135 136 137 138 139 140 141 142 143 144 145 146 147 148 149 150 151 152 153 154 155 156 157 158 159 160 161 162 163 164 165 166 167 168 169 170 171 172 173 174 175 176 177 178 179 180 181 182 183 184 | // SPDX-License-Identifier: GPL-2.0+ /* * (C) Copyright 2015 Google, Inc * Written by Simon Glass <sjg@chromium.org> */ #include <dm.h> #include <log.h> #include <usb.h> #include <dm/root.h> #include <linux/usb/gadget.h> struct sandbox_udc { struct usb_gadget gadget; }; struct sandbox_udc *this_controller; struct sandbox_usb_ctrl { int rootdev; }; static void usbmon_trace(struct udevice *bus, ulong pipe, struct devrequest *setup, struct udevice *emul) { static const char types[] = "ZICB"; int type; type = (pipe & USB_PIPE_TYPE_MASK) >> USB_PIPE_TYPE_SHIFT; debug("0 0 S %c%c:%d:%03ld:%ld", types[type], pipe & USB_DIR_IN ? 'i' : 'o', dev_seq(bus), (pipe & USB_PIPE_DEV_MASK) >> USB_PIPE_DEV_SHIFT, (pipe & USB_PIPE_EP_MASK) >> USB_PIPE_EP_SHIFT); if (setup) { debug(" s %02x %02x %04x %04x %04x", setup->requesttype, setup->request, setup->value, setup->index, setup->length); } debug(" %s", emul ? emul->name : "(no emul found)"); debug("\n"); } static int sandbox_submit_control(struct udevice *bus, struct usb_device *udev, unsigned long pipe, void *buffer, int length, struct devrequest *setup) { struct sandbox_usb_ctrl *ctrl = dev_get_priv(bus); struct udevice *emul; int ret; /* Just use child of dev as emulator? */ debug("%s: bus=%s\n", __func__, bus->name); ret = usb_emul_find(bus, pipe, udev->portnr, &emul); usbmon_trace(bus, pipe, setup, emul); if (ret) return ret; if (usb_pipedevice(pipe) == ctrl->rootdev) { if (setup->request == USB_REQ_SET_ADDRESS) { debug("%s: Set root hub's USB address\n", __func__); ctrl->rootdev = le16_to_cpu(setup->value); } } ret = usb_emul_control(emul, udev, pipe, buffer, length, setup); if (ret < 0) { debug("ret=%d\n", ret); udev->status = ret; udev->act_len = 0; } else { udev->status = 0; udev->act_len = ret; } return ret; } static int sandbox_submit_bulk(struct udevice *bus, struct usb_device *udev, unsigned long pipe, void *buffer, int length) { struct udevice *emul; int ret; /* Just use child of dev as emulator? */ debug("%s: bus=%s\n", __func__, bus->name); ret = usb_emul_find(bus, pipe, udev->portnr, &emul); usbmon_trace(bus, pipe, NULL, emul); if (ret) return ret; ret = usb_emul_bulk(emul, udev, pipe, buffer, length); if (ret < 0) { debug("ret=%d\n", ret); udev->status = ret; udev->act_len = 0; } else { udev->status = 0; udev->act_len = ret; } return ret; } static int sandbox_submit_int(struct udevice *bus, struct usb_device *udev, unsigned long pipe, void *buffer, int length, int interval, bool nonblock) { struct udevice *emul; int ret; /* Just use child of dev as emulator? */ debug("%s: bus=%s\n", __func__, bus->name); ret = usb_emul_find(bus, pipe, udev->portnr, &emul); usbmon_trace(bus, pipe, NULL, emul); if (ret) return ret; ret = usb_emul_int(emul, udev, pipe, buffer, length, interval, nonblock); return ret; } #if !CONFIG_IS_ENABLED(DM_USB_GADGET) int usb_gadget_register_driver(struct usb_gadget_driver *driver) { struct sandbox_udc *dev = this_controller; return driver->bind(&dev->gadget); } int usb_gadget_unregister_driver(struct usb_gadget_driver *driver) { struct sandbox_udc *dev = this_controller; driver->unbind(&dev->gadget); return 0; } #endif static int sandbox_alloc_device(struct udevice *dev, struct usb_device *udev) { struct sandbox_usb_ctrl *ctrl = dev_get_priv(dev); /* * Root hub will be the first device to be initailized. * If this device is a root hub, initialize its device speed * to high speed as we are a USB 2.0 controller. */ if (ctrl->rootdev == 0) udev->speed = USB_SPEED_HIGH; return 0; } static int sandbox_usb_probe(struct udevice *dev) { return 0; } static const struct dm_usb_ops sandbox_usb_ops = { .control = sandbox_submit_control, .bulk = sandbox_submit_bulk, .interrupt = sandbox_submit_int, .alloc_device = sandbox_alloc_device, }; static const struct udevice_id sandbox_usb_ids[] = { { .compatible = "sandbox,usb" }, { } }; U_BOOT_DRIVER(usb_sandbox) = { .name = "usb_sandbox", .id = UCLASS_USB, .of_match = sandbox_usb_ids, .probe = sandbox_usb_probe, .ops = &sandbox_usb_ops, .priv_auto = sizeof(struct sandbox_usb_ctrl), .flags = DM_FLAG_ACTIVE_DMA, }; |