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
|
// SPDX-License-Identifier: GPL-2.0-only
#include <common.h>
#include <driver.h>
#include <linux/usb/usb.h>
struct otg_mode {
struct device 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 *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);
}
struct bus_type otg_bus_type = {
.name = "usbotg" /* "otg" is already taken for the alias */
};
int otg_device_get_mode(struct device *dev)
{
struct otg_mode *otg;
if (dev->bus != &otg_bus_type)
return -ENODEV;
otg = dev->priv;
return otg->cur_mode;
}
int usb_register_otg_device(struct device *parent,
int (*set_mode)(void *ctx, enum usb_dr_mode mode), void *ctx)
{
bool first_otg = list_empty(&otg_bus_type.device_list);
int ret;
struct otg_mode *otg;
otg = xzalloc(sizeof(*otg));
otg->dev.priv = otg;
otg->dev.parent = parent;
otg->dev.bus = &otg_bus_type;
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;
ret = register_otg_device(&otg->dev, otg);
if (ret)
return ret;
/* register otg.mode as an alias of otg0.mode */
if (first_otg)
dev_add_alias(&otg->dev, "otg");
return 0;
}
static int otg_bus_init(void)
{
return bus_register(&otg_bus_type);
}
pure_initcall(otg_bus_init);
|