1 /* 2 * OpenCores Keyboard Controller Driver 3 * http://www.opencores.org/project,keyboardcontroller 4 * 5 * Copyright 2007-2009 HV Sistemas S.L. 6 * 7 * Licensed under the GPL-2 or later. 8 */ 9 10 #include <linux/input.h> 11 #include <linux/interrupt.h> 12 #include <linux/io.h> 13 #include <linux/ioport.h> 14 #include <linux/kernel.h> 15 #include <linux/module.h> 16 #include <linux/platform_device.h> 17 18 struct opencores_kbd { 19 struct input_dev *input; 20 struct resource *addr_res; 21 void __iomem *addr; 22 int irq; 23 unsigned short keycodes[128]; 24 }; 25 26 static irqreturn_t opencores_kbd_isr(int irq, void *dev_id) 27 { 28 struct opencores_kbd *opencores_kbd = dev_id; 29 struct input_dev *input = opencores_kbd->input; 30 unsigned char c; 31 32 c = readb(opencores_kbd->addr); 33 input_report_key(input, c & 0x7f, c & 0x80 ? 0 : 1); 34 input_sync(input); 35 36 return IRQ_HANDLED; 37 } 38 39 static int __devinit opencores_kbd_probe(struct platform_device *pdev) 40 { 41 struct input_dev *input; 42 struct opencores_kbd *opencores_kbd; 43 struct resource *res; 44 int irq, i, error; 45 46 res = platform_get_resource(pdev, IORESOURCE_MEM, 0); 47 if (!res) { 48 dev_err(&pdev->dev, "missing board memory resource\n"); 49 return -EINVAL; 50 } 51 52 irq = platform_get_irq(pdev, 0); 53 if (irq < 0) { 54 dev_err(&pdev->dev, "missing board IRQ resource\n"); 55 return -EINVAL; 56 } 57 58 opencores_kbd = kzalloc(sizeof(*opencores_kbd), GFP_KERNEL); 59 input = input_allocate_device(); 60 if (!opencores_kbd || !input) { 61 dev_err(&pdev->dev, "failed to allocate device structures\n"); 62 error = -ENOMEM; 63 goto err_free_mem; 64 } 65 66 opencores_kbd->addr_res = res; 67 res = request_mem_region(res->start, resource_size(res), pdev->name); 68 if (!res) { 69 dev_err(&pdev->dev, "failed to request I/O memory\n"); 70 error = -EBUSY; 71 goto err_free_mem; 72 } 73 74 opencores_kbd->addr = ioremap(res->start, resource_size(res)); 75 if (!opencores_kbd->addr) { 76 dev_err(&pdev->dev, "failed to remap I/O memory\n"); 77 error = -ENXIO; 78 goto err_rel_mem; 79 } 80 81 opencores_kbd->input = input; 82 opencores_kbd->irq = irq; 83 84 input->name = pdev->name; 85 input->phys = "opencores-kbd/input0"; 86 input->dev.parent = &pdev->dev; 87 88 input_set_drvdata(input, opencores_kbd); 89 90 input->id.bustype = BUS_HOST; 91 input->id.vendor = 0x0001; 92 input->id.product = 0x0001; 93 input->id.version = 0x0100; 94 95 input->keycode = opencores_kbd->keycodes; 96 input->keycodesize = sizeof(opencores_kbd->keycodes[0]); 97 input->keycodemax = ARRAY_SIZE(opencores_kbd->keycodes); 98 99 __set_bit(EV_KEY, input->evbit); 100 101 for (i = 0; i < ARRAY_SIZE(opencores_kbd->keycodes); i++) { 102 /* 103 * OpenCores controller happens to have scancodes match 104 * our KEY_* definitions. 105 */ 106 opencores_kbd->keycodes[i] = i; 107 __set_bit(opencores_kbd->keycodes[i], input->keybit); 108 } 109 __clear_bit(KEY_RESERVED, input->keybit); 110 111 error = request_irq(irq, &opencores_kbd_isr, 112 IRQF_TRIGGER_RISING, pdev->name, opencores_kbd); 113 if (error) { 114 dev_err(&pdev->dev, "unable to claim irq %d\n", irq); 115 goto err_unmap_mem; 116 } 117 118 error = input_register_device(input); 119 if (error) { 120 dev_err(&pdev->dev, "unable to register input device\n"); 121 goto err_free_irq; 122 } 123 124 platform_set_drvdata(pdev, opencores_kbd); 125 126 return 0; 127 128 err_free_irq: 129 free_irq(irq, opencores_kbd); 130 err_unmap_mem: 131 iounmap(opencores_kbd->addr); 132 err_rel_mem: 133 release_mem_region(res->start, resource_size(res)); 134 err_free_mem: 135 input_free_device(input); 136 kfree(opencores_kbd); 137 138 return error; 139 } 140 141 static int __devexit opencores_kbd_remove(struct platform_device *pdev) 142 { 143 struct opencores_kbd *opencores_kbd = platform_get_drvdata(pdev); 144 145 free_irq(opencores_kbd->irq, opencores_kbd); 146 147 iounmap(opencores_kbd->addr); 148 release_mem_region(opencores_kbd->addr_res->start, 149 resource_size(opencores_kbd->addr_res)); 150 input_unregister_device(opencores_kbd->input); 151 kfree(opencores_kbd); 152 153 platform_set_drvdata(pdev, NULL); 154 155 return 0; 156 } 157 158 static struct platform_driver opencores_kbd_device_driver = { 159 .probe = opencores_kbd_probe, 160 .remove = __devexit_p(opencores_kbd_remove), 161 .driver = { 162 .name = "opencores-kbd", 163 }, 164 }; 165 166 static int __init opencores_kbd_init(void) 167 { 168 return platform_driver_register(&opencores_kbd_device_driver); 169 } 170 module_init(opencores_kbd_init); 171 172 static void __exit opencores_kbd_exit(void) 173 { 174 platform_driver_unregister(&opencores_kbd_device_driver); 175 } 176 module_exit(opencores_kbd_exit); 177 178 MODULE_LICENSE("GPL"); 179 MODULE_AUTHOR("Javier Herrero <jherrero@hvsistemas.es>"); 180 MODULE_DESCRIPTION("Keyboard driver for OpenCores Keyboard Controller"); 181