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; | |
b435fdcd | 85 | int error; |
1da177e4 | 86 | |
a97e148a | 87 | gp = kzalloc(sizeof(struct fm801_gp), GFP_KERNEL); |
1da177e4 LT |
88 | port = gameport_allocate_port(); |
89 | if (!gp || !port) { | |
90 | printk(KERN_ERR "fm801-gp: Memory allocation failed\n"); | |
b435fdcd JG |
91 | error = -ENOMEM; |
92 | goto err_out_free; | |
1da177e4 LT |
93 | } |
94 | ||
b435fdcd JG |
95 | error = pci_enable_device(pci); |
96 | if (error) | |
97 | goto err_out_free; | |
1da177e4 LT |
98 | |
99 | port->open = fm801_gp_open; | |
100 | #ifdef HAVE_COOKED | |
101 | port->cooked_read = fm801_gp_cooked_read; | |
102 | #endif | |
103 | gameport_set_name(port, "FM801"); | |
104 | gameport_set_phys(port, "pci%s/gameport0", pci_name(pci)); | |
105 | port->dev.parent = &pci->dev; | |
106 | port->io = pci_resource_start(pci, 0); | |
107 | ||
108 | gp->gameport = port; | |
109 | gp->res_port = request_region(port->io, 0x10, "FM801 GP"); | |
110 | if (!gp->res_port) { | |
1da177e4 LT |
111 | printk(KERN_DEBUG "fm801-gp: unable to grab region 0x%x-0x%x\n", |
112 | port->io, port->io + 0x0f); | |
b435fdcd JG |
113 | error = -EBUSY; |
114 | goto err_out_disable_dev; | |
1da177e4 LT |
115 | } |
116 | ||
117 | pci_set_drvdata(pci, gp); | |
118 | ||
119 | outb(0x60, port->io + 0x0d); /* enable joystick 1 and 2 */ | |
120 | gameport_register_port(port); | |
121 | ||
122 | return 0; | |
b435fdcd JG |
123 | |
124 | err_out_disable_dev: | |
125 | pci_disable_device(pci); | |
126 | err_out_free: | |
127 | gameport_free_port(port); | |
128 | kfree(gp); | |
129 | return error; | |
1da177e4 LT |
130 | } |
131 | ||
132 | static void __devexit fm801_gp_remove(struct pci_dev *pci) | |
133 | { | |
134 | struct fm801_gp *gp = pci_get_drvdata(pci); | |
135 | ||
136 | if (gp) { | |
137 | gameport_unregister_port(gp->gameport); | |
138 | release_resource(gp->res_port); | |
139 | kfree(gp); | |
140 | } | |
141 | } | |
142 | ||
143 | static struct pci_device_id fm801_gp_id_table[] = { | |
144 | { PCI_VENDOR_ID_FORTEMEDIA, PCI_DEVICE_ID_FM801_GP, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0 }, | |
145 | { 0 } | |
146 | }; | |
147 | ||
148 | static struct pci_driver fm801_gp_driver = { | |
149 | .name = "FM801_gameport", | |
150 | .id_table = fm801_gp_id_table, | |
151 | .probe = fm801_gp_probe, | |
152 | .remove = __devexit_p(fm801_gp_remove), | |
153 | }; | |
154 | ||
155 | static int __init fm801_gp_init(void) | |
156 | { | |
157 | return pci_register_driver(&fm801_gp_driver); | |
158 | } | |
159 | ||
160 | static void __exit fm801_gp_exit(void) | |
161 | { | |
162 | pci_unregister_driver(&fm801_gp_driver); | |
163 | } | |
164 | ||
165 | module_init(fm801_gp_init); | |
166 | module_exit(fm801_gp_exit); | |
167 | ||
168 | MODULE_DEVICE_TABLE(pci, fm801_gp_id_table); | |
169 | ||
f445da83 | 170 | MODULE_DESCRIPTION("FM801 gameport driver"); |
1da177e4 LT |
171 | MODULE_AUTHOR("Takashi Iwai <tiwai@suse.de>"); |
172 | MODULE_LICENSE("GPL"); |