]>
Commit | Line | Data |
---|---|---|
1da177e4 LT |
1 | /* |
2 | * FM801 gameport driver for Linux | |
3 | * | |
4 | * Copyright (c) by Takashi Iwai <tiwai@suse.de> | |
5 | * | |
6 | * | |
7 | * This program is free software; you can redistribute it and/or modify | |
8 | * it under the terms of the GNU General Public License as published by | |
9 | * the Free Software Foundation; either version 2 of the License, or | |
10 | * (at your option) any later version. | |
11 | * | |
12 | * This program is distributed in the hope that it will be useful, | |
13 | * but WITHOUT ANY WARRANTY; without even the implied warranty of | |
14 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the | |
15 | * GNU General Public License for more details. | |
16 | * | |
17 | * You should have received a copy of the GNU General Public License | |
18 | * along with this program; if not, write to the Free Software | |
19 | * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA. | |
20 | * | |
21 | */ | |
22 | ||
23 | #include <asm/io.h> | |
24 | #include <linux/delay.h> | |
25 | #include <linux/errno.h> | |
26 | #include <linux/ioport.h> | |
27 | #include <linux/kernel.h> | |
28 | #include <linux/module.h> | |
29 | #include <linux/pci.h> | |
30 | #include <linux/init.h> | |
31 | #include <linux/slab.h> | |
32 | #include <linux/gameport.h> | |
33 | ||
34 | #define PCI_VENDOR_ID_FORTEMEDIA 0x1319 | |
35 | #define PCI_DEVICE_ID_FM801_GP 0x0802 | |
36 | ||
37 | #define HAVE_COOKED | |
38 | ||
39 | struct fm801_gp { | |
40 | struct gameport *gameport; | |
41 | struct resource *res_port; | |
42 | }; | |
43 | ||
44 | #ifdef HAVE_COOKED | |
45 | static int fm801_gp_cooked_read(struct gameport *gameport, int *axes, int *buttons) | |
46 | { | |
47 | unsigned short w; | |
48 | ||
49 | w = inw(gameport->io + 2); | |
50 | *buttons = (~w >> 14) & 0x03; | |
51 | axes[0] = (w == 0xffff) ? -1 : ((w & 0x1fff) << 5); | |
52 | w = inw(gameport->io + 4); | |
53 | axes[1] = (w == 0xffff) ? -1 : ((w & 0x1fff) << 5); | |
54 | w = inw(gameport->io + 6); | |
55 | *buttons |= ((~w >> 14) & 0x03) << 2; | |
56 | axes[2] = (w == 0xffff) ? -1 : ((w & 0x1fff) << 5); | |
57 | w = inw(gameport->io + 8); | |
58 | axes[3] = (w == 0xffff) ? -1 : ((w & 0x1fff) << 5); | |
59 | outw(0xff, gameport->io); /* reset */ | |
60 | ||
61 | return 0; | |
62 | } | |
63 | #endif | |
64 | ||
65 | static int fm801_gp_open(struct gameport *gameport, int mode) | |
66 | { | |
67 | switch (mode) { | |
68 | #ifdef HAVE_COOKED | |
69 | case GAMEPORT_MODE_COOKED: | |
70 | return 0; | |
71 | #endif | |
72 | case GAMEPORT_MODE_RAW: | |
73 | return 0; | |
74 | default: | |
75 | return -1; | |
76 | } | |
77 | ||
78 | return 0; | |
79 | } | |
80 | ||
81 | static int __devinit fm801_gp_probe(struct pci_dev *pci, const struct pci_device_id *id) | |
82 | { | |
83 | struct fm801_gp *gp; | |
84 | struct gameport *port; | |
85 | ||
86 | gp = kcalloc(1, sizeof(struct fm801_gp), GFP_KERNEL); | |
87 | port = gameport_allocate_port(); | |
88 | if (!gp || !port) { | |
89 | printk(KERN_ERR "fm801-gp: Memory allocation failed\n"); | |
90 | kfree(gp); | |
91 | gameport_free_port(port); | |
92 | return -ENOMEM; | |
93 | } | |
94 | ||
95 | pci_enable_device(pci); | |
96 | ||
97 | port->open = fm801_gp_open; | |
98 | #ifdef HAVE_COOKED | |
99 | port->cooked_read = fm801_gp_cooked_read; | |
100 | #endif | |
101 | gameport_set_name(port, "FM801"); | |
102 | gameport_set_phys(port, "pci%s/gameport0", pci_name(pci)); | |
103 | port->dev.parent = &pci->dev; | |
104 | port->io = pci_resource_start(pci, 0); | |
105 | ||
106 | gp->gameport = port; | |
107 | gp->res_port = request_region(port->io, 0x10, "FM801 GP"); | |
108 | if (!gp->res_port) { | |
109 | kfree(gp); | |
110 | gameport_free_port(port); | |
111 | printk(KERN_DEBUG "fm801-gp: unable to grab region 0x%x-0x%x\n", | |
112 | port->io, port->io + 0x0f); | |
113 | return -EBUSY; | |
114 | } | |
115 | ||
116 | pci_set_drvdata(pci, gp); | |
117 | ||
118 | outb(0x60, port->io + 0x0d); /* enable joystick 1 and 2 */ | |
119 | gameport_register_port(port); | |
120 | ||
121 | return 0; | |
122 | } | |
123 | ||
124 | static void __devexit fm801_gp_remove(struct pci_dev *pci) | |
125 | { | |
126 | struct fm801_gp *gp = pci_get_drvdata(pci); | |
127 | ||
128 | if (gp) { | |
129 | gameport_unregister_port(gp->gameport); | |
130 | release_resource(gp->res_port); | |
131 | kfree(gp); | |
132 | } | |
133 | } | |
134 | ||
135 | static struct pci_device_id fm801_gp_id_table[] = { | |
136 | { PCI_VENDOR_ID_FORTEMEDIA, PCI_DEVICE_ID_FM801_GP, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0 }, | |
137 | { 0 } | |
138 | }; | |
139 | ||
140 | static struct pci_driver fm801_gp_driver = { | |
141 | .name = "FM801_gameport", | |
142 | .id_table = fm801_gp_id_table, | |
143 | .probe = fm801_gp_probe, | |
144 | .remove = __devexit_p(fm801_gp_remove), | |
145 | }; | |
146 | ||
147 | static int __init fm801_gp_init(void) | |
148 | { | |
149 | return pci_register_driver(&fm801_gp_driver); | |
150 | } | |
151 | ||
152 | static void __exit fm801_gp_exit(void) | |
153 | { | |
154 | pci_unregister_driver(&fm801_gp_driver); | |
155 | } | |
156 | ||
157 | module_init(fm801_gp_init); | |
158 | module_exit(fm801_gp_exit); | |
159 | ||
160 | MODULE_DEVICE_TABLE(pci, fm801_gp_id_table); | |
161 | ||
162 | MODULE_AUTHOR("Takashi Iwai <tiwai@suse.de>"); | |
163 | MODULE_LICENSE("GPL"); |