git.sur5r.net Git - u-boot/blob - drivers/usb/host/usb-sandbox.c

   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 };