diff options
-rw-r--r-- | drivers/uio/uio.c | 159 | ||||
-rw-r--r-- | include/linux/uio_driver.h | 26 |
2 files changed, 168 insertions, 17 deletions
diff --git a/drivers/uio/uio.c b/drivers/uio/uio.c index 2d2440cd57a9..4ca85a113aa2 100644 --- a/drivers/uio/uio.c +++ b/drivers/uio/uio.c | |||
@@ -35,6 +35,7 @@ struct uio_device { | |||
35 | int vma_count; | 35 | int vma_count; |
36 | struct uio_info *info; | 36 | struct uio_info *info; |
37 | struct kobject *map_dir; | 37 | struct kobject *map_dir; |
38 | struct kobject *portio_dir; | ||
38 | }; | 39 | }; |
39 | 40 | ||
40 | static int uio_major; | 41 | static int uio_major; |
@@ -75,17 +76,17 @@ static ssize_t map_offset_show(struct uio_mem *mem, char *buf) | |||
75 | return sprintf(buf, "0x%lx\n", mem->addr & ~PAGE_MASK); | 76 | return sprintf(buf, "0x%lx\n", mem->addr & ~PAGE_MASK); |
76 | } | 77 | } |
77 | 78 | ||
78 | struct uio_sysfs_entry { | 79 | struct map_sysfs_entry { |
79 | struct attribute attr; | 80 | struct attribute attr; |
80 | ssize_t (*show)(struct uio_mem *, char *); | 81 | ssize_t (*show)(struct uio_mem *, char *); |
81 | ssize_t (*store)(struct uio_mem *, const char *, size_t); | 82 | ssize_t (*store)(struct uio_mem *, const char *, size_t); |
82 | }; | 83 | }; |
83 | 84 | ||
84 | static struct uio_sysfs_entry addr_attribute = | 85 | static struct map_sysfs_entry addr_attribute = |
85 | __ATTR(addr, S_IRUGO, map_addr_show, NULL); | 86 | __ATTR(addr, S_IRUGO, map_addr_show, NULL); |
86 | static struct uio_sysfs_entry size_attribute = | 87 | static struct map_sysfs_entry size_attribute = |
87 | __ATTR(size, S_IRUGO, map_size_show, NULL); | 88 | __ATTR(size, S_IRUGO, map_size_show, NULL); |
88 | static struct uio_sysfs_entry offset_attribute = | 89 | static struct map_sysfs_entry offset_attribute = |
89 | __ATTR(offset, S_IRUGO, map_offset_show, NULL); | 90 | __ATTR(offset, S_IRUGO, map_offset_show, NULL); |
90 | 91 | ||
91 | static struct attribute *attrs[] = { | 92 | static struct attribute *attrs[] = { |
@@ -106,9 +107,9 @@ static ssize_t map_type_show(struct kobject *kobj, struct attribute *attr, | |||
106 | { | 107 | { |
107 | struct uio_map *map = to_map(kobj); | 108 | struct uio_map *map = to_map(kobj); |
108 | struct uio_mem *mem = map->mem; | 109 | struct uio_mem *mem = map->mem; |
109 | struct uio_sysfs_entry *entry; | 110 | struct map_sysfs_entry *entry; |
110 | 111 | ||
111 | entry = container_of(attr, struct uio_sysfs_entry, attr); | 112 | entry = container_of(attr, struct map_sysfs_entry, attr); |
112 | 113 | ||
113 | if (!entry->show) | 114 | if (!entry->show) |
114 | return -EIO; | 115 | return -EIO; |
@@ -116,16 +117,93 @@ static ssize_t map_type_show(struct kobject *kobj, struct attribute *attr, | |||
116 | return entry->show(mem, buf); | 117 | return entry->show(mem, buf); |
117 | } | 118 | } |
118 | 119 | ||
119 | static struct sysfs_ops uio_sysfs_ops = { | 120 | static struct sysfs_ops map_sysfs_ops = { |
120 | .show = map_type_show, | 121 | .show = map_type_show, |
121 | }; | 122 | }; |
122 | 123 | ||
123 | static struct kobj_type map_attr_type = { | 124 | static struct kobj_type map_attr_type = { |
124 | .release = map_release, | 125 | .release = map_release, |
125 | .sysfs_ops = &uio_sysfs_ops, | 126 | .sysfs_ops = &map_sysfs_ops, |
126 | .default_attrs = attrs, | 127 | .default_attrs = attrs, |
127 | }; | 128 | }; |
128 | 129 | ||
130 | struct uio_portio { | ||
131 | struct kobject kobj; | ||
132 | struct uio_port *port; | ||
133 | }; | ||
134 | #define to_portio(portio) container_of(portio, struct uio_portio, kobj) | ||
135 | |||
136 | static ssize_t portio_start_show(struct uio_port *port, char *buf) | ||
137 | { | ||
138 | return sprintf(buf, "0x%lx\n", port->start); | ||
139 | } | ||
140 | |||
141 | static ssize_t portio_size_show(struct uio_port *port, char *buf) | ||
142 | { | ||
143 | return sprintf(buf, "0x%lx\n", port->size); | ||
144 | } | ||
145 | |||
146 | static ssize_t portio_porttype_show(struct uio_port *port, char *buf) | ||
147 | { | ||
148 | const char *porttypes[] = {"none", "x86", "gpio", "other"}; | ||
149 | |||
150 | if ((port->porttype < 0) || (port->porttype > UIO_PORT_OTHER)) | ||
151 | return -EINVAL; | ||
152 | |||
153 | return sprintf(buf, "port_%s\n", porttypes[port->porttype]); | ||
154 | } | ||
155 | |||
156 | struct portio_sysfs_entry { | ||
157 | struct attribute attr; | ||
158 | ssize_t (*show)(struct uio_port *, char *); | ||
159 | ssize_t (*store)(struct uio_port *, const char *, size_t); | ||
160 | }; | ||
161 | |||
162 | static struct portio_sysfs_entry portio_start_attribute = | ||
163 | __ATTR(start, S_IRUGO, portio_start_show, NULL); | ||
164 | static struct portio_sysfs_entry portio_size_attribute = | ||
165 | __ATTR(size, S_IRUGO, portio_size_show, NULL); | ||
166 | static struct portio_sysfs_entry portio_porttype_attribute = | ||
167 | __ATTR(porttype, S_IRUGO, portio_porttype_show, NULL); | ||
168 | |||
169 | static struct attribute *portio_attrs[] = { | ||
170 | &portio_start_attribute.attr, | ||
171 | &portio_size_attribute.attr, | ||
172 | &portio_porttype_attribute.attr, | ||
173 | NULL, | ||
174 | }; | ||
175 | |||
176 | static void portio_release(struct kobject *kobj) | ||
177 | { | ||
178 | struct uio_portio *portio = to_portio(kobj); | ||
179 | kfree(portio); | ||
180 | } | ||
181 | |||
182 | static ssize_t portio_type_show(struct kobject *kobj, struct attribute *attr, | ||
183 | char *buf) | ||
184 | { | ||
185 | struct uio_portio *portio = to_portio(kobj); | ||
186 | struct uio_port *port = portio->port; | ||
187 | struct portio_sysfs_entry *entry; | ||
188 | |||
189 | entry = container_of(attr, struct portio_sysfs_entry, attr); | ||
190 | |||
191 | if (!entry->show) | ||
192 | return -EIO; | ||
193 | |||
194 | return entry->show(port, buf); | ||
195 | } | ||
196 | |||
197 | static struct sysfs_ops portio_sysfs_ops = { | ||
198 | .show = portio_type_show, | ||
199 | }; | ||
200 | |||
201 | static struct kobj_type portio_attr_type = { | ||
202 | .release = portio_release, | ||
203 | .sysfs_ops = &portio_sysfs_ops, | ||
204 | .default_attrs = portio_attrs, | ||
205 | }; | ||
206 | |||
129 | static ssize_t show_name(struct device *dev, | 207 | static ssize_t show_name(struct device *dev, |
130 | struct device_attribute *attr, char *buf) | 208 | struct device_attribute *attr, char *buf) |
131 | { | 209 | { |
@@ -177,10 +255,13 @@ static struct attribute_group uio_attr_grp = { | |||
177 | static int uio_dev_add_attributes(struct uio_device *idev) | 255 | static int uio_dev_add_attributes(struct uio_device *idev) |
178 | { | 256 | { |
179 | int ret; | 257 | int ret; |
180 | int mi; | 258 | int mi, pi; |
181 | int map_found = 0; | 259 | int map_found = 0; |
260 | int portio_found = 0; | ||
182 | struct uio_mem *mem; | 261 | struct uio_mem *mem; |
183 | struct uio_map *map; | 262 | struct uio_map *map; |
263 | struct uio_port *port; | ||
264 | struct uio_portio *portio; | ||
184 | 265 | ||
185 | ret = sysfs_create_group(&idev->dev->kobj, &uio_attr_grp); | 266 | ret = sysfs_create_group(&idev->dev->kobj, &uio_attr_grp); |
186 | if (ret) | 267 | if (ret) |
@@ -195,25 +276,58 @@ static int uio_dev_add_attributes(struct uio_device *idev) | |||
195 | idev->map_dir = kobject_create_and_add("maps", | 276 | idev->map_dir = kobject_create_and_add("maps", |
196 | &idev->dev->kobj); | 277 | &idev->dev->kobj); |
197 | if (!idev->map_dir) | 278 | if (!idev->map_dir) |
198 | goto err; | 279 | goto err_map; |
199 | } | 280 | } |
200 | map = kzalloc(sizeof(*map), GFP_KERNEL); | 281 | map = kzalloc(sizeof(*map), GFP_KERNEL); |
201 | if (!map) | 282 | if (!map) |
202 | goto err; | 283 | goto err_map; |
203 | kobject_init(&map->kobj, &map_attr_type); | 284 | kobject_init(&map->kobj, &map_attr_type); |
204 | map->mem = mem; | 285 | map->mem = mem; |
205 | mem->map = map; | 286 | mem->map = map; |
206 | ret = kobject_add(&map->kobj, idev->map_dir, "map%d", mi); | 287 | ret = kobject_add(&map->kobj, idev->map_dir, "map%d", mi); |
207 | if (ret) | 288 | if (ret) |
208 | goto err; | 289 | goto err_map; |
209 | ret = kobject_uevent(&map->kobj, KOBJ_ADD); | 290 | ret = kobject_uevent(&map->kobj, KOBJ_ADD); |
210 | if (ret) | 291 | if (ret) |
211 | goto err; | 292 | goto err_map; |
293 | } | ||
294 | |||
295 | for (pi = 0; pi < MAX_UIO_PORT_REGIONS; pi++) { | ||
296 | port = &idev->info->port[pi]; | ||
297 | if (port->size == 0) | ||
298 | break; | ||
299 | if (!portio_found) { | ||
300 | portio_found = 1; | ||
301 | idev->portio_dir = kobject_create_and_add("portio", | ||
302 | &idev->dev->kobj); | ||
303 | if (!idev->portio_dir) | ||
304 | goto err_portio; | ||
305 | } | ||
306 | portio = kzalloc(sizeof(*portio), GFP_KERNEL); | ||
307 | if (!portio) | ||
308 | goto err_portio; | ||
309 | kobject_init(&portio->kobj, &portio_attr_type); | ||
310 | portio->port = port; | ||
311 | port->portio = portio; | ||
312 | ret = kobject_add(&portio->kobj, idev->portio_dir, | ||
313 | "port%d", pi); | ||
314 | if (ret) | ||
315 | goto err_portio; | ||
316 | ret = kobject_uevent(&portio->kobj, KOBJ_ADD); | ||
317 | if (ret) | ||
318 | goto err_portio; | ||
212 | } | 319 | } |
213 | 320 | ||
214 | return 0; | 321 | return 0; |
215 | 322 | ||
216 | err: | 323 | err_portio: |
324 | for (pi--; pi >= 0; pi--) { | ||
325 | port = &idev->info->port[pi]; | ||
326 | portio = port->portio; | ||
327 | kobject_put(&portio->kobj); | ||
328 | } | ||
329 | kobject_put(idev->portio_dir); | ||
330 | err_map: | ||
217 | for (mi--; mi>=0; mi--) { | 331 | for (mi--; mi>=0; mi--) { |
218 | mem = &idev->info->mem[mi]; | 332 | mem = &idev->info->mem[mi]; |
219 | map = mem->map; | 333 | map = mem->map; |
@@ -228,15 +342,26 @@ err_group: | |||
228 | 342 | ||
229 | static void uio_dev_del_attributes(struct uio_device *idev) | 343 | static void uio_dev_del_attributes(struct uio_device *idev) |
230 | { | 344 | { |
231 | int mi; | 345 | int i; |
232 | struct uio_mem *mem; | 346 | struct uio_mem *mem; |
233 | for (mi = 0; mi < MAX_UIO_MAPS; mi++) { | 347 | struct uio_port *port; |
234 | mem = &idev->info->mem[mi]; | 348 | |
349 | for (i = 0; i < MAX_UIO_MAPS; i++) { | ||
350 | mem = &idev->info->mem[i]; | ||
235 | if (mem->size == 0) | 351 | if (mem->size == 0) |
236 | break; | 352 | break; |
237 | kobject_put(&mem->map->kobj); | 353 | kobject_put(&mem->map->kobj); |
238 | } | 354 | } |
239 | kobject_put(idev->map_dir); | 355 | kobject_put(idev->map_dir); |
356 | |||
357 | for (i = 0; i < MAX_UIO_PORT_REGIONS; i++) { | ||
358 | port = &idev->info->port[i]; | ||
359 | if (port->size == 0) | ||
360 | break; | ||
361 | kobject_put(&port->portio->kobj); | ||
362 | } | ||
363 | kobject_put(idev->portio_dir); | ||
364 | |||
240 | sysfs_remove_group(&idev->dev->kobj, &uio_attr_grp); | 365 | sysfs_remove_group(&idev->dev->kobj, &uio_attr_grp); |
241 | } | 366 | } |
242 | 367 | ||
diff --git a/include/linux/uio_driver.h b/include/linux/uio_driver.h index cdf338d94b7f..20be327bfbb4 100644 --- a/include/linux/uio_driver.h +++ b/include/linux/uio_driver.h | |||
@@ -38,6 +38,24 @@ struct uio_mem { | |||
38 | 38 | ||
39 | #define MAX_UIO_MAPS 5 | 39 | #define MAX_UIO_MAPS 5 |
40 | 40 | ||
41 | struct uio_portio; | ||
42 | |||
43 | /** | ||
44 | * struct uio_port - description of a UIO port region | ||
45 | * @start: start of port region | ||
46 | * @size: size of port region | ||
47 | * @porttype: type of port (see UIO_PORT_* below) | ||
48 | * @portio: for use by the UIO core only. | ||
49 | */ | ||
50 | struct uio_port { | ||
51 | unsigned long start; | ||
52 | unsigned long size; | ||
53 | int porttype; | ||
54 | struct uio_portio *portio; | ||
55 | }; | ||
56 | |||
57 | #define MAX_UIO_PORT_REGIONS 5 | ||
58 | |||
41 | struct uio_device; | 59 | struct uio_device; |
42 | 60 | ||
43 | /** | 61 | /** |
@@ -46,6 +64,7 @@ struct uio_device; | |||
46 | * @name: device name | 64 | * @name: device name |
47 | * @version: device driver version | 65 | * @version: device driver version |
48 | * @mem: list of mappable memory regions, size==0 for end of list | 66 | * @mem: list of mappable memory regions, size==0 for end of list |
67 | * @port: list of port regions, size==0 for end of list | ||
49 | * @irq: interrupt number or UIO_IRQ_CUSTOM | 68 | * @irq: interrupt number or UIO_IRQ_CUSTOM |
50 | * @irq_flags: flags for request_irq() | 69 | * @irq_flags: flags for request_irq() |
51 | * @priv: optional private data | 70 | * @priv: optional private data |
@@ -60,6 +79,7 @@ struct uio_info { | |||
60 | char *name; | 79 | char *name; |
61 | char *version; | 80 | char *version; |
62 | struct uio_mem mem[MAX_UIO_MAPS]; | 81 | struct uio_mem mem[MAX_UIO_MAPS]; |
82 | struct uio_port port[MAX_UIO_PORT_REGIONS]; | ||
63 | long irq; | 83 | long irq; |
64 | unsigned long irq_flags; | 84 | unsigned long irq_flags; |
65 | void *priv; | 85 | void *priv; |
@@ -92,4 +112,10 @@ extern void uio_event_notify(struct uio_info *info); | |||
92 | #define UIO_MEM_LOGICAL 2 | 112 | #define UIO_MEM_LOGICAL 2 |
93 | #define UIO_MEM_VIRTUAL 3 | 113 | #define UIO_MEM_VIRTUAL 3 |
94 | 114 | ||
115 | /* defines for uio_port->porttype */ | ||
116 | #define UIO_PORT_NONE 0 | ||
117 | #define UIO_PORT_X86 1 | ||
118 | #define UIO_PORT_GPIO 2 | ||
119 | #define UIO_PORT_OTHER 3 | ||
120 | |||
95 | #endif /* _LINUX_UIO_DRIVER_H_ */ | 121 | #endif /* _LINUX_UIO_DRIVER_H_ */ |