Commit | Line | Data |
---|---|---|
bc95df78 RK |
1 | /* |
2 | * SPEAr Keyboard Driver | |
3 | * Based on omap-keypad driver | |
4 | * | |
5 | * Copyright (C) 2010 ST Microelectronics | |
6 | * Rajeev Kumar<rajeev-dlh.kumar@st.com> | |
7 | * | |
8 | * This file is licensed under the terms of the GNU General Public | |
9 | * License version 2. This program is licensed "as is" without any | |
10 | * warranty of any kind, whether express or implied. | |
11 | */ | |
12 | ||
13 | #include <linux/clk.h> | |
14 | #include <linux/errno.h> | |
15 | #include <linux/init.h> | |
16 | #include <linux/interrupt.h> | |
17 | #include <linux/input.h> | |
18 | #include <linux/io.h> | |
19 | #include <linux/irq.h> | |
20 | #include <linux/kernel.h> | |
21 | #include <linux/module.h> | |
22 | #include <linux/platform_device.h> | |
23 | #include <linux/pm_wakeup.h> | |
24 | #include <linux/slab.h> | |
25 | #include <linux/types.h> | |
26 | #include <plat/keyboard.h> | |
27 | ||
28 | /* Keyboard Registers */ | |
29 | #define MODE_REG 0x00 /* 16 bit reg */ | |
30 | #define STATUS_REG 0x0C /* 2 bit reg */ | |
31 | #define DATA_REG 0x10 /* 8 bit reg */ | |
32 | #define INTR_MASK 0x54 | |
33 | ||
34 | /* Register Values */ | |
35 | /* | |
36 | * pclk freq mask = (APB FEQ -1)= 82 MHZ.Programme bit 15-9 in mode | |
37 | * control register as 1010010(82MHZ) | |
38 | */ | |
39 | #define PCLK_FREQ_MSK 0xA400 /* 82 MHz */ | |
40 | #define START_SCAN 0x0100 | |
41 | #define SCAN_RATE_10 0x0000 | |
42 | #define SCAN_RATE_20 0x0004 | |
43 | #define SCAN_RATE_40 0x0008 | |
44 | #define SCAN_RATE_80 0x000C | |
45 | #define MODE_KEYBOARD 0x0002 | |
46 | #define DATA_AVAIL 0x2 | |
47 | ||
48 | #define KEY_MASK 0xFF000000 | |
49 | #define KEY_VALUE 0x00FFFFFF | |
50 | #define ROW_MASK 0xF0 | |
51 | #define COLUMN_MASK 0x0F | |
52 | #define ROW_SHIFT 4 | |
53 | ||
54 | struct spear_kbd { | |
55 | struct input_dev *input; | |
56 | struct resource *res; | |
57 | void __iomem *io_base; | |
58 | struct clk *clk; | |
59 | unsigned int irq; | |
60 | unsigned short last_key; | |
61 | unsigned short keycodes[256]; | |
62 | }; | |
63 | ||
64 | static irqreturn_t spear_kbd_interrupt(int irq, void *dev_id) | |
65 | { | |
66 | struct spear_kbd *kbd = dev_id; | |
67 | struct input_dev *input = kbd->input; | |
68 | unsigned int key; | |
69 | u8 sts, val; | |
70 | ||
71 | sts = readb(kbd->io_base + STATUS_REG); | |
799a2a21 | 72 | if (!(sts & DATA_AVAIL)) |
bc95df78 RK |
73 | return IRQ_NONE; |
74 | ||
75 | if (kbd->last_key != KEY_RESERVED) { | |
76 | input_report_key(input, kbd->last_key, 0); | |
77 | kbd->last_key = KEY_RESERVED; | |
78 | } | |
79 | ||
80 | /* following reads active (row, col) pair */ | |
81 | val = readb(kbd->io_base + DATA_REG); | |
82 | key = kbd->keycodes[val]; | |
83 | ||
84 | input_event(input, EV_MSC, MSC_SCAN, val); | |
85 | input_report_key(input, key, 1); | |
86 | input_sync(input); | |
87 | ||
88 | kbd->last_key = key; | |
89 | ||
90 | /* clear interrupt */ | |
91 | writeb(0, kbd->io_base + STATUS_REG); | |
92 | ||
93 | return IRQ_HANDLED; | |
94 | } | |
95 | ||
96 | static int spear_kbd_open(struct input_dev *dev) | |
97 | { | |
98 | struct spear_kbd *kbd = input_get_drvdata(dev); | |
99 | int error; | |
100 | u16 val; | |
101 | ||
102 | kbd->last_key = KEY_RESERVED; | |
103 | ||
104 | error = clk_enable(kbd->clk); | |
105 | if (error) | |
106 | return error; | |
107 | ||
108 | /* program keyboard */ | |
109 | val = SCAN_RATE_80 | MODE_KEYBOARD | PCLK_FREQ_MSK; | |
110 | writew(val, kbd->io_base + MODE_REG); | |
111 | writeb(1, kbd->io_base + STATUS_REG); | |
112 | ||
113 | /* start key scan */ | |
114 | val = readw(kbd->io_base + MODE_REG); | |
115 | val |= START_SCAN; | |
116 | writew(val, kbd->io_base + MODE_REG); | |
117 | ||
118 | return 0; | |
119 | } | |
120 | ||
121 | static void spear_kbd_close(struct input_dev *dev) | |
122 | { | |
123 | struct spear_kbd *kbd = input_get_drvdata(dev); | |
124 | u16 val; | |
125 | ||
126 | /* stop key scan */ | |
127 | val = readw(kbd->io_base + MODE_REG); | |
128 | val &= ~START_SCAN; | |
129 | writew(val, kbd->io_base + MODE_REG); | |
130 | ||
131 | clk_disable(kbd->clk); | |
132 | ||
133 | kbd->last_key = KEY_RESERVED; | |
134 | } | |
135 | ||
136 | static int __devinit spear_kbd_probe(struct platform_device *pdev) | |
137 | { | |
138 | const struct kbd_platform_data *pdata = pdev->dev.platform_data; | |
139 | const struct matrix_keymap_data *keymap; | |
140 | struct spear_kbd *kbd; | |
141 | struct input_dev *input_dev; | |
142 | struct resource *res; | |
143 | int irq; | |
144 | int error; | |
145 | ||
146 | if (!pdata) { | |
147 | dev_err(&pdev->dev, "Invalid platform data\n"); | |
148 | return -EINVAL; | |
149 | } | |
150 | ||
151 | keymap = pdata->keymap; | |
152 | if (!keymap) { | |
153 | dev_err(&pdev->dev, "no keymap defined\n"); | |
154 | return -EINVAL; | |
155 | } | |
156 | ||
157 | res = platform_get_resource(pdev, IORESOURCE_MEM, 0); | |
158 | if (!res) { | |
159 | dev_err(&pdev->dev, "no keyboard resource defined\n"); | |
160 | return -EBUSY; | |
161 | } | |
162 | ||
163 | irq = platform_get_irq(pdev, 0); | |
164 | if (irq < 0) { | |
165 | dev_err(&pdev->dev, "not able to get irq for the device\n"); | |
166 | return irq; | |
167 | } | |
168 | ||
169 | kbd = kzalloc(sizeof(*kbd), GFP_KERNEL); | |
170 | input_dev = input_allocate_device(); | |
171 | if (!kbd || !input_dev) { | |
172 | dev_err(&pdev->dev, "out of memory\n"); | |
173 | error = -ENOMEM; | |
174 | goto err_free_mem; | |
175 | } | |
176 | ||
177 | kbd->input = input_dev; | |
178 | kbd->irq = irq; | |
179 | kbd->res = request_mem_region(res->start, resource_size(res), | |
180 | pdev->name); | |
181 | if (!kbd->res) { | |
182 | dev_err(&pdev->dev, "keyboard region already claimed\n"); | |
183 | error = -EBUSY; | |
184 | goto err_free_mem; | |
185 | } | |
186 | ||
187 | kbd->io_base = ioremap(res->start, resource_size(res)); | |
188 | if (!kbd->io_base) { | |
189 | dev_err(&pdev->dev, "ioremap failed for kbd_region\n"); | |
190 | error = -ENOMEM; | |
191 | goto err_release_mem_region; | |
192 | } | |
193 | ||
194 | kbd->clk = clk_get(&pdev->dev, NULL); | |
195 | if (IS_ERR(kbd->clk)) { | |
196 | error = PTR_ERR(kbd->clk); | |
197 | goto err_iounmap; | |
198 | } | |
199 | ||
200 | input_dev->name = "Spear Keyboard"; | |
201 | input_dev->phys = "keyboard/input0"; | |
202 | input_dev->dev.parent = &pdev->dev; | |
203 | input_dev->id.bustype = BUS_HOST; | |
204 | input_dev->id.vendor = 0x0001; | |
205 | input_dev->id.product = 0x0001; | |
206 | input_dev->id.version = 0x0100; | |
207 | input_dev->open = spear_kbd_open; | |
208 | input_dev->close = spear_kbd_close; | |
209 | ||
210 | __set_bit(EV_KEY, input_dev->evbit); | |
211 | if (pdata->rep) | |
212 | __set_bit(EV_REP, input_dev->evbit); | |
213 | input_set_capability(input_dev, EV_MSC, MSC_SCAN); | |
214 | ||
215 | input_dev->keycode = kbd->keycodes; | |
216 | input_dev->keycodesize = sizeof(kbd->keycodes[0]); | |
217 | input_dev->keycodemax = ARRAY_SIZE(kbd->keycodes); | |
218 | ||
219 | matrix_keypad_build_keymap(keymap, ROW_SHIFT, | |
220 | input_dev->keycode, input_dev->keybit); | |
221 | ||
222 | input_set_drvdata(input_dev, kbd); | |
223 | ||
224 | error = request_irq(irq, spear_kbd_interrupt, 0, "keyboard", kbd); | |
225 | if (error) { | |
226 | dev_err(&pdev->dev, "request_irq fail\n"); | |
227 | goto err_put_clk; | |
228 | } | |
229 | ||
230 | error = input_register_device(input_dev); | |
231 | if (error) { | |
232 | dev_err(&pdev->dev, "Unable to register keyboard device\n"); | |
233 | goto err_free_irq; | |
234 | } | |
235 | ||
236 | device_init_wakeup(&pdev->dev, 1); | |
237 | platform_set_drvdata(pdev, kbd); | |
238 | ||
239 | return 0; | |
240 | ||
241 | err_free_irq: | |
242 | free_irq(kbd->irq, kbd); | |
243 | err_put_clk: | |
244 | clk_put(kbd->clk); | |
245 | err_iounmap: | |
246 | iounmap(kbd->io_base); | |
247 | err_release_mem_region: | |
248 | release_mem_region(res->start, resource_size(res)); | |
249 | err_free_mem: | |
250 | input_free_device(input_dev); | |
251 | kfree(kbd); | |
252 | ||
253 | return error; | |
254 | } | |
255 | ||
256 | static int __devexit spear_kbd_remove(struct platform_device *pdev) | |
257 | { | |
258 | struct spear_kbd *kbd = platform_get_drvdata(pdev); | |
259 | ||
260 | free_irq(kbd->irq, kbd); | |
261 | input_unregister_device(kbd->input); | |
262 | clk_put(kbd->clk); | |
263 | iounmap(kbd->io_base); | |
264 | release_mem_region(kbd->res->start, resource_size(kbd->res)); | |
265 | kfree(kbd); | |
266 | ||
267 | device_init_wakeup(&pdev->dev, 1); | |
268 | platform_set_drvdata(pdev, NULL); | |
269 | ||
270 | return 0; | |
271 | } | |
272 | ||
273 | #ifdef CONFIG_PM | |
274 | static int spear_kbd_suspend(struct device *dev) | |
275 | { | |
276 | struct platform_device *pdev = to_platform_device(dev); | |
277 | struct spear_kbd *kbd = platform_get_drvdata(pdev); | |
278 | struct input_dev *input_dev = kbd->input; | |
279 | ||
280 | mutex_lock(&input_dev->mutex); | |
281 | ||
282 | if (input_dev->users) | |
283 | clk_enable(kbd->clk); | |
284 | ||
285 | if (device_may_wakeup(&pdev->dev)) | |
286 | enable_irq_wake(kbd->irq); | |
287 | ||
288 | mutex_unlock(&input_dev->mutex); | |
289 | ||
290 | return 0; | |
291 | } | |
292 | ||
293 | static int spear_kbd_resume(struct device *dev) | |
294 | { | |
295 | struct platform_device *pdev = to_platform_device(dev); | |
296 | struct spear_kbd *kbd = platform_get_drvdata(pdev); | |
297 | struct input_dev *input_dev = kbd->input; | |
298 | ||
299 | mutex_lock(&input_dev->mutex); | |
300 | ||
301 | if (device_may_wakeup(&pdev->dev)) | |
302 | disable_irq_wake(kbd->irq); | |
303 | ||
304 | if (input_dev->users) | |
305 | clk_enable(kbd->clk); | |
306 | ||
307 | mutex_unlock(&input_dev->mutex); | |
308 | ||
309 | return 0; | |
310 | } | |
311 | ||
312 | static const struct dev_pm_ops spear_kbd_pm_ops = { | |
313 | .suspend = spear_kbd_suspend, | |
314 | .resume = spear_kbd_resume, | |
315 | }; | |
316 | #endif | |
317 | ||
318 | static struct platform_driver spear_kbd_driver = { | |
319 | .probe = spear_kbd_probe, | |
320 | .remove = __devexit_p(spear_kbd_remove), | |
321 | .driver = { | |
322 | .name = "keyboard", | |
323 | .owner = THIS_MODULE, | |
324 | #ifdef CONFIG_PM | |
325 | .pm = &spear_kbd_pm_ops, | |
326 | #endif | |
327 | }, | |
328 | }; | |
329 | ||
330 | static int __init spear_kbd_init(void) | |
331 | { | |
332 | return platform_driver_register(&spear_kbd_driver); | |
333 | } | |
334 | module_init(spear_kbd_init); | |
335 | ||
336 | static void __exit spear_kbd_exit(void) | |
337 | { | |
338 | platform_driver_unregister(&spear_kbd_driver); | |
339 | } | |
340 | module_exit(spear_kbd_exit); | |
341 | ||
342 | MODULE_AUTHOR("Rajeev Kumar"); | |
343 | MODULE_DESCRIPTION("SPEAr Keyboard Driver"); | |
344 | MODULE_LICENSE("GPL"); |