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 DECLARE_GLOBAL_DATA_PTR;
  14
  15 static void usbmon_trace(struct udevice *bus, ulong pipe,
  16                          struct devrequest *setup, struct udevice *emul)
  17 {
  18         static const char types[] = "ZICB";
  19         int type;
  20
  21         type = (pipe & USB_PIPE_TYPE_MASK) >> USB_PIPE_TYPE_SHIFT;
  22         debug("0 0 S %c%c:%d:%03ld:%ld", types[type],
  23               pipe & USB_DIR_IN ? 'i' : 'o',
  24               bus->seq,
  25               (pipe & USB_PIPE_DEV_MASK) >> USB_PIPE_DEV_SHIFT,
  26               (pipe & USB_PIPE_EP_MASK) >> USB_PIPE_EP_SHIFT);
  27         if (setup) {
  28                 debug(" s %02x %02x %04x %04x %04x", setup->requesttype,
  29                       setup->request, setup->value, setup->index,
  30                       setup->length);
  31         }
  32         debug(" %s", emul ? emul->name : "(no emul found)");
  33
  34         debug("\n");
  35 }
  36
  37 static int sandbox_submit_control(struct udevice *bus,
  38                                       struct usb_device *udev,
  39                                       unsigned long pipe,
  40                                       void *buffer, int length,
  41                                       struct devrequest *setup)
  42 {
  43         struct udevice *emul;
  44         int ret;
  45
  46         /* Just use child of dev as emulator? */
  47         debug("%s: bus=%s\n", __func__, bus->name);
  48         ret = usb_emul_find(bus, pipe, &emul);
  49         usbmon_trace(bus, pipe, setup, emul);
  50         if (ret)
  51                 return ret;
  52         ret = usb_emul_control(emul, udev, pipe, buffer, length, setup);
  53         if (ret < 0) {
  54                 debug("ret=%d\n", ret);
  55                 udev->status = ret;
  56                 udev->act_len = 0;
  57         } else {
  58                 udev->status = 0;
  59                 udev->act_len = ret;
  60         }
  61
  62         return ret;
  63 }
  64
  65 static int sandbox_submit_bulk(struct udevice *bus, struct usb_device *udev,
  66                                unsigned long pipe, void *buffer, int length)
  67 {
  68         struct udevice *emul;
  69         int ret;
  70
  71         /* Just use child of dev as emulator? */
  72         debug("%s: bus=%s\n", __func__, bus->name);
  73         ret = usb_emul_find(bus, pipe, &emul);
  74         usbmon_trace(bus, pipe, NULL, emul);
  75         if (ret)
  76                 return ret;
  77         ret = usb_emul_bulk(emul, udev, pipe, buffer, length);
  78         if (ret < 0) {
  79                 debug("ret=%d\n", ret);
  80                 udev->status = ret;
  81                 udev->act_len = 0;
  82         } else {
  83                 udev->status = 0;
  84                 udev->act_len = ret;
  85         }
  86
  87         return ret;
  88 }
  89
  90 static int sandbox_alloc_device(struct udevice *dev, struct usb_device *udev)
  91 {
  92         return 0;
  93 }
  94
  95 static int sandbox_usb_probe(struct udevice *dev)
  96 {
  97         return 0;
  98 }
  99
 100 static const struct dm_usb_ops sandbox_usb_ops = {
 101         .control        = sandbox_submit_control,
 102         .bulk           = sandbox_submit_bulk,
 103         .alloc_device   = sandbox_alloc_device,
 104 };
 105
 106 static const struct udevice_id sandbox_usb_ids[] = {
 107         { .compatible = "sandbox,usb" },
 108         { }
 109 };
 110
 111 U_BOOT_DRIVER(usb_sandbox) = {
 112         .name   = "usb_sandbox",
 113         .id     = UCLASS_USB,
 114         .of_match = sandbox_usb_ids,
 115         .probe = sandbox_usb_probe,
 116         .ops    = &sandbox_usb_ops,
 117 };