Commit | Line | Data |
---|---|---|
1da177e4 LT |
1 | /* |
2 | * Raw serio device providing access to a raw byte stream from underlying | |
3 | * serio port. Closely emulates behavior of pre-2.6 /dev/psaux device | |
4 | * | |
5 | * Copyright (c) 2004 Dmitry Torokhov | |
6 | * | |
7 | * This program is free software; you can redistribute it and/or modify it | |
8 | * under the terms of the GNU General Public License version 2 as published by | |
9 | * the Free Software Foundation. | |
10 | */ | |
11 | ||
12 | #include <linux/slab.h> | |
13 | #include <linux/poll.h> | |
14 | #include <linux/module.h> | |
15 | #include <linux/serio.h> | |
16 | #include <linux/init.h> | |
17 | #include <linux/major.h> | |
18 | #include <linux/device.h> | |
19 | #include <linux/devfs_fs_kernel.h> | |
20 | #include <linux/miscdevice.h> | |
21 | #include <linux/wait.h> | |
c4e32e9f | 22 | #include <linux/mutex.h> |
1da177e4 LT |
23 | |
24 | #define DRIVER_DESC "Raw serio driver" | |
25 | ||
26 | MODULE_AUTHOR("Dmitry Torokhov <dtor@mail.ru>"); | |
27 | MODULE_DESCRIPTION(DRIVER_DESC); | |
28 | MODULE_LICENSE("GPL"); | |
29 | ||
30 | #define SERIO_RAW_QUEUE_LEN 64 | |
31 | struct serio_raw { | |
32 | unsigned char queue[SERIO_RAW_QUEUE_LEN]; | |
33 | unsigned int tail, head; | |
34 | ||
35 | char name[16]; | |
36 | unsigned int refcnt; | |
37 | struct serio *serio; | |
38 | struct miscdevice dev; | |
39 | wait_queue_head_t wait; | |
40 | struct list_head list; | |
41 | struct list_head node; | |
42 | }; | |
43 | ||
44 | struct serio_raw_list { | |
45 | struct fasync_struct *fasync; | |
46 | struct serio_raw *serio_raw; | |
47 | struct list_head node; | |
48 | }; | |
49 | ||
c4e32e9f | 50 | static DEFINE_MUTEX(serio_raw_mutex); |
1da177e4 LT |
51 | static LIST_HEAD(serio_raw_list); |
52 | static unsigned int serio_raw_no; | |
53 | ||
54 | /********************************************************************* | |
55 | * Interface with userspace (file operations) * | |
56 | *********************************************************************/ | |
57 | ||
58 | static int serio_raw_fasync(int fd, struct file *file, int on) | |
59 | { | |
60 | struct serio_raw_list *list = file->private_data; | |
61 | int retval; | |
62 | ||
63 | retval = fasync_helper(fd, file, on, &list->fasync); | |
64 | return retval < 0 ? retval : 0; | |
65 | } | |
66 | ||
67 | static struct serio_raw *serio_raw_locate(int minor) | |
68 | { | |
69 | struct serio_raw *serio_raw; | |
70 | ||
71 | list_for_each_entry(serio_raw, &serio_raw_list, node) { | |
72 | if (serio_raw->dev.minor == minor) | |
73 | return serio_raw; | |
74 | } | |
75 | ||
76 | return NULL; | |
77 | } | |
78 | ||
79 | static int serio_raw_open(struct inode *inode, struct file *file) | |
80 | { | |
81 | struct serio_raw *serio_raw; | |
82 | struct serio_raw_list *list; | |
83 | int retval = 0; | |
84 | ||
c4e32e9f | 85 | retval = mutex_lock_interruptible(&serio_raw_mutex); |
1da177e4 LT |
86 | if (retval) |
87 | return retval; | |
88 | ||
89 | if (!(serio_raw = serio_raw_locate(iminor(inode)))) { | |
90 | retval = -ENODEV; | |
91 | goto out; | |
92 | } | |
93 | ||
94 | if (!serio_raw->serio) { | |
95 | retval = -ENODEV; | |
96 | goto out; | |
97 | } | |
98 | ||
99 | if (!(list = kmalloc(sizeof(struct serio_raw_list), GFP_KERNEL))) { | |
100 | retval = -ENOMEM; | |
101 | goto out; | |
102 | } | |
103 | ||
104 | memset(list, 0, sizeof(struct serio_raw_list)); | |
105 | list->serio_raw = serio_raw; | |
106 | file->private_data = list; | |
107 | ||
108 | serio_raw->refcnt++; | |
109 | list_add_tail(&list->node, &serio_raw->list); | |
110 | ||
111 | out: | |
c4e32e9f | 112 | mutex_unlock(&serio_raw_mutex); |
1da177e4 LT |
113 | return retval; |
114 | } | |
115 | ||
116 | static int serio_raw_cleanup(struct serio_raw *serio_raw) | |
117 | { | |
118 | if (--serio_raw->refcnt == 0) { | |
119 | misc_deregister(&serio_raw->dev); | |
120 | list_del_init(&serio_raw->node); | |
121 | kfree(serio_raw); | |
122 | ||
123 | return 1; | |
124 | } | |
125 | ||
126 | return 0; | |
127 | } | |
128 | ||
129 | static int serio_raw_release(struct inode *inode, struct file *file) | |
130 | { | |
131 | struct serio_raw_list *list = file->private_data; | |
132 | struct serio_raw *serio_raw = list->serio_raw; | |
133 | ||
c4e32e9f | 134 | mutex_lock(&serio_raw_mutex); |
1da177e4 LT |
135 | |
136 | serio_raw_fasync(-1, file, 0); | |
137 | serio_raw_cleanup(serio_raw); | |
138 | ||
c4e32e9f | 139 | mutex_unlock(&serio_raw_mutex); |
1da177e4 LT |
140 | return 0; |
141 | } | |
142 | ||
143 | static int serio_raw_fetch_byte(struct serio_raw *serio_raw, char *c) | |
144 | { | |
145 | unsigned long flags; | |
146 | int empty; | |
147 | ||
148 | spin_lock_irqsave(&serio_raw->serio->lock, flags); | |
149 | ||
150 | empty = serio_raw->head == serio_raw->tail; | |
151 | if (!empty) { | |
152 | *c = serio_raw->queue[serio_raw->tail]; | |
153 | serio_raw->tail = (serio_raw->tail + 1) % SERIO_RAW_QUEUE_LEN; | |
154 | } | |
155 | ||
156 | spin_unlock_irqrestore(&serio_raw->serio->lock, flags); | |
157 | ||
158 | return !empty; | |
159 | } | |
160 | ||
161 | static ssize_t serio_raw_read(struct file *file, char __user *buffer, size_t count, loff_t *ppos) | |
162 | { | |
163 | struct serio_raw_list *list = file->private_data; | |
164 | struct serio_raw *serio_raw = list->serio_raw; | |
165 | char c; | |
166 | ssize_t retval = 0; | |
167 | ||
168 | if (!serio_raw->serio) | |
169 | return -ENODEV; | |
170 | ||
171 | if (serio_raw->head == serio_raw->tail && (file->f_flags & O_NONBLOCK)) | |
172 | return -EAGAIN; | |
173 | ||
174 | retval = wait_event_interruptible(list->serio_raw->wait, | |
175 | serio_raw->head != serio_raw->tail || !serio_raw->serio); | |
176 | if (retval) | |
177 | return retval; | |
178 | ||
179 | if (!serio_raw->serio) | |
180 | return -ENODEV; | |
181 | ||
182 | while (retval < count && serio_raw_fetch_byte(serio_raw, &c)) { | |
183 | if (put_user(c, buffer++)) | |
184 | return -EFAULT; | |
185 | retval++; | |
186 | } | |
187 | ||
188 | return retval; | |
189 | } | |
190 | ||
191 | static ssize_t serio_raw_write(struct file *file, const char __user *buffer, size_t count, loff_t *ppos) | |
192 | { | |
193 | struct serio_raw_list *list = file->private_data; | |
194 | ssize_t written = 0; | |
195 | int retval; | |
196 | unsigned char c; | |
197 | ||
c4e32e9f | 198 | retval = mutex_lock_interruptible(&serio_raw_mutex); |
1da177e4 LT |
199 | if (retval) |
200 | return retval; | |
201 | ||
202 | if (!list->serio_raw->serio) { | |
203 | retval = -ENODEV; | |
204 | goto out; | |
205 | } | |
206 | ||
207 | if (count > 32) | |
208 | count = 32; | |
209 | ||
210 | while (count--) { | |
211 | if (get_user(c, buffer++)) { | |
212 | retval = -EFAULT; | |
213 | goto out; | |
214 | } | |
215 | if (serio_write(list->serio_raw->serio, c)) { | |
216 | retval = -EIO; | |
217 | goto out; | |
218 | } | |
219 | written++; | |
220 | }; | |
221 | ||
222 | out: | |
c4e32e9f | 223 | mutex_unlock(&serio_raw_mutex); |
1da177e4 LT |
224 | return written; |
225 | } | |
226 | ||
227 | static unsigned int serio_raw_poll(struct file *file, poll_table *wait) | |
228 | { | |
229 | struct serio_raw_list *list = file->private_data; | |
230 | ||
231 | poll_wait(file, &list->serio_raw->wait, wait); | |
232 | ||
233 | if (list->serio_raw->head != list->serio_raw->tail) | |
234 | return POLLIN | POLLRDNORM; | |
235 | ||
236 | return 0; | |
237 | } | |
238 | ||
239 | static struct file_operations serio_raw_fops = { | |
240 | .owner = THIS_MODULE, | |
241 | .open = serio_raw_open, | |
242 | .release = serio_raw_release, | |
243 | .read = serio_raw_read, | |
244 | .write = serio_raw_write, | |
245 | .poll = serio_raw_poll, | |
246 | .fasync = serio_raw_fasync, | |
247 | }; | |
248 | ||
249 | ||
250 | /********************************************************************* | |
251 | * Interface with serio port * | |
252 | *********************************************************************/ | |
253 | ||
254 | static irqreturn_t serio_raw_interrupt(struct serio *serio, unsigned char data, | |
255 | unsigned int dfl, struct pt_regs *regs) | |
256 | { | |
257 | struct serio_raw *serio_raw = serio_get_drvdata(serio); | |
258 | struct serio_raw_list *list; | |
259 | unsigned int head = serio_raw->head; | |
260 | ||
261 | /* we are holding serio->lock here so we are prootected */ | |
262 | serio_raw->queue[head] = data; | |
263 | head = (head + 1) % SERIO_RAW_QUEUE_LEN; | |
264 | if (likely(head != serio_raw->tail)) { | |
265 | serio_raw->head = head; | |
266 | list_for_each_entry(list, &serio_raw->list, node) | |
267 | kill_fasync(&list->fasync, SIGIO, POLL_IN); | |
268 | wake_up_interruptible(&serio_raw->wait); | |
269 | } | |
270 | ||
271 | return IRQ_HANDLED; | |
272 | } | |
273 | ||
274 | static int serio_raw_connect(struct serio *serio, struct serio_driver *drv) | |
275 | { | |
276 | struct serio_raw *serio_raw; | |
277 | int err; | |
278 | ||
279 | if (!(serio_raw = kmalloc(sizeof(struct serio_raw), GFP_KERNEL))) { | |
280 | printk(KERN_ERR "serio_raw.c: can't allocate memory for a device\n"); | |
281 | return -ENOMEM; | |
282 | } | |
283 | ||
c4e32e9f | 284 | mutex_lock(&serio_raw_mutex); |
1da177e4 LT |
285 | |
286 | memset(serio_raw, 0, sizeof(struct serio_raw)); | |
287 | snprintf(serio_raw->name, sizeof(serio_raw->name), "serio_raw%d", serio_raw_no++); | |
288 | serio_raw->refcnt = 1; | |
289 | serio_raw->serio = serio; | |
290 | INIT_LIST_HEAD(&serio_raw->list); | |
291 | init_waitqueue_head(&serio_raw->wait); | |
292 | ||
293 | serio_set_drvdata(serio, serio_raw); | |
294 | ||
295 | err = serio_open(serio, drv); | |
296 | if (err) | |
297 | goto out_free; | |
298 | ||
299 | list_add_tail(&serio_raw->node, &serio_raw_list); | |
300 | ||
301 | serio_raw->dev.minor = PSMOUSE_MINOR; | |
302 | serio_raw->dev.name = serio_raw->name; | |
dc1e97b5 | 303 | serio_raw->dev.dev = &serio->dev; |
1da177e4 LT |
304 | serio_raw->dev.fops = &serio_raw_fops; |
305 | ||
306 | err = misc_register(&serio_raw->dev); | |
307 | if (err) { | |
308 | serio_raw->dev.minor = MISC_DYNAMIC_MINOR; | |
309 | err = misc_register(&serio_raw->dev); | |
310 | } | |
311 | ||
312 | if (err) { | |
313 | printk(KERN_INFO "serio_raw: failed to register raw access device for %s\n", | |
314 | serio->phys); | |
315 | goto out_close; | |
316 | } | |
317 | ||
318 | printk(KERN_INFO "serio_raw: raw access enabled on %s (%s, minor %d)\n", | |
319 | serio->phys, serio_raw->name, serio_raw->dev.minor); | |
320 | goto out; | |
321 | ||
322 | out_close: | |
323 | serio_close(serio); | |
324 | list_del_init(&serio_raw->node); | |
325 | out_free: | |
326 | serio_set_drvdata(serio, NULL); | |
327 | kfree(serio_raw); | |
328 | out: | |
c4e32e9f | 329 | mutex_unlock(&serio_raw_mutex); |
1da177e4 LT |
330 | return err; |
331 | } | |
332 | ||
333 | static int serio_raw_reconnect(struct serio *serio) | |
334 | { | |
335 | struct serio_raw *serio_raw = serio_get_drvdata(serio); | |
336 | struct serio_driver *drv = serio->drv; | |
337 | ||
338 | if (!drv || !serio_raw) { | |
339 | printk(KERN_DEBUG "serio_raw: reconnect request, but serio is disconnected, ignoring...\n"); | |
340 | return -1; | |
341 | } | |
342 | ||
343 | /* | |
344 | * Nothing needs to be done here, we just need this method to | |
345 | * keep the same device. | |
346 | */ | |
347 | return 0; | |
348 | } | |
349 | ||
350 | static void serio_raw_disconnect(struct serio *serio) | |
351 | { | |
352 | struct serio_raw *serio_raw; | |
353 | ||
c4e32e9f | 354 | mutex_lock(&serio_raw_mutex); |
1da177e4 LT |
355 | |
356 | serio_raw = serio_get_drvdata(serio); | |
357 | ||
358 | serio_close(serio); | |
359 | serio_set_drvdata(serio, NULL); | |
360 | ||
361 | serio_raw->serio = NULL; | |
362 | if (!serio_raw_cleanup(serio_raw)) | |
363 | wake_up_interruptible(&serio_raw->wait); | |
364 | ||
c4e32e9f | 365 | mutex_unlock(&serio_raw_mutex); |
1da177e4 LT |
366 | } |
367 | ||
368 | static struct serio_device_id serio_raw_serio_ids[] = { | |
369 | { | |
370 | .type = SERIO_8042, | |
371 | .proto = SERIO_ANY, | |
372 | .id = SERIO_ANY, | |
373 | .extra = SERIO_ANY, | |
374 | }, | |
375 | { 0 } | |
376 | }; | |
377 | ||
378 | MODULE_DEVICE_TABLE(serio, serio_raw_serio_ids); | |
379 | ||
380 | static struct serio_driver serio_raw_drv = { | |
381 | .driver = { | |
382 | .name = "serio_raw", | |
383 | }, | |
384 | .description = DRIVER_DESC, | |
385 | .id_table = serio_raw_serio_ids, | |
386 | .interrupt = serio_raw_interrupt, | |
387 | .connect = serio_raw_connect, | |
388 | .reconnect = serio_raw_reconnect, | |
389 | .disconnect = serio_raw_disconnect, | |
390 | .manual_bind = 1, | |
391 | }; | |
392 | ||
393 | static int __init serio_raw_init(void) | |
394 | { | |
395 | serio_register_driver(&serio_raw_drv); | |
396 | return 0; | |
397 | } | |
398 | ||
399 | static void __exit serio_raw_exit(void) | |
400 | { | |
401 | serio_unregister_driver(&serio_raw_drv); | |
402 | } | |
403 | ||
404 | module_init(serio_raw_init); | |
405 | module_exit(serio_raw_exit); |