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