Commit | Line | Data |
---|---|---|
8f740ef3 MH |
1 | /* |
2 | * File: drivers/input/keyboard/bf54x-keys.c | |
3 | * Based on: | |
4 | * Author: Michael Hennerich <hennerich@blackfin.uclinux.org> | |
5 | * | |
6 | * Created: | |
7 | * Description: keypad driver for Analog Devices Blackfin BF54x Processors | |
8 | * | |
9 | * | |
10 | * Modified: | |
108fcb42 | 11 | * Copyright 2007-2008 Analog Devices Inc. |
8f740ef3 MH |
12 | * |
13 | * Bugs: Enter bugs at http://blackfin.uclinux.org/ | |
14 | * | |
15 | * This program is free software; you can redistribute it and/or modify | |
16 | * it under the terms of the GNU General Public License as published by | |
17 | * the Free Software Foundation; either version 2 of the License, or | |
18 | * (at your option) any later version. | |
19 | * | |
20 | * This program is distributed in the hope that it will be useful, | |
21 | * but WITHOUT ANY WARRANTY; without even the implied warranty of | |
22 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the | |
23 | * GNU General Public License for more details. | |
24 | * | |
25 | * You should have received a copy of the GNU General Public License | |
26 | * along with this program; if not, see the file COPYING, or write | |
27 | * to the Free Software Foundation, Inc., | |
28 | * 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA | |
29 | */ | |
30 | ||
31 | #include <linux/module.h> | |
8f740ef3 MH |
32 | |
33 | #include <linux/init.h> | |
34 | #include <linux/fs.h> | |
35 | #include <linux/interrupt.h> | |
36 | #include <linux/irq.h> | |
5a0e3ad6 | 37 | #include <linux/slab.h> |
8f740ef3 MH |
38 | #include <linux/sched.h> |
39 | #include <linux/pm.h> | |
40 | #include <linux/sysctl.h> | |
41 | #include <linux/proc_fs.h> | |
42 | #include <linux/delay.h> | |
43 | #include <linux/platform_device.h> | |
44 | #include <linux/input.h> | |
8f740ef3 MH |
45 | |
46 | #include <asm/portmux.h> | |
639f6571 | 47 | #include <mach/bf54x_keys.h> |
8f740ef3 MH |
48 | |
49 | #define DRV_NAME "bf54x-keys" | |
50 | #define TIME_SCALE 100 /* 100 ns */ | |
51 | #define MAX_MULT (0xFF * TIME_SCALE) | |
52 | #define MAX_RC 8 /* Max Row/Col */ | |
53 | ||
54 | static const u16 per_rows[] = { | |
55 | P_KEY_ROW7, | |
56 | P_KEY_ROW6, | |
57 | P_KEY_ROW5, | |
58 | P_KEY_ROW4, | |
59 | P_KEY_ROW3, | |
60 | P_KEY_ROW2, | |
61 | P_KEY_ROW1, | |
62 | P_KEY_ROW0, | |
63 | 0 | |
64 | }; | |
65 | ||
66 | static const u16 per_cols[] = { | |
67 | P_KEY_COL7, | |
68 | P_KEY_COL6, | |
69 | P_KEY_COL5, | |
70 | P_KEY_COL4, | |
71 | P_KEY_COL3, | |
72 | P_KEY_COL2, | |
73 | P_KEY_COL1, | |
74 | P_KEY_COL0, | |
75 | 0 | |
76 | }; | |
77 | ||
78 | struct bf54x_kpad { | |
79 | struct input_dev *input; | |
80 | int irq; | |
81 | unsigned short lastkey; | |
82 | unsigned short *keycode; | |
83 | struct timer_list timer; | |
84 | unsigned int keyup_test_jiffies; | |
108fcb42 MH |
85 | unsigned short kpad_msel; |
86 | unsigned short kpad_prescale; | |
87 | unsigned short kpad_ctl; | |
8f740ef3 MH |
88 | }; |
89 | ||
90 | static inline int bfin_kpad_find_key(struct bf54x_kpad *bf54x_kpad, | |
91 | struct input_dev *input, u16 keyident) | |
92 | { | |
93 | u16 i; | |
94 | ||
95 | for (i = 0; i < input->keycodemax; i++) | |
96 | if (bf54x_kpad->keycode[i + input->keycodemax] == keyident) | |
97 | return bf54x_kpad->keycode[i]; | |
98 | return -1; | |
99 | } | |
100 | ||
101 | static inline void bfin_keycodecpy(unsigned short *keycode, | |
102 | const unsigned int *pdata_kc, | |
103 | unsigned short keymapsize) | |
104 | { | |
105 | unsigned int i; | |
106 | ||
107 | for (i = 0; i < keymapsize; i++) { | |
108 | keycode[i] = pdata_kc[i] & 0xffff; | |
109 | keycode[i + keymapsize] = pdata_kc[i] >> 16; | |
110 | } | |
111 | } | |
112 | ||
113 | static inline u16 bfin_kpad_get_prescale(u32 timescale) | |
114 | { | |
115 | u32 sclk = get_sclk(); | |
116 | ||
117 | return ((((sclk / 1000) * timescale) / 1024) - 1); | |
118 | } | |
119 | ||
120 | static inline u16 bfin_kpad_get_keypressed(struct bf54x_kpad *bf54x_kpad) | |
121 | { | |
122 | return (bfin_read_KPAD_STAT() & KPAD_PRESSED); | |
123 | } | |
124 | ||
125 | static inline void bfin_kpad_clear_irq(void) | |
126 | { | |
127 | bfin_write_KPAD_STAT(0xFFFF); | |
128 | bfin_write_KPAD_ROWCOL(0xFFFF); | |
129 | } | |
130 | ||
131 | static void bfin_kpad_timer(unsigned long data) | |
132 | { | |
133 | struct platform_device *pdev = (struct platform_device *) data; | |
134 | struct bf54x_kpad *bf54x_kpad = platform_get_drvdata(pdev); | |
135 | ||
136 | if (bfin_kpad_get_keypressed(bf54x_kpad)) { | |
137 | /* Try again later */ | |
138 | mod_timer(&bf54x_kpad->timer, | |
139 | jiffies + bf54x_kpad->keyup_test_jiffies); | |
140 | return; | |
141 | } | |
142 | ||
143 | input_report_key(bf54x_kpad->input, bf54x_kpad->lastkey, 0); | |
144 | input_sync(bf54x_kpad->input); | |
145 | ||
146 | /* Clear IRQ Status */ | |
147 | ||
148 | bfin_kpad_clear_irq(); | |
149 | enable_irq(bf54x_kpad->irq); | |
150 | } | |
151 | ||
152 | static irqreturn_t bfin_kpad_isr(int irq, void *dev_id) | |
153 | { | |
154 | struct platform_device *pdev = dev_id; | |
155 | struct bf54x_kpad *bf54x_kpad = platform_get_drvdata(pdev); | |
156 | struct input_dev *input = bf54x_kpad->input; | |
157 | int key; | |
158 | u16 rowcol = bfin_read_KPAD_ROWCOL(); | |
159 | ||
160 | key = bfin_kpad_find_key(bf54x_kpad, input, rowcol); | |
161 | ||
162 | input_report_key(input, key, 1); | |
163 | input_sync(input); | |
164 | ||
165 | if (bfin_kpad_get_keypressed(bf54x_kpad)) { | |
9e49f6c1 | 166 | disable_irq_nosync(bf54x_kpad->irq); |
8f740ef3 MH |
167 | bf54x_kpad->lastkey = key; |
168 | mod_timer(&bf54x_kpad->timer, | |
169 | jiffies + bf54x_kpad->keyup_test_jiffies); | |
170 | } else { | |
171 | input_report_key(input, key, 0); | |
172 | input_sync(input); | |
173 | ||
174 | bfin_kpad_clear_irq(); | |
175 | } | |
176 | ||
177 | return IRQ_HANDLED; | |
178 | } | |
179 | ||
180 | static int __devinit bfin_kpad_probe(struct platform_device *pdev) | |
181 | { | |
182 | struct bf54x_kpad *bf54x_kpad; | |
183 | struct bfin_kpad_platform_data *pdata = pdev->dev.platform_data; | |
184 | struct input_dev *input; | |
185 | int i, error; | |
186 | ||
187 | if (!pdata->rows || !pdata->cols || !pdata->keymap) { | |
11a79260 | 188 | dev_err(&pdev->dev, "no rows, cols or keymap from pdata\n"); |
8f740ef3 MH |
189 | return -EINVAL; |
190 | } | |
191 | ||
192 | if (!pdata->keymapsize || | |
193 | pdata->keymapsize > (pdata->rows * pdata->cols)) { | |
11a79260 | 194 | dev_err(&pdev->dev, "invalid keymapsize\n"); |
8f740ef3 MH |
195 | return -EINVAL; |
196 | } | |
197 | ||
198 | bf54x_kpad = kzalloc(sizeof(struct bf54x_kpad), GFP_KERNEL); | |
199 | if (!bf54x_kpad) | |
200 | return -ENOMEM; | |
201 | ||
202 | platform_set_drvdata(pdev, bf54x_kpad); | |
203 | ||
204 | /* Allocate memory for keymap followed by private LUT */ | |
205 | bf54x_kpad->keycode = kmalloc(pdata->keymapsize * | |
206 | sizeof(unsigned short) * 2, GFP_KERNEL); | |
207 | if (!bf54x_kpad->keycode) { | |
208 | error = -ENOMEM; | |
209 | goto out; | |
210 | } | |
211 | ||
e8e0c023 RK |
212 | if (!pdata->debounce_time || pdata->debounce_time > MAX_MULT || |
213 | !pdata->coldrive_time || pdata->coldrive_time > MAX_MULT) { | |
11a79260 MF |
214 | dev_warn(&pdev->dev, |
215 | "invalid platform debounce/columndrive time\n"); | |
8f740ef3 MH |
216 | bfin_write_KPAD_MSEL(0xFF0); /* Default MSEL */ |
217 | } else { | |
218 | bfin_write_KPAD_MSEL( | |
219 | ((pdata->debounce_time / TIME_SCALE) | |
220 | & DBON_SCALE) | | |
221 | (((pdata->coldrive_time / TIME_SCALE) << 8) | |
222 | & COLDRV_SCALE)); | |
223 | ||
224 | } | |
225 | ||
226 | if (!pdata->keyup_test_interval) | |
227 | bf54x_kpad->keyup_test_jiffies = msecs_to_jiffies(50); | |
228 | else | |
229 | bf54x_kpad->keyup_test_jiffies = | |
230 | msecs_to_jiffies(pdata->keyup_test_interval); | |
231 | ||
232 | if (peripheral_request_list((u16 *)&per_rows[MAX_RC - pdata->rows], | |
233 | DRV_NAME)) { | |
11a79260 | 234 | dev_err(&pdev->dev, "requesting peripherals failed\n"); |
8f740ef3 MH |
235 | error = -EFAULT; |
236 | goto out0; | |
237 | } | |
238 | ||
239 | if (peripheral_request_list((u16 *)&per_cols[MAX_RC - pdata->cols], | |
240 | DRV_NAME)) { | |
11a79260 | 241 | dev_err(&pdev->dev, "requesting peripherals failed\n"); |
8f740ef3 MH |
242 | error = -EFAULT; |
243 | goto out1; | |
244 | } | |
245 | ||
246 | bf54x_kpad->irq = platform_get_irq(pdev, 0); | |
247 | if (bf54x_kpad->irq < 0) { | |
248 | error = -ENODEV; | |
249 | goto out2; | |
250 | } | |
251 | ||
252 | error = request_irq(bf54x_kpad->irq, bfin_kpad_isr, | |
3eaa750d | 253 | 0, DRV_NAME, pdev); |
8f740ef3 | 254 | if (error) { |
11a79260 MF |
255 | dev_err(&pdev->dev, "unable to claim irq %d\n", |
256 | bf54x_kpad->irq); | |
8f740ef3 MH |
257 | goto out2; |
258 | } | |
259 | ||
260 | input = input_allocate_device(); | |
261 | if (!input) { | |
262 | error = -ENOMEM; | |
263 | goto out3; | |
264 | } | |
265 | ||
266 | bf54x_kpad->input = input; | |
267 | ||
268 | input->name = pdev->name; | |
269 | input->phys = "bf54x-keys/input0"; | |
270 | input->dev.parent = &pdev->dev; | |
271 | ||
272 | input_set_drvdata(input, bf54x_kpad); | |
273 | ||
274 | input->id.bustype = BUS_HOST; | |
275 | input->id.vendor = 0x0001; | |
276 | input->id.product = 0x0001; | |
277 | input->id.version = 0x0100; | |
278 | ||
279 | input->keycodesize = sizeof(unsigned short); | |
280 | input->keycodemax = pdata->keymapsize; | |
281 | input->keycode = bf54x_kpad->keycode; | |
282 | ||
283 | bfin_keycodecpy(bf54x_kpad->keycode, pdata->keymap, pdata->keymapsize); | |
284 | ||
285 | /* setup input device */ | |
286 | __set_bit(EV_KEY, input->evbit); | |
287 | ||
288 | if (pdata->repeat) | |
289 | __set_bit(EV_REP, input->evbit); | |
290 | ||
291 | for (i = 0; i < input->keycodemax; i++) | |
292 | __set_bit(bf54x_kpad->keycode[i] & KEY_MAX, input->keybit); | |
293 | __clear_bit(KEY_RESERVED, input->keybit); | |
294 | ||
295 | error = input_register_device(input); | |
296 | if (error) { | |
11a79260 | 297 | dev_err(&pdev->dev, "unable to register input device\n"); |
8f740ef3 MH |
298 | goto out4; |
299 | } | |
300 | ||
301 | /* Init Keypad Key Up/Release test timer */ | |
302 | ||
303 | setup_timer(&bf54x_kpad->timer, bfin_kpad_timer, (unsigned long) pdev); | |
304 | ||
305 | bfin_write_KPAD_PRESCALE(bfin_kpad_get_prescale(TIME_SCALE)); | |
306 | ||
307 | bfin_write_KPAD_CTL((((pdata->cols - 1) << 13) & KPAD_COLEN) | | |
308 | (((pdata->rows - 1) << 10) & KPAD_ROWEN) | | |
309 | (2 & KPAD_IRQMODE)); | |
310 | ||
311 | bfin_write_KPAD_CTL(bfin_read_KPAD_CTL() | KPAD_EN); | |
312 | ||
d0478d0a MH |
313 | device_init_wakeup(&pdev->dev, 1); |
314 | ||
8f740ef3 MH |
315 | return 0; |
316 | ||
317 | out4: | |
318 | input_free_device(input); | |
319 | out3: | |
320 | free_irq(bf54x_kpad->irq, pdev); | |
321 | out2: | |
322 | peripheral_free_list((u16 *)&per_cols[MAX_RC - pdata->cols]); | |
323 | out1: | |
324 | peripheral_free_list((u16 *)&per_rows[MAX_RC - pdata->rows]); | |
325 | out0: | |
326 | kfree(bf54x_kpad->keycode); | |
327 | out: | |
328 | kfree(bf54x_kpad); | |
329 | platform_set_drvdata(pdev, NULL); | |
330 | ||
331 | return error; | |
332 | } | |
333 | ||
334 | static int __devexit bfin_kpad_remove(struct platform_device *pdev) | |
335 | { | |
336 | struct bfin_kpad_platform_data *pdata = pdev->dev.platform_data; | |
337 | struct bf54x_kpad *bf54x_kpad = platform_get_drvdata(pdev); | |
338 | ||
339 | del_timer_sync(&bf54x_kpad->timer); | |
340 | free_irq(bf54x_kpad->irq, pdev); | |
341 | ||
342 | input_unregister_device(bf54x_kpad->input); | |
343 | ||
344 | peripheral_free_list((u16 *)&per_rows[MAX_RC - pdata->rows]); | |
345 | peripheral_free_list((u16 *)&per_cols[MAX_RC - pdata->cols]); | |
346 | ||
347 | kfree(bf54x_kpad->keycode); | |
348 | kfree(bf54x_kpad); | |
349 | platform_set_drvdata(pdev, NULL); | |
350 | ||
351 | return 0; | |
352 | } | |
353 | ||
d0478d0a MH |
354 | #ifdef CONFIG_PM |
355 | static int bfin_kpad_suspend(struct platform_device *pdev, pm_message_t state) | |
356 | { | |
357 | struct bf54x_kpad *bf54x_kpad = platform_get_drvdata(pdev); | |
358 | ||
108fcb42 MH |
359 | bf54x_kpad->kpad_msel = bfin_read_KPAD_MSEL(); |
360 | bf54x_kpad->kpad_prescale = bfin_read_KPAD_PRESCALE(); | |
361 | bf54x_kpad->kpad_ctl = bfin_read_KPAD_CTL(); | |
362 | ||
d0478d0a MH |
363 | if (device_may_wakeup(&pdev->dev)) |
364 | enable_irq_wake(bf54x_kpad->irq); | |
365 | ||
366 | return 0; | |
367 | } | |
368 | ||
369 | static int bfin_kpad_resume(struct platform_device *pdev) | |
370 | { | |
371 | struct bf54x_kpad *bf54x_kpad = platform_get_drvdata(pdev); | |
372 | ||
108fcb42 MH |
373 | bfin_write_KPAD_MSEL(bf54x_kpad->kpad_msel); |
374 | bfin_write_KPAD_PRESCALE(bf54x_kpad->kpad_prescale); | |
375 | bfin_write_KPAD_CTL(bf54x_kpad->kpad_ctl); | |
376 | ||
d0478d0a MH |
377 | if (device_may_wakeup(&pdev->dev)) |
378 | disable_irq_wake(bf54x_kpad->irq); | |
379 | ||
380 | return 0; | |
381 | } | |
382 | #else | |
383 | # define bfin_kpad_suspend NULL | |
384 | # define bfin_kpad_resume NULL | |
385 | #endif | |
386 | ||
aeec0517 | 387 | static struct platform_driver bfin_kpad_device_driver = { |
8f740ef3 MH |
388 | .driver = { |
389 | .name = DRV_NAME, | |
d7b5247b | 390 | .owner = THIS_MODULE, |
d0478d0a MH |
391 | }, |
392 | .probe = bfin_kpad_probe, | |
393 | .remove = __devexit_p(bfin_kpad_remove), | |
394 | .suspend = bfin_kpad_suspend, | |
395 | .resume = bfin_kpad_resume, | |
8f740ef3 | 396 | }; |
5146c84f | 397 | module_platform_driver(bfin_kpad_device_driver); |
8f740ef3 MH |
398 | |
399 | MODULE_LICENSE("GPL"); | |
400 | MODULE_AUTHOR("Michael Hennerich <hennerich@blackfin.uclinux.org>"); | |
401 | MODULE_DESCRIPTION("Keypad driver for BF54x Processors"); | |
d7b5247b | 402 | MODULE_ALIAS("platform:bf54x-keys"); |