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
|
/*
* (C) Copyright 2015 Google, Inc
* Written by Simon Glass <sjg@chromium.org>
*
* SPDX-License-Identifier: GPL-2.0+
*/
#include <common.h>
#include <dm.h>
#include <usb.h>
#include <dm/root.h>
DECLARE_GLOBAL_DATA_PTR;
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',
bus->seq,
(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 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, &emul);
usbmon_trace(bus, pipe, setup, emul);
if (ret)
return ret;
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, &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_alloc_device(struct udevice *dev, struct usb_device *udev)
{
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,
.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,
};
|
