/* * SGI O2 MACE PS2 controller driver for linux * * Copyright (C) 2002 Vivien Chappelier * * This program is free software; you can redistribute it and/or modify * it under the terms of the GNU General Public License version 2 as * published by the Free Software Foundation */ #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include MODULE_AUTHOR("Vivien Chappelier port_data)->port; unsigned int timeout = MACE_PS2_TIMEOUT; do { if (port->status & PS2_STATUS_TX_EMPTY) { port->tx = val; return 0; } udelay(50); } while (timeout--); return -1; } static irqreturn_t maceps2_interrupt(int irq, void *dev_id, struct pt_regs *regs) { struct serio *dev = dev_id; struct mace_ps2port *port = ((struct maceps2_data *)dev->port_data)->port; unsigned long byte; if (port->status & PS2_STATUS_RX_FULL) { byte = port->rx; serio_interrupt(dev, byte & 0xff, 0, regs); } return IRQ_HANDLED; } static int maceps2_open(struct serio *dev) { struct maceps2_data *data = (struct maceps2_data *)dev->port_data; if (request_irq(data->irq, maceps2_interrupt, 0, "PS2 port", dev)) { printk(KERN_ERR "Could not allocate PS/2 IRQ\n"); return -EBUSY; } /* Reset port */ data->port->control = PS2_CONTROL_TX_CLOCK_DISABLE | PS2_CONTROL_RESET; udelay(100); /* Enable interrupts */ data->port->control = PS2_CONTROL_RX_CLOCK_ENABLE | PS2_CONTROL_TX_ENABLE | PS2_CONTROL_RX_INT_ENABLE; return 0; } static void maceps2_close(struct serio *dev) { struct maceps2_data *data = (struct maceps2_data *)dev->port_data; data->port->control = PS2_CONTROL_TX_CLOCK_DISABLE | PS2_CONTROL_RESET; udelay(100); free_irq(data->irq, dev); } static struct serio * __init maceps2_allocate_port(int idx) { struct serio *serio; serio = kmalloc(sizeof(struct serio), GFP_KERNEL); if (serio) { memset(serio, 0, sizeof(struct serio)); serio->id.type = SERIO_8042; serio->write = maceps2_write; serio->open = maceps2_open; serio->close = maceps2_close; snprintf(serio->name, sizeof(serio->name), "MACE PS/2 port%d", idx); snprintf(serio->phys, sizeof(serio->phys), "mace/serio%d", idx); serio->port_data = &port_data[idx]; serio->dev.parent = &maceps2_device->dev; } return serio; } static int __init maceps2_init(void) { maceps2_device = platform_device_register_simple("maceps2", -1, NULL, 0); if (IS_ERR(maceps2_device)) return PTR_ERR(maceps2_device); port_data[0].port = &mace->perif.ps2.keyb; port_data[0].irq = MACEISA_KEYB_IRQ; port_data[1].port = &mace->perif.ps2.mouse; port_data[1].irq = MACEISA_MOUSE_IRQ; maceps2_port[0] = maceps2_allocate_port(0); maceps2_port[1] = maceps2_allocate_port(1); if (!maceps2_port[0] || !maceps2_port[1]) { kfree(maceps2_port[0]); kfree(maceps2_port[1]); platform_device_unregister(maceps2_device); return -ENOMEM; } serio_register_port(maceps2_port[0]); serio_register_port(maceps2_port[1]); return 0; } static void __exit maceps2_exit(void) { serio_unregister_port(maceps2_port[0]); serio_unregister_port(maceps2_port[1]); platform_device_unregister(maceps2_device); } module_init(maceps2_init); module_exit(maceps2_exit);