1 // SPDX-License-Identifier: GPL-2.0-or-later 2 /* 3 * Copyright (c) 1998-2001 Vojtech Pavlik 4 */ 5 6 /* 7 * PDPI Lightning 4 gamecard driver for Linux. 8 */ 9 10 #include <asm/io.h> 11 #include <linux/delay.h> 12 #include <linux/errno.h> 13 #include <linux/ioport.h> 14 #include <linux/kernel.h> 15 #include <linux/module.h> 16 #include <linux/init.h> 17 #include <linux/gameport.h> 18 19 #define L4_PORT 0x201 20 #define L4_SELECT_ANALOG 0xa4 21 #define L4_SELECT_DIGITAL 0xa5 22 #define L4_SELECT_SECONDARY 0xa6 23 #define L4_CMD_ID 0x80 24 #define L4_CMD_GETCAL 0x92 25 #define L4_CMD_SETCAL 0x93 26 #define L4_ID 0x04 27 #define L4_BUSY 0x01 28 #define L4_TIMEOUT 80 /* 80 us */ 29 30 MODULE_AUTHOR("Vojtech Pavlik <vojtech@ucw.cz>"); 31 MODULE_DESCRIPTION("PDPI Lightning 4 gamecard driver"); 32 MODULE_LICENSE("GPL"); 33 34 struct l4 { 35 struct gameport *gameport; 36 unsigned char port; 37 }; 38 39 static struct l4 l4_ports[8]; 40 41 /* 42 * l4_wait_ready() waits for the L4 to become ready. 43 */ 44 45 static int l4_wait_ready(void) 46 { 47 unsigned int t = L4_TIMEOUT; 48 49 while ((inb(L4_PORT) & L4_BUSY) && t > 0) t--; 50 return -(t <= 0); 51 } 52 53 /* 54 * l4_cooked_read() reads data from the Lightning 4. 55 */ 56 57 static int l4_cooked_read(struct gameport *gameport, int *axes, int *buttons) 58 { 59 struct l4 *l4 = gameport->port_data; 60 unsigned char status; 61 int i, result = -1; 62 63 outb(L4_SELECT_ANALOG, L4_PORT); 64 outb(L4_SELECT_DIGITAL + (l4->port >> 2), L4_PORT); 65 66 if (inb(L4_PORT) & L4_BUSY) goto fail; 67 outb(l4->port & 3, L4_PORT); 68 69 if (l4_wait_ready()) goto fail; 70 status = inb(L4_PORT); 71 72 for (i = 0; i < 4; i++) 73 if (status & (1 << i)) { 74 if (l4_wait_ready()) goto fail; 75 axes[i] = inb(L4_PORT); 76 if (axes[i] > 252) axes[i] = -1; 77 } 78 79 if (status & 0x10) { 80 if (l4_wait_ready()) goto fail; 81 *buttons = inb(L4_PORT) & 0x0f; 82 } 83 84 result = 0; 85 86 fail: outb(L4_SELECT_ANALOG, L4_PORT); 87 return result; 88 } 89 90 static int l4_open(struct gameport *gameport, int mode) 91 { 92 struct l4 *l4 = gameport->port_data; 93 94 if (l4->port != 0 && mode != GAMEPORT_MODE_COOKED) 95 return -1; 96 outb(L4_SELECT_ANALOG, L4_PORT); 97 return 0; 98 } 99 100 /* 101 * l4_getcal() reads the L4 with calibration values. 102 */ 103 104 static int l4_getcal(int port, int *cal) 105 { 106 int i, result = -1; 107 108 outb(L4_SELECT_ANALOG, L4_PORT); 109 outb(L4_SELECT_DIGITAL + (port >> 2), L4_PORT); 110 if (inb(L4_PORT) & L4_BUSY) 111 goto out; 112 113 outb(L4_CMD_GETCAL, L4_PORT); 114 if (l4_wait_ready()) 115 goto out; 116 117 if (inb(L4_PORT) != L4_SELECT_DIGITAL + (port >> 2)) 118 goto out; 119 120 if (l4_wait_ready()) 121 goto out; 122 outb(port & 3, L4_PORT); 123 124 for (i = 0; i < 4; i++) { 125 if (l4_wait_ready()) 126 goto out; 127 cal[i] = inb(L4_PORT); 128 } 129 130 result = 0; 131 132 out: outb(L4_SELECT_ANALOG, L4_PORT); 133 return result; 134 } 135 136 /* 137 * l4_setcal() programs the L4 with calibration values. 138 */ 139 140 static int l4_setcal(int port, int *cal) 141 { 142 int i, result = -1; 143 144 outb(L4_SELECT_ANALOG, L4_PORT); 145 outb(L4_SELECT_DIGITAL + (port >> 2), L4_PORT); 146 if (inb(L4_PORT) & L4_BUSY) 147 goto out; 148 149 outb(L4_CMD_SETCAL, L4_PORT); 150 if (l4_wait_ready()) 151 goto out; 152 153 if (inb(L4_PORT) != L4_SELECT_DIGITAL + (port >> 2)) 154 goto out; 155 156 if (l4_wait_ready()) 157 goto out; 158 outb(port & 3, L4_PORT); 159 160 for (i = 0; i < 4; i++) { 161 if (l4_wait_ready()) 162 goto out; 163 outb(cal[i], L4_PORT); 164 } 165 166 result = 0; 167 168 out: outb(L4_SELECT_ANALOG, L4_PORT); 169 return result; 170 } 171 172 /* 173 * l4_calibrate() calibrates the L4 for the attached device, so 174 * that the device's resistance fits into the L4's 8-bit range. 175 */ 176 177 static int l4_calibrate(struct gameport *gameport, int *axes, int *max) 178 { 179 int i, t; 180 int cal[4]; 181 struct l4 *l4 = gameport->port_data; 182 183 if (l4_getcal(l4->port, cal)) 184 return -1; 185 186 for (i = 0; i < 4; i++) { 187 t = (max[i] * cal[i]) / 200; 188 t = (t < 1) ? 1 : ((t > 255) ? 255 : t); 189 axes[i] = (axes[i] < 0) ? -1 : (axes[i] * cal[i]) / t; 190 axes[i] = (axes[i] > 252) ? 252 : axes[i]; 191 cal[i] = t; 192 } 193 194 if (l4_setcal(l4->port, cal)) 195 return -1; 196 197 return 0; 198 } 199 200 static int __init l4_create_ports(int card_no) 201 { 202 struct l4 *l4; 203 struct gameport *port; 204 int i, idx; 205 206 for (i = 0; i < 4; i++) { 207 208 idx = card_no * 4 + i; 209 l4 = &l4_ports[idx]; 210 211 if (!(l4->gameport = port = gameport_allocate_port())) { 212 printk(KERN_ERR "lightning: Memory allocation failed\n"); 213 while (--i >= 0) { 214 gameport_free_port(l4->gameport); 215 l4->gameport = NULL; 216 } 217 return -ENOMEM; 218 } 219 l4->port = idx; 220 221 port->port_data = l4; 222 port->open = l4_open; 223 port->cooked_read = l4_cooked_read; 224 port->calibrate = l4_calibrate; 225 226 gameport_set_name(port, "PDPI Lightning 4"); 227 gameport_set_phys(port, "isa%04x/gameport%d", L4_PORT, idx); 228 229 if (idx == 0) 230 port->io = L4_PORT; 231 } 232 233 return 0; 234 } 235 236 static int __init l4_add_card(int card_no) 237 { 238 int cal[4] = { 255, 255, 255, 255 }; 239 int i, rev, result; 240 struct l4 *l4; 241 242 outb(L4_SELECT_ANALOG, L4_PORT); 243 outb(L4_SELECT_DIGITAL + card_no, L4_PORT); 244 245 if (inb(L4_PORT) & L4_BUSY) 246 return -1; 247 outb(L4_CMD_ID, L4_PORT); 248 249 if (l4_wait_ready()) 250 return -1; 251 252 if (inb(L4_PORT) != L4_SELECT_DIGITAL + card_no) 253 return -1; 254 255 if (l4_wait_ready()) 256 return -1; 257 if (inb(L4_PORT) != L4_ID) 258 return -1; 259 260 if (l4_wait_ready()) 261 return -1; 262 rev = inb(L4_PORT); 263 264 if (!rev) 265 return -1; 266 267 result = l4_create_ports(card_no); 268 if (result) 269 return result; 270 271 printk(KERN_INFO "gameport: PDPI Lightning 4 %s card v%d.%d at %#x\n", 272 card_no ? "secondary" : "primary", rev >> 4, rev, L4_PORT); 273 274 for (i = 0; i < 4; i++) { 275 l4 = &l4_ports[card_no * 4 + i]; 276 277 if (rev > 0x28) /* on 2.9+ the setcal command works correctly */ 278 l4_setcal(l4->port, cal); 279 gameport_register_port(l4->gameport); 280 } 281 282 return 0; 283 } 284 285 static int __init l4_init(void) 286 { 287 int i, cards = 0; 288 289 if (!request_region(L4_PORT, 1, "lightning")) 290 return -EBUSY; 291 292 for (i = 0; i < 2; i++) 293 if (l4_add_card(i) == 0) 294 cards++; 295 296 outb(L4_SELECT_ANALOG, L4_PORT); 297 298 if (!cards) { 299 release_region(L4_PORT, 1); 300 return -ENODEV; 301 } 302 303 return 0; 304 } 305 306 static void __exit l4_exit(void) 307 { 308 int i; 309 int cal[4] = { 59, 59, 59, 59 }; 310 311 for (i = 0; i < 8; i++) 312 if (l4_ports[i].gameport) { 313 l4_setcal(l4_ports[i].port, cal); 314 gameport_unregister_port(l4_ports[i].gameport); 315 } 316 317 outb(L4_SELECT_ANALOG, L4_PORT); 318 release_region(L4_PORT, 1); 319 } 320 321 module_init(l4_init); 322 module_exit(l4_exit); 323