1
2
3
4
5
6
7
8
9
10
11
12
13
14#include <linux/stddef.h>
15#include <linux/module.h>
16#include <linux/ioport.h>
17#include <linux/init.h>
18#include <linux/gameport.h>
19#include <linux/wait.h>
20#include <linux/slab.h>
21#include <linux/delay.h>
22#include <linux/kthread.h>
23#include <linux/sched.h>
24#include <linux/mutex.h>
25#include <linux/freezer.h>
26
27
28
29MODULE_AUTHOR("Vojtech Pavlik <vojtech@ucw.cz>");
30MODULE_DESCRIPTION("Generic gameport layer");
31MODULE_LICENSE("GPL");
32
33
34
35
36
37static DEFINE_MUTEX(gameport_mutex);
38
39static LIST_HEAD(gameport_list);
40
41static struct bus_type gameport_bus;
42
43static void gameport_add_port(struct gameport *gameport);
44static void gameport_attach_driver(struct gameport_driver *drv);
45static void gameport_reconnect_port(struct gameport *gameport);
46static void gameport_disconnect_port(struct gameport *gameport);
47
48#if defined(__i386__)
49
50#include <asm/i8253.h>
51
52#define DELTA(x,y) ((y)-(x)+((y)<(x)?1193182/HZ:0))
53#define GET_TIME(x) do { x = get_time_pit(); } while (0)
54
55static unsigned int get_time_pit(void)
56{
57 unsigned long flags;
58 unsigned int count;
59
60 spin_lock_irqsave(&i8253_lock, flags);
61 outb_p(0x00, 0x43);
62 count = inb_p(0x40);
63 count |= inb_p(0x40) << 8;
64 spin_unlock_irqrestore(&i8253_lock, flags);
65
66 return count;
67}
68
69#endif
70
71
72
73
74
75
76
77static int gameport_measure_speed(struct gameport *gameport)
78{
79#if defined(__i386__)
80
81 unsigned int i, t, t1, t2, t3, tx;
82 unsigned long flags;
83
84 if (gameport_open(gameport, NULL, GAMEPORT_MODE_RAW))
85 return 0;
86
87 tx = 1 << 30;
88
89 for(i = 0; i < 50; i++) {
90 local_irq_save(flags);
91 GET_TIME(t1);
92 for (t = 0; t < 50; t++) gameport_read(gameport);
93 GET_TIME(t2);
94 GET_TIME(t3);
95 local_irq_restore(flags);
96 udelay(i * 10);
97 if ((t = DELTA(t2,t1) - DELTA(t3,t2)) < tx) tx = t;
98 }
99
100 gameport_close(gameport);
101 return 59659 / (tx < 1 ? 1 : tx);
102
103#elif defined (__x86_64__)
104
105 unsigned int i, t;
106 unsigned long tx, t1, t2, flags;
107
108 if (gameport_open(gameport, NULL, GAMEPORT_MODE_RAW))
109 return 0;
110
111 tx = 1 << 30;
112
113 for(i = 0; i < 50; i++) {
114 local_irq_save(flags);
115 rdtscl(t1);
116 for (t = 0; t < 50; t++) gameport_read(gameport);
117 rdtscl(t2);
118 local_irq_restore(flags);
119 udelay(i * 10);
120 if (t2 - t1 < tx) tx = t2 - t1;
121 }
122
123 gameport_close(gameport);
124 return (cpu_data(raw_smp_processor_id()).loops_per_jiffy *
125 (unsigned long)HZ / (1000 / 50)) / (tx < 1 ? 1 : tx);
126
127#else
128
129 unsigned int j, t = 0;
130
131 if (gameport_open(gameport, NULL, GAMEPORT_MODE_RAW))
132 return 0;
133
134 j = jiffies; while (j == jiffies);
135 j = jiffies; while (j == jiffies) { t++; gameport_read(gameport); }
136
137 gameport_close(gameport);
138 return t * HZ / 1000;
139
140#endif
141}
142
143void gameport_start_polling(struct gameport *gameport)
144{
145 spin_lock(&gameport->timer_lock);
146
147 if (!gameport->poll_cnt++) {
148 BUG_ON(!gameport->poll_handler);
149 BUG_ON(!gameport->poll_interval);
150 mod_timer(&gameport->poll_timer, jiffies + msecs_to_jiffies(gameport->poll_interval));
151 }
152
153 spin_unlock(&gameport->timer_lock);
154}
155EXPORT_SYMBOL(gameport_start_polling);
156
157void gameport_stop_polling(struct gameport *gameport)
158{
159 spin_lock(&gameport->timer_lock);
160
161 if (!--gameport->poll_cnt)
162 del_timer(&gameport->poll_timer);
163
164 spin_unlock(&gameport->timer_lock);
165}
166EXPORT_SYMBOL(gameport_stop_polling);
167
168static void gameport_run_poll_handler(unsigned long d)
169{
170 struct gameport *gameport = (struct gameport *)d;
171
172 gameport->poll_handler(gameport);
173 if (gameport->poll_cnt)
174 mod_timer(&gameport->poll_timer, jiffies + msecs_to_jiffies(gameport->poll_interval));
175}
176
177
178
179
180
181static int gameport_bind_driver(struct gameport *gameport, struct gameport_driver *drv)
182{
183 int error;
184
185 gameport->dev.driver = &drv->driver;
186 if (drv->connect(gameport, drv)) {
187 gameport->dev.driver = NULL;
188 return -ENODEV;
189 }
190
191 error = device_bind_driver(&gameport->dev);
192 if (error) {
193 printk(KERN_WARNING
194 "gameport: device_bind_driver() failed "
195 "for %s (%s) and %s, error: %d\n",
196 gameport->phys, gameport->name,
197 drv->description, error);
198 drv->disconnect(gameport);
199 gameport->dev.driver = NULL;
200 return error;
201 }
202
203 return 0;
204}
205
206static void gameport_find_driver(struct gameport *gameport)
207{
208 int error;
209
210 error = device_attach(&gameport->dev);
211 if (error < 0)
212 printk(KERN_WARNING
213 "gameport: device_attach() failed for %s (%s), error: %d\n",
214 gameport->phys, gameport->name, error);
215}
216
217
218
219
220
221
222enum gameport_event_type {
223 GAMEPORT_REGISTER_PORT,
224 GAMEPORT_ATTACH_DRIVER,
225};
226
227struct gameport_event {
228 enum gameport_event_type type;
229 void *object;
230 struct module *owner;
231 struct list_head node;
232};
233
234static DEFINE_SPINLOCK(gameport_event_lock);
235static LIST_HEAD(gameport_event_list);
236static DECLARE_WAIT_QUEUE_HEAD(gameport_wait);
237static struct task_struct *gameport_task;
238
239static int gameport_queue_event(void *object, struct module *owner,
240 enum gameport_event_type event_type)
241{
242 unsigned long flags;
243 struct gameport_event *event;
244 int retval = 0;
245
246 spin_lock_irqsave(&gameport_event_lock, flags);
247
248
249
250
251
252
253
254
255 list_for_each_entry_reverse(event, &gameport_event_list, node) {
256 if (event->object == object) {
257 if (event->type == event_type)
258 goto out;
259 break;
260 }
261 }
262
263 event = kmalloc(sizeof(struct gameport_event), GFP_ATOMIC);
264 if (!event) {
265 printk(KERN_ERR
266 "gameport: Not enough memory to queue event %d\n",
267 event_type);
268 retval = -ENOMEM;
269 goto out;
270 }
271
272 if (!try_module_get(owner)) {
273 printk(KERN_WARNING
274 "gameport: Can't get module reference, dropping event %d\n",
275 event_type);
276 kfree(event);
277 retval = -EINVAL;
278 goto out;
279 }
280
281 event->type = event_type;
282 event->object = object;
283 event->owner = owner;
284
285 list_add_tail(&event->node, &gameport_event_list);
286 wake_up(&gameport_wait);
287
288out:
289 spin_unlock_irqrestore(&gameport_event_lock, flags);
290 return retval;
291}
292
293static void gameport_free_event(struct gameport_event *event)
294{
295 module_put(event->owner);
296 kfree(event);
297}
298
299static void gameport_remove_duplicate_events(struct gameport_event *event)
300{
301 struct list_head *node, *next;
302 struct gameport_event *e;
303 unsigned long flags;
304
305 spin_lock_irqsave(&gameport_event_lock, flags);
306
307 list_for_each_safe(node, next, &gameport_event_list) {
308 e = list_entry(node, struct gameport_event, node);
309 if (event->object == e->object) {
310
311
312
313
314
315 if (event->type != e->type)
316 break;
317
318 list_del_init(node);
319 gameport_free_event(e);
320 }
321 }
322
323 spin_unlock_irqrestore(&gameport_event_lock, flags);
324}
325
326static struct gameport_event *gameport_get_event(void)
327{
328 struct gameport_event *event;
329 struct list_head *node;
330 unsigned long flags;
331
332 spin_lock_irqsave(&gameport_event_lock, flags);
333
334 if (list_empty(&gameport_event_list)) {
335 spin_unlock_irqrestore(&gameport_event_lock, flags);
336 return NULL;
337 }
338
339 node = gameport_event_list.next;
340 event = list_entry(node, struct gameport_event, node);
341 list_del_init(node);
342
343 spin_unlock_irqrestore(&gameport_event_lock, flags);
344
345 return event;
346}
347
348static void gameport_handle_event(void)
349{
350 struct gameport_event *event;
351
352 mutex_lock(&gameport_mutex);
353
354
355
356
357
358
359
360 if ((event = gameport_get_event())) {
361
362 switch (event->type) {
363 case GAMEPORT_REGISTER_PORT:
364 gameport_add_port(event->object);
365 break;
366
367 case GAMEPORT_ATTACH_DRIVER:
368 gameport_attach_driver(event->object);
369 break;
370
371 default:
372 break;
373 }
374
375 gameport_remove_duplicate_events(event);
376 gameport_free_event(event);
377 }
378
379 mutex_unlock(&gameport_mutex);
380}
381
382
383
384
385
386static void gameport_remove_pending_events(void *object)
387{
388 struct list_head *node, *next;
389 struct gameport_event *event;
390 unsigned long flags;
391
392 spin_lock_irqsave(&gameport_event_lock, flags);
393
394 list_for_each_safe(node, next, &gameport_event_list) {
395 event = list_entry(node, struct gameport_event, node);
396 if (event->object == object) {
397 list_del_init(node);
398 gameport_free_event(event);
399 }
400 }
401
402 spin_unlock_irqrestore(&gameport_event_lock, flags);
403}
404
405
406
407
408
409
410
411
412
413static struct gameport *gameport_get_pending_child(struct gameport *parent)
414{
415 struct gameport_event *event;
416 struct gameport *gameport, *child = NULL;
417 unsigned long flags;
418
419 spin_lock_irqsave(&gameport_event_lock, flags);
420
421 list_for_each_entry(event, &gameport_event_list, node) {
422 if (event->type == GAMEPORT_REGISTER_PORT) {
423 gameport = event->object;
424 if (gameport->parent == parent) {
425 child = gameport;
426 break;
427 }
428 }
429 }
430
431 spin_unlock_irqrestore(&gameport_event_lock, flags);
432 return child;
433}
434
435static int gameport_thread(void *nothing)
436{
437 set_freezable();
438 do {
439 gameport_handle_event();
440 wait_event_freezable(gameport_wait,
441 kthread_should_stop() || !list_empty(&gameport_event_list));
442 } while (!kthread_should_stop());
443
444 printk(KERN_DEBUG "gameport: kgameportd exiting\n");
445 return 0;
446}
447
448
449
450
451
452
453static ssize_t gameport_show_description(struct device *dev, struct device_attribute *attr, char *buf)
454{
455 struct gameport *gameport = to_gameport_port(dev);
456 return sprintf(buf, "%s\n", gameport->name);
457}
458
459static ssize_t gameport_rebind_driver(struct device *dev, struct device_attribute *attr, const char *buf, size_t count)
460{
461 struct gameport *gameport = to_gameport_port(dev);
462 struct device_driver *drv;
463 int error;
464
465 error = mutex_lock_interruptible(&gameport_mutex);
466 if (error)
467 return error;
468
469 if (!strncmp(buf, "none", count)) {
470 gameport_disconnect_port(gameport);
471 } else if (!strncmp(buf, "reconnect", count)) {
472 gameport_reconnect_port(gameport);
473 } else if (!strncmp(buf, "rescan", count)) {
474 gameport_disconnect_port(gameport);
475 gameport_find_driver(gameport);
476 } else if ((drv = driver_find(buf, &gameport_bus)) != NULL) {
477 gameport_disconnect_port(gameport);
478 error = gameport_bind_driver(gameport, to_gameport_driver(drv));
479 put_driver(drv);
480 } else {
481 error = -EINVAL;
482 }
483
484 mutex_unlock(&gameport_mutex);
485
486 return error ? error : count;
487}
488
489static struct device_attribute gameport_device_attrs[] = {
490 __ATTR(description, S_IRUGO, gameport_show_description, NULL),
491 __ATTR(drvctl, S_IWUSR, NULL, gameport_rebind_driver),
492 __ATTR_NULL
493};
494
495static void gameport_release_port(struct device *dev)
496{
497 struct gameport *gameport = to_gameport_port(dev);
498
499 kfree(gameport);
500 module_put(THIS_MODULE);
501}
502
503void gameport_set_phys(struct gameport *gameport, const char *fmt, ...)
504{
505 va_list args;
506
507 va_start(args, fmt);
508 vsnprintf(gameport->phys, sizeof(gameport->phys), fmt, args);
509 va_end(args);
510}
511EXPORT_SYMBOL(gameport_set_phys);
512
513
514
515
516static void gameport_init_port(struct gameport *gameport)
517{
518 static atomic_t gameport_no = ATOMIC_INIT(0);
519
520 __module_get(THIS_MODULE);
521
522 mutex_init(&gameport->drv_mutex);
523 device_initialize(&gameport->dev);
524 dev_set_name(&gameport->dev, "gameport%lu", (unsigned long)atomic_inc_return(&gameport_no) - 1);
525 gameport->dev.bus = &gameport_bus;
526 gameport->dev.release = gameport_release_port;
527 if (gameport->parent)
528 gameport->dev.parent = &gameport->parent->dev;
529
530 INIT_LIST_HEAD(&gameport->node);
531 spin_lock_init(&gameport->timer_lock);
532 init_timer(&gameport->poll_timer);
533 gameport->poll_timer.function = gameport_run_poll_handler;
534 gameport->poll_timer.data = (unsigned long)gameport;
535}
536
537
538
539
540
541static void gameport_add_port(struct gameport *gameport)
542{
543 int error;
544
545 if (gameport->parent)
546 gameport->parent->child = gameport;
547
548 gameport->speed = gameport_measure_speed(gameport);
549
550 list_add_tail(&gameport->node, &gameport_list);
551
552 if (gameport->io)
553 printk(KERN_INFO "gameport: %s is %s, io %#x, speed %dkHz\n",
554 gameport->name, gameport->phys, gameport->io, gameport->speed);
555 else
556 printk(KERN_INFO "gameport: %s is %s, speed %dkHz\n",
557 gameport->name, gameport->phys, gameport->speed);
558
559 error = device_add(&gameport->dev);
560 if (error)
561 printk(KERN_ERR
562 "gameport: device_add() failed for %s (%s), error: %d\n",
563 gameport->phys, gameport->name, error);
564 else
565 gameport->registered = 1;
566}
567
568
569
570
571
572static void gameport_destroy_port(struct gameport *gameport)
573{
574 struct gameport *child;
575
576 child = gameport_get_pending_child(gameport);
577 if (child) {
578 gameport_remove_pending_events(child);
579 put_device(&child->dev);
580 }
581
582 if (gameport->parent) {
583 gameport->parent->child = NULL;
584 gameport->parent = NULL;
585 }
586
587 if (gameport->registered) {
588 device_del(&gameport->dev);
589 gameport->registered = 0;
590 }
591
592 list_del_init(&gameport->node);
593
594 gameport_remove_pending_events(gameport);
595 put_device(&gameport->dev);
596}
597
598
599
600
601static void gameport_reconnect_port(struct gameport *gameport)
602{
603 do {
604 if (!gameport->drv || !gameport->drv->reconnect || gameport->drv->reconnect(gameport)) {
605 gameport_disconnect_port(gameport);
606 gameport_find_driver(gameport);
607
608 break;
609 }
610 gameport = gameport->child;
611 } while (gameport);
612}
613
614
615
616
617
618static void gameport_disconnect_port(struct gameport *gameport)
619{
620 struct gameport *s, *parent;
621
622 if (gameport->child) {
623
624
625
626
627
628 for (s = gameport; s->child; s = s->child)
629 ;
630
631 do {
632 parent = s->parent;
633
634 device_release_driver(&s->dev);
635 gameport_destroy_port(s);
636 } while ((s = parent) != gameport);
637 }
638
639
640
641
642 device_release_driver(&gameport->dev);
643}
644
645
646
647
648
649void __gameport_register_port(struct gameport *gameport, struct module *owner)
650{
651 gameport_init_port(gameport);
652 gameport_queue_event(gameport, owner, GAMEPORT_REGISTER_PORT);
653}
654EXPORT_SYMBOL(__gameport_register_port);
655
656
657
658
659void gameport_unregister_port(struct gameport *gameport)
660{
661 mutex_lock(&gameport_mutex);
662 gameport_disconnect_port(gameport);
663 gameport_destroy_port(gameport);
664 mutex_unlock(&gameport_mutex);
665}
666EXPORT_SYMBOL(gameport_unregister_port);
667
668
669
670
671
672
673static ssize_t gameport_driver_show_description(struct device_driver *drv, char *buf)
674{
675 struct gameport_driver *driver = to_gameport_driver(drv);
676 return sprintf(buf, "%s\n", driver->description ? driver->description : "(none)");
677}
678
679static struct driver_attribute gameport_driver_attrs[] = {
680 __ATTR(description, S_IRUGO, gameport_driver_show_description, NULL),
681 __ATTR_NULL
682};
683
684static int gameport_driver_probe(struct device *dev)
685{
686 struct gameport *gameport = to_gameport_port(dev);
687 struct gameport_driver *drv = to_gameport_driver(dev->driver);
688
689 drv->connect(gameport, drv);
690 return gameport->drv ? 0 : -ENODEV;
691}
692
693static int gameport_driver_remove(struct device *dev)
694{
695 struct gameport *gameport = to_gameport_port(dev);
696 struct gameport_driver *drv = to_gameport_driver(dev->driver);
697
698 drv->disconnect(gameport);
699 return 0;
700}
701
702static void gameport_attach_driver(struct gameport_driver *drv)
703{
704 int error;
705
706 error = driver_attach(&drv->driver);
707 if (error)
708 printk(KERN_ERR
709 "gameport: driver_attach() failed for %s, error: %d\n",
710 drv->driver.name, error);
711}
712
713int __gameport_register_driver(struct gameport_driver *drv, struct module *owner,
714 const char *mod_name)
715{
716 int error;
717
718 drv->driver.bus = &gameport_bus;
719 drv->driver.owner = owner;
720 drv->driver.mod_name = mod_name;
721
722
723
724
725
726 drv->ignore = true;
727
728 error = driver_register(&drv->driver);
729 if (error) {
730 printk(KERN_ERR
731 "gameport: driver_register() failed for %s, error: %d\n",
732 drv->driver.name, error);
733 return error;
734 }
735
736
737
738
739 drv->ignore = false;
740 error = gameport_queue_event(drv, NULL, GAMEPORT_ATTACH_DRIVER);
741 if (error) {
742 driver_unregister(&drv->driver);
743 return error;
744 }
745
746 return 0;
747}
748EXPORT_SYMBOL(__gameport_register_driver);
749
750void gameport_unregister_driver(struct gameport_driver *drv)
751{
752 struct gameport *gameport;
753
754 mutex_lock(&gameport_mutex);
755
756 drv->ignore = true;
757 gameport_remove_pending_events(drv);
758
759start_over:
760 list_for_each_entry(gameport, &gameport_list, node) {
761 if (gameport->drv == drv) {
762 gameport_disconnect_port(gameport);
763 gameport_find_driver(gameport);
764
765 goto start_over;
766 }
767 }
768
769 driver_unregister(&drv->driver);
770
771 mutex_unlock(&gameport_mutex);
772}
773EXPORT_SYMBOL(gameport_unregister_driver);
774
775static int gameport_bus_match(struct device *dev, struct device_driver *drv)
776{
777 struct gameport_driver *gameport_drv = to_gameport_driver(drv);
778
779 return !gameport_drv->ignore;
780}
781
782static struct bus_type gameport_bus = {
783 .name = "gameport",
784 .dev_attrs = gameport_device_attrs,
785 .drv_attrs = gameport_driver_attrs,
786 .match = gameport_bus_match,
787 .probe = gameport_driver_probe,
788 .remove = gameport_driver_remove,
789};
790
791static void gameport_set_drv(struct gameport *gameport, struct gameport_driver *drv)
792{
793 mutex_lock(&gameport->drv_mutex);
794 gameport->drv = drv;
795 mutex_unlock(&gameport->drv_mutex);
796}
797
798int gameport_open(struct gameport *gameport, struct gameport_driver *drv, int mode)
799{
800 if (gameport->open) {
801 if (gameport->open(gameport, mode)) {
802 return -1;
803 }
804 } else {
805 if (mode != GAMEPORT_MODE_RAW)
806 return -1;
807 }
808
809 gameport_set_drv(gameport, drv);
810 return 0;
811}
812EXPORT_SYMBOL(gameport_open);
813
814void gameport_close(struct gameport *gameport)
815{
816 del_timer_sync(&gameport->poll_timer);
817 gameport->poll_handler = NULL;
818 gameport->poll_interval = 0;
819 gameport_set_drv(gameport, NULL);
820 if (gameport->close)
821 gameport->close(gameport);
822}
823EXPORT_SYMBOL(gameport_close);
824
825static int __init gameport_init(void)
826{
827 int error;
828
829 error = bus_register(&gameport_bus);
830 if (error) {
831 printk(KERN_ERR "gameport: failed to register gameport bus, error: %d\n", error);
832 return error;
833 }
834
835 gameport_task = kthread_run(gameport_thread, NULL, "kgameportd");
836 if (IS_ERR(gameport_task)) {
837 bus_unregister(&gameport_bus);
838 error = PTR_ERR(gameport_task);
839 printk(KERN_ERR "gameport: Failed to start kgameportd, error: %d\n", error);
840 return error;
841 }
842
843 return 0;
844}
845
846static void __exit gameport_exit(void)
847{
848 bus_unregister(&gameport_bus);
849 kthread_stop(gameport_task);
850}
851
852subsys_initcall(gameport_init);
853module_exit(gameport_exit);
854