1 // SPDX-License-Identifier: GPL-2.0-only 2 /* 3 * linux/drivers/input/serio/pcips2.c 4 * 5 * Copyright (C) 2003 Russell King, All Rights Reserved. 6 * 7 * I'm not sure if this is a generic PS/2 PCI interface or specific to 8 * the Mobility Electronics docking station. 9 */ 10 #include <linux/module.h> 11 #include <linux/interrupt.h> 12 #include <linux/ioport.h> 13 #include <linux/input.h> 14 #include <linux/pci.h> 15 #include <linux/slab.h> 16 #include <linux/serio.h> 17 #include <linux/delay.h> 18 #include <asm/io.h> 19 20 #define PS2_CTRL (0) 21 #define PS2_STATUS (1) 22 #define PS2_DATA (2) 23 24 #define PS2_CTRL_CLK (1<<0) 25 #define PS2_CTRL_DAT (1<<1) 26 #define PS2_CTRL_TXIRQ (1<<2) 27 #define PS2_CTRL_ENABLE (1<<3) 28 #define PS2_CTRL_RXIRQ (1<<4) 29 30 #define PS2_STAT_CLK (1<<0) 31 #define PS2_STAT_DAT (1<<1) 32 #define PS2_STAT_PARITY (1<<2) 33 #define PS2_STAT_RXFULL (1<<5) 34 #define PS2_STAT_TXBUSY (1<<6) 35 #define PS2_STAT_TXEMPTY (1<<7) 36 37 struct pcips2_data { 38 struct serio *io; 39 unsigned int base; 40 struct pci_dev *dev; 41 }; 42 43 static int pcips2_write(struct serio *io, unsigned char val) 44 { 45 struct pcips2_data *ps2if = io->port_data; 46 unsigned int stat; 47 48 do { 49 stat = inb(ps2if->base + PS2_STATUS); 50 cpu_relax(); 51 } while (!(stat & PS2_STAT_TXEMPTY)); 52 53 outb(val, ps2if->base + PS2_DATA); 54 55 return 0; 56 } 57 58 static irqreturn_t pcips2_interrupt(int irq, void *devid) 59 { 60 struct pcips2_data *ps2if = devid; 61 unsigned char status, scancode; 62 int handled = 0; 63 64 do { 65 unsigned int flag; 66 67 status = inb(ps2if->base + PS2_STATUS); 68 if (!(status & PS2_STAT_RXFULL)) 69 break; 70 handled = 1; 71 scancode = inb(ps2if->base + PS2_DATA); 72 if (status == 0xff && scancode == 0xff) 73 break; 74 75 flag = (status & PS2_STAT_PARITY) ? 0 : SERIO_PARITY; 76 77 if (hweight8(scancode) & 1) 78 flag ^= SERIO_PARITY; 79 80 serio_interrupt(ps2if->io, scancode, flag); 81 } while (1); 82 return IRQ_RETVAL(handled); 83 } 84 85 static void pcips2_flush_input(struct pcips2_data *ps2if) 86 { 87 unsigned char status, scancode; 88 89 do { 90 status = inb(ps2if->base + PS2_STATUS); 91 if (!(status & PS2_STAT_RXFULL)) 92 break; 93 scancode = inb(ps2if->base + PS2_DATA); 94 if (status == 0xff && scancode == 0xff) 95 break; 96 } while (1); 97 } 98 99 static int pcips2_open(struct serio *io) 100 { 101 struct pcips2_data *ps2if = io->port_data; 102 int ret, val = 0; 103 104 outb(PS2_CTRL_ENABLE, ps2if->base); 105 pcips2_flush_input(ps2if); 106 107 ret = request_irq(ps2if->dev->irq, pcips2_interrupt, IRQF_SHARED, 108 "pcips2", ps2if); 109 if (ret == 0) 110 val = PS2_CTRL_ENABLE | PS2_CTRL_RXIRQ; 111 112 outb(val, ps2if->base); 113 114 return ret; 115 } 116 117 static void pcips2_close(struct serio *io) 118 { 119 struct pcips2_data *ps2if = io->port_data; 120 121 outb(0, ps2if->base); 122 123 free_irq(ps2if->dev->irq, ps2if); 124 } 125 126 static int pcips2_probe(struct pci_dev *dev, const struct pci_device_id *id) 127 { 128 struct pcips2_data *ps2if; 129 struct serio *serio; 130 int ret; 131 132 ret = pci_enable_device(dev); 133 if (ret) 134 goto out; 135 136 ret = pci_request_regions(dev, "pcips2"); 137 if (ret) 138 goto disable; 139 140 ps2if = kzalloc(sizeof(*ps2if), GFP_KERNEL); 141 serio = kzalloc(sizeof(*serio), GFP_KERNEL); 142 if (!ps2if || !serio) { 143 ret = -ENOMEM; 144 goto release; 145 } 146 147 148 serio->id.type = SERIO_8042; 149 serio->write = pcips2_write; 150 serio->open = pcips2_open; 151 serio->close = pcips2_close; 152 strscpy(serio->name, pci_name(dev), sizeof(serio->name)); 153 strscpy(serio->phys, dev_name(&dev->dev), sizeof(serio->phys)); 154 serio->port_data = ps2if; 155 serio->dev.parent = &dev->dev; 156 ps2if->io = serio; 157 ps2if->dev = dev; 158 ps2if->base = pci_resource_start(dev, 0); 159 160 pci_set_drvdata(dev, ps2if); 161 162 serio_register_port(ps2if->io); 163 return 0; 164 165 release: 166 kfree(ps2if); 167 kfree(serio); 168 pci_release_regions(dev); 169 disable: 170 pci_disable_device(dev); 171 out: 172 return ret; 173 } 174 175 static void pcips2_remove(struct pci_dev *dev) 176 { 177 struct pcips2_data *ps2if = pci_get_drvdata(dev); 178 179 serio_unregister_port(ps2if->io); 180 kfree(ps2if); 181 pci_release_regions(dev); 182 pci_disable_device(dev); 183 } 184 185 static const struct pci_device_id pcips2_ids[] = { 186 { 187 .vendor = 0x14f2, /* MOBILITY */ 188 .device = 0x0123, /* Keyboard */ 189 .subvendor = PCI_ANY_ID, 190 .subdevice = PCI_ANY_ID, 191 .class = PCI_CLASS_INPUT_KEYBOARD << 8, 192 .class_mask = 0xffff00, 193 }, 194 { 195 .vendor = 0x14f2, /* MOBILITY */ 196 .device = 0x0124, /* Mouse */ 197 .subvendor = PCI_ANY_ID, 198 .subdevice = PCI_ANY_ID, 199 .class = PCI_CLASS_INPUT_MOUSE << 8, 200 .class_mask = 0xffff00, 201 }, 202 { 0, } 203 }; 204 MODULE_DEVICE_TABLE(pci, pcips2_ids); 205 206 static struct pci_driver pcips2_driver = { 207 .name = "pcips2", 208 .id_table = pcips2_ids, 209 .probe = pcips2_probe, 210 .remove = pcips2_remove, 211 }; 212 213 module_pci_driver(pcips2_driver); 214 215 MODULE_LICENSE("GPL"); 216 MODULE_AUTHOR("Russell King <rmk@arm.linux.org.uk>"); 217 MODULE_DESCRIPTION("PCI PS/2 keyboard/mouse driver"); 218