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
|
// SPDX-License-Identifier: GPL-2.0-only
#include <common.h>
#include <driver.h>
#include <usb/usb.h>
struct otg_mode {
struct device_d dev;
unsigned int var_mode;
unsigned int cur_mode;
int (*set_mode_callback)(void *ctx, enum usb_dr_mode mode);
void *ctx;
};
static int otg_set_mode(struct param_d *param, void *ctx)
{
struct otg_mode *otg = ctx;
int ret;
if (otg->var_mode == USB_DR_MODE_UNKNOWN)
return -EINVAL;
if (otg->var_mode == otg->cur_mode)
return 0;
if (otg->cur_mode != USB_DR_MODE_OTG)
return -EBUSY;
ret = otg->set_mode_callback(otg->ctx, otg->var_mode);
if (ret)
return ret;
otg->cur_mode = otg->var_mode;
return 0;
}
static const char *otg_mode_names[] = {
[USB_DR_MODE_UNKNOWN] = "unknown",
[USB_DR_MODE_HOST] = "host",
[USB_DR_MODE_PERIPHERAL] = "peripheral",
[USB_DR_MODE_OTG] = "otg",
};
static int register_otg_device(struct device_d *dev, struct otg_mode *otg)
{
struct param_d *param_mode;
int ret;
ret = register_device(dev);
if (ret)
return ret;
param_mode = dev_add_param_enum(dev, "mode",
otg_set_mode, NULL, &otg->var_mode,
otg_mode_names, ARRAY_SIZE(otg_mode_names), otg);
return PTR_ERR_OR_ZERO(param_mode);
}
static struct device_d otg_device = {
.name = "otg",
.id = DEVICE_ID_SINGLE,
};
int usb_register_otg_device(struct device_d *parent,
int (*set_mode)(void *ctx, enum usb_dr_mode mode), void *ctx)
{
int ret;
struct otg_mode *otg;
otg = xzalloc(sizeof(*otg));
otg->dev.priv = otg;
otg->dev.parent = parent;
otg->dev.id = DEVICE_ID_DYNAMIC;
dev_set_name(&otg->dev, "otg");
otg->var_mode = USB_DR_MODE_OTG;
otg->cur_mode = USB_DR_MODE_OTG;
otg->set_mode_callback = set_mode;
otg->ctx = ctx;
/* register otg.mode as an alias of otg0.mode */
if (otg_device.parent == NULL) {
otg_device.parent = parent;
ret = register_otg_device(&otg_device, otg);
if (ret)
return ret;
}
return register_otg_device(&otg->dev, otg);
}
|