1 // SPDX-License-Identifier: GPL-2.0-or-later 2 /* 3 * Copyright (c) 1999-2001 Vojtech Pavlik 4 * Copyright (c) 1999 Brian Gerst 5 */ 6 7 /* 8 * NS558 based standard IBM game port driver for Linux 9 */ 10 11 #include <asm/io.h> 12 13 #include <linux/module.h> 14 #include <linux/ioport.h> 15 #include <linux/init.h> 16 #include <linux/delay.h> 17 #include <linux/gameport.h> 18 #include <linux/slab.h> 19 #include <linux/pnp.h> 20 21 MODULE_AUTHOR("Vojtech Pavlik <vojtech@ucw.cz>"); 22 MODULE_DESCRIPTION("Classic gameport (ISA/PnP) driver"); 23 MODULE_LICENSE("GPL"); 24 25 static int ns558_isa_portlist[] = { 0x201, 0x200, 0x202, 0x203, 0x204, 0x205, 0x207, 0x209, 26 0x20b, 0x20c, 0x20e, 0x20f, 0x211, 0x219, 0x101, 0 }; 27 28 struct ns558 { 29 int type; 30 int io; 31 int size; 32 struct pnp_dev *dev; 33 struct gameport *gameport; 34 struct list_head node; 35 }; 36 37 static LIST_HEAD(ns558_list); 38 39 /* 40 * ns558_isa_probe() tries to find an isa gameport at the 41 * specified address, and also checks for mirrors. 42 * A joystick must be attached for this to work. 43 */ 44 45 static int ns558_isa_probe(int io) 46 { 47 int i, j, b; 48 unsigned char c, u, v; 49 struct ns558 *ns558; 50 struct gameport *port; 51 52 /* 53 * No one should be using this address. 54 */ 55 56 if (!request_region(io, 1, "ns558-isa")) 57 return -EBUSY; 58 59 /* 60 * We must not be able to write arbitrary values to the port. 61 * The lower two axis bits must be 1 after a write. 62 */ 63 64 c = inb(io); 65 outb(~c & ~3, io); 66 if (~(u = v = inb(io)) & 3) { 67 outb(c, io); 68 release_region(io, 1); 69 return -ENODEV; 70 } 71 /* 72 * After a trigger, there must be at least some bits changing. 73 */ 74 75 for (i = 0; i < 1000; i++) v &= inb(io); 76 77 if (u == v) { 78 outb(c, io); 79 release_region(io, 1); 80 return -ENODEV; 81 } 82 msleep(3); 83 /* 84 * After some time (4ms) the axes shouldn't change anymore. 85 */ 86 87 u = inb(io); 88 for (i = 0; i < 1000; i++) 89 if ((u ^ inb(io)) & 0xf) { 90 outb(c, io); 91 release_region(io, 1); 92 return -ENODEV; 93 } 94 /* 95 * And now find the number of mirrors of the port. 96 */ 97 98 for (i = 1; i < 5; i++) { 99 100 release_region(io & (-1 << (i - 1)), (1 << (i - 1))); 101 102 if (!request_region(io & (-1 << i), (1 << i), "ns558-isa")) 103 break; /* Don't disturb anyone */ 104 105 outb(0xff, io & (-1 << i)); 106 for (j = b = 0; j < 1000; j++) 107 if (inb(io & (-1 << i)) != inb((io & (-1 << i)) + (1 << i) - 1)) b++; 108 msleep(3); 109 110 if (b > 300) { /* We allow 30% difference */ 111 release_region(io & (-1 << i), (1 << i)); 112 break; 113 } 114 } 115 116 i--; 117 118 if (i != 4) { 119 if (!request_region(io & (-1 << i), (1 << i), "ns558-isa")) 120 return -EBUSY; 121 } 122 123 ns558 = kzalloc(sizeof(*ns558), GFP_KERNEL); 124 port = gameport_allocate_port(); 125 if (!ns558 || !port) { 126 printk(KERN_ERR "ns558: Memory allocation failed.\n"); 127 release_region(io & (-1 << i), (1 << i)); 128 kfree(ns558); 129 gameport_free_port(port); 130 return -ENOMEM; 131 } 132 133 ns558->io = io; 134 ns558->size = 1 << i; 135 ns558->gameport = port; 136 137 port->io = io; 138 gameport_set_name(port, "NS558 ISA Gameport"); 139 gameport_set_phys(port, "isa%04x/gameport0", io & (-1 << i)); 140 141 gameport_register_port(port); 142 143 list_add(&ns558->node, &ns558_list); 144 145 return 0; 146 } 147 148 #ifdef CONFIG_PNP 149 150 static const struct pnp_device_id pnp_devids[] = { 151 { .id = "@P@0001", .driver_data = 0 }, /* ALS 100 */ 152 { .id = "@P@0020", .driver_data = 0 }, /* ALS 200 */ 153 { .id = "@P@1001", .driver_data = 0 }, /* ALS 100+ */ 154 { .id = "@P@2001", .driver_data = 0 }, /* ALS 120 */ 155 { .id = "ASB16fd", .driver_data = 0 }, /* AdLib NSC16 */ 156 { .id = "AZT3001", .driver_data = 0 }, /* AZT1008 */ 157 { .id = "CDC0001", .driver_data = 0 }, /* Opl3-SAx */ 158 { .id = "CSC0001", .driver_data = 0 }, /* CS4232 */ 159 { .id = "CSC000f", .driver_data = 0 }, /* CS4236 */ 160 { .id = "CSC0101", .driver_data = 0 }, /* CS4327 */ 161 { .id = "CTL7001", .driver_data = 0 }, /* SB16 */ 162 { .id = "CTL7002", .driver_data = 0 }, /* AWE64 */ 163 { .id = "CTL7005", .driver_data = 0 }, /* Vibra16 */ 164 { .id = "ENS2020", .driver_data = 0 }, /* SoundscapeVIVO */ 165 { .id = "ESS0001", .driver_data = 0 }, /* ES1869 */ 166 { .id = "ESS0005", .driver_data = 0 }, /* ES1878 */ 167 { .id = "ESS6880", .driver_data = 0 }, /* ES688 */ 168 { .id = "IBM0012", .driver_data = 0 }, /* CS4232 */ 169 { .id = "OPT0001", .driver_data = 0 }, /* OPTi Audio16 */ 170 { .id = "YMH0006", .driver_data = 0 }, /* Opl3-SA */ 171 { .id = "YMH0022", .driver_data = 0 }, /* Opl3-SAx */ 172 { .id = "PNPb02f", .driver_data = 0 }, /* Generic */ 173 { .id = "", }, 174 }; 175 176 MODULE_DEVICE_TABLE(pnp, pnp_devids); 177 178 static int ns558_pnp_probe(struct pnp_dev *dev, const struct pnp_device_id *did) 179 { 180 int ioport, iolen; 181 struct ns558 *ns558; 182 struct gameport *port; 183 184 if (!pnp_port_valid(dev, 0)) { 185 printk(KERN_WARNING "ns558: No i/o ports on a gameport? Weird\n"); 186 return -ENODEV; 187 } 188 189 ioport = pnp_port_start(dev, 0); 190 iolen = pnp_port_len(dev, 0); 191 192 if (!request_region(ioport, iolen, "ns558-pnp")) 193 return -EBUSY; 194 195 ns558 = kzalloc(sizeof(*ns558), GFP_KERNEL); 196 port = gameport_allocate_port(); 197 if (!ns558 || !port) { 198 printk(KERN_ERR "ns558: Memory allocation failed\n"); 199 kfree(ns558); 200 gameport_free_port(port); 201 return -ENOMEM; 202 } 203 204 ns558->io = ioport; 205 ns558->size = iolen; 206 ns558->dev = dev; 207 ns558->gameport = port; 208 209 gameport_set_name(port, "NS558 PnP Gameport"); 210 gameport_set_phys(port, "pnp%s/gameport0", dev_name(&dev->dev)); 211 port->dev.parent = &dev->dev; 212 port->io = ioport; 213 214 gameport_register_port(port); 215 216 list_add_tail(&ns558->node, &ns558_list); 217 return 0; 218 } 219 220 static struct pnp_driver ns558_pnp_driver = { 221 .name = "ns558", 222 .id_table = pnp_devids, 223 .probe = ns558_pnp_probe, 224 }; 225 226 #else 227 228 static struct pnp_driver ns558_pnp_driver; 229 230 #endif 231 232 static int __init ns558_init(void) 233 { 234 int i = 0; 235 int error; 236 237 error = pnp_register_driver(&ns558_pnp_driver); 238 if (error && error != -ENODEV) /* should be ENOSYS really */ 239 return error; 240 241 /* 242 * Probe ISA ports after PnP, so that PnP ports that are already 243 * enabled get detected as PnP. This may be suboptimal in multi-device 244 * configurations, but saves hassle with simple setups. 245 */ 246 247 while (ns558_isa_portlist[i]) 248 ns558_isa_probe(ns558_isa_portlist[i++]); 249 250 return list_empty(&ns558_list) && error ? -ENODEV : 0; 251 } 252 253 static void __exit ns558_exit(void) 254 { 255 struct ns558 *ns558, *safe; 256 257 list_for_each_entry_safe(ns558, safe, &ns558_list, node) { 258 gameport_unregister_port(ns558->gameport); 259 release_region(ns558->io & ~(ns558->size - 1), ns558->size); 260 kfree(ns558); 261 } 262 263 pnp_unregister_driver(&ns558_pnp_driver); 264 } 265 266 module_init(ns558_init); 267 module_exit(ns558_exit); 268