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
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
|
#include <linux/ipaq-sleeve.h>
#include <linux/module.h>
#include <linux/slab.h>
#define to_ipaq_option_driver(x) \
container_of(x, struct ipaq_option_driver, driver)
static ssize_t vendor_show(struct device *dev, struct device_attribute *attr, char *buf)
{
struct ipaq_option_device *idev = to_ipaq_option_device(dev);
return snprintf(buf, PAGE_SIZE, "%04x\n", idev->id.vendor);
}
static DEVICE_ATTR_RO(vendor);
static ssize_t device_show(struct device *dev, struct device_attribute *attr, char *buf)
{
struct ipaq_option_device *idev = to_ipaq_option_device(dev);
return snprintf(buf, PAGE_SIZE, "%04x\n", idev->id.device);
}
static DEVICE_ATTR_RO(device);
static ssize_t description_show(struct device *dev, struct device_attribute *attr, char *buf)
{
struct ipaq_option_device *idev = to_ipaq_option_device(dev);
return snprintf(buf, PAGE_SIZE, "%s\n", idev->description);
}
static DEVICE_ATTR_RO(description);
static struct attribute *ipaq_option_sleeve_attrs[] = {
&dev_attr_description.attr,
&dev_attr_device.attr,
&dev_attr_vendor.attr,
NULL,
};
static const struct attribute_group ipaq_option_sleeve_dev_group = {
.attrs = ipaq_option_sleeve_attrs,
};
static const struct attribute_group *ipaq_option_sleeve_dev_groups[] = {
&ipaq_option_sleeve_dev_group,
NULL,
};
static int ipaq_option_sleeve_match(struct device *dev, struct device_driver *drv)
{
struct ipaq_option_device *idev = to_ipaq_option_device(dev);
struct ipaq_option_driver *idrv = to_ipaq_option_driver(drv);
const struct ipaq_option_id *id;
for (id = idrv->id_table; id->vendor || id->device; id++)
if (id->vendor == idev->id.vendor &&
id->device == idev->id.device)
return 1;
return 0;
}
static int ipaq_option_sleeve_uevent(struct device *dev, struct kobj_uevent_env *env)
{
struct ipaq_option_device *idev = to_ipaq_option_device(dev);
if (!dev)
return -ENODEV;
if (add_uevent_var(env, "DESCRIPTION=%s", idev->description) ||
add_uevent_var(env, "MODALIAS=ipaq:v%04Xd%04X",
idev->id.vendor, idev->id.device))
return -ENOMEM;
return 0;
}
struct bus_type ipaq_option_sleeve_bus = {
.name = "ipaq-sleeve",
.dev_groups = ipaq_option_sleeve_dev_groups,
.match = ipaq_option_sleeve_match,
.uevent = ipaq_option_sleeve_uevent,
};
EXPORT_SYMBOL_GPL(ipaq_option_sleeve_bus);
static void ipaq_option_release(struct device *dev)
{
struct ipaq_option_device *idev = to_ipaq_option_device(dev);
kfree(idev->description);
kfree(idev);
}
int ipaq_option_device_add(struct device *parent, struct ipaq_option_id id,
const char *description)
{
struct ipaq_option_device *idev;
idev = kzalloc(sizeof(*idev), GFP_KERNEL);
if (!idev)
return -ENOMEM;
idev->description = kstrdup(description, GFP_KERNEL);
if (!idev->description) {
kfree(idev);
return -ENOMEM;
}
idev->id = id;
device_initialize(&idev->dev);
dev_set_name(&idev->dev, "sleeve");
idev->dev.parent = parent;
idev->dev.release = ipaq_option_release;
idev->dev.bus = &ipaq_option_sleeve_bus;
return device_add(&idev->dev);
}
EXPORT_SYMBOL_GPL(ipaq_option_device_add);
static int ipaq_option_device_remove(struct device *dev, void *data)
{
device_unregister(dev);
return 0;
}
void ipaq_option_device_del(void)
{
bus_for_each_dev(&ipaq_option_sleeve_bus, NULL, NULL,
ipaq_option_device_remove);
}
EXPORT_SYMBOL_GPL(ipaq_option_device_del);
static int ipaq_option_sleeve_init(void)
{
return bus_register(&ipaq_option_sleeve_bus);
}
core_initcall(ipaq_option_sleeve_init);
static void ipaq_option_sleeve_exit(void)
{
bus_unregister(&ipaq_option_sleeve_bus);
}
module_exit(ipaq_option_sleeve_exit);
MODULE_LICENSE("GPL");
|
