]>
Commit | Line | Data |
---|---|---|
422b552d JH |
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"); |