blob: 6069abe31e42b0b4a8f17cf0f08ac91ff4de3fe4 [file] [log] [blame]
Phil Blundell78a56aa2007-01-18 00:44:09 -05001/*
2 * Driver for keys on GPIO lines capable of generating interrupts.
3 *
4 * Copyright 2005 Phil Blundell
5 *
6 * This program is free software; you can redistribute it and/or modify
7 * it under the terms of the GNU General Public License version 2 as
8 * published by the Free Software Foundation.
9 */
10
11#include <linux/module.h>
Phil Blundell78a56aa2007-01-18 00:44:09 -050012
13#include <linux/init.h>
14#include <linux/fs.h>
15#include <linux/interrupt.h>
16#include <linux/irq.h>
17#include <linux/sched.h>
18#include <linux/pm.h>
Tejun Heo5a0e3ad2010-03-24 17:04:11 +090019#include <linux/slab.h>
Phil Blundell78a56aa2007-01-18 00:44:09 -050020#include <linux/sysctl.h>
21#include <linux/proc_fs.h>
22#include <linux/delay.h>
23#include <linux/platform_device.h>
24#include <linux/input.h>
David Brownell49015be2007-03-05 00:30:22 -080025#include <linux/gpio_keys.h>
Jani Nikulada0d03f2009-06-28 22:38:56 -070026#include <linux/workqueue.h>
Ben Dooks111bc592009-11-10 21:01:31 -080027#include <linux/gpio.h>
Phil Blundell78a56aa2007-01-18 00:44:09 -050028
Dmitry Baryshkova33466e2008-05-07 16:30:15 -040029struct gpio_button_data {
30 struct gpio_keys_button *button;
31 struct input_dev *input;
Jani Nikulaca865a72009-06-28 22:38:44 -070032 struct timer_list timer;
Jani Nikulada0d03f2009-06-28 22:38:56 -070033 struct work_struct work;
Grazvydas Ignotas28ed6842010-06-28 10:59:32 -070034 int timer_debounce; /* in msecs */
Mika Westerberg9e3af042010-02-04 00:48:00 -080035 bool disabled;
Dmitry Baryshkova33466e2008-05-07 16:30:15 -040036};
37
38struct gpio_keys_drvdata {
39 struct input_dev *input;
Mika Westerberg9e3af042010-02-04 00:48:00 -080040 struct mutex disable_lock;
41 unsigned int n_buttons;
Shubhrajyoti D173bdd72010-08-03 19:44:40 -070042 int (*enable)(struct device *dev);
43 void (*disable)(struct device *dev);
Dmitry Baryshkova33466e2008-05-07 16:30:15 -040044 struct gpio_button_data data[0];
45};
46
Mika Westerberg9e3af042010-02-04 00:48:00 -080047/*
48 * SYSFS interface for enabling/disabling keys and switches:
49 *
50 * There are 4 attributes under /sys/devices/platform/gpio-keys/
51 * keys [ro] - bitmap of keys (EV_KEY) which can be
52 * disabled
53 * switches [ro] - bitmap of switches (EV_SW) which can be
54 * disabled
55 * disabled_keys [rw] - bitmap of keys currently disabled
56 * disabled_switches [rw] - bitmap of switches currently disabled
57 *
58 * Userland can change these values and hence disable event generation
59 * for each key (or switch). Disabling a key means its interrupt line
60 * is disabled.
61 *
62 * For example, if we have following switches set up as gpio-keys:
63 * SW_DOCK = 5
64 * SW_CAMERA_LENS_COVER = 9
65 * SW_KEYPAD_SLIDE = 10
66 * SW_FRONT_PROXIMITY = 11
67 * This is read from switches:
68 * 11-9,5
69 * Next we want to disable proximity (11) and dock (5), we write:
70 * 11,5
71 * to file disabled_switches. Now proximity and dock IRQs are disabled.
72 * This can be verified by reading the file disabled_switches:
73 * 11,5
74 * If we now want to enable proximity (11) switch we write:
75 * 5
76 * to disabled_switches.
77 *
78 * We can disable only those keys which don't allow sharing the irq.
79 */
80
81/**
82 * get_n_events_by_type() - returns maximum number of events per @type
83 * @type: type of button (%EV_KEY, %EV_SW)
84 *
85 * Return value of this function can be used to allocate bitmap
86 * large enough to hold all bits for given type.
87 */
88static inline int get_n_events_by_type(int type)
89{
90 BUG_ON(type != EV_SW && type != EV_KEY);
91
92 return (type == EV_KEY) ? KEY_CNT : SW_CNT;
93}
94
95/**
96 * gpio_keys_disable_button() - disables given GPIO button
97 * @bdata: button data for button to be disabled
98 *
99 * Disables button pointed by @bdata. This is done by masking
100 * IRQ line. After this function is called, button won't generate
101 * input events anymore. Note that one can only disable buttons
102 * that don't share IRQs.
103 *
104 * Make sure that @bdata->disable_lock is locked when entering
105 * this function to avoid races when concurrent threads are
106 * disabling buttons at the same time.
107 */
108static void gpio_keys_disable_button(struct gpio_button_data *bdata)
109{
110 if (!bdata->disabled) {
111 /*
112 * Disable IRQ and possible debouncing timer.
113 */
114 disable_irq(gpio_to_irq(bdata->button->gpio));
Grazvydas Ignotas28ed6842010-06-28 10:59:32 -0700115 if (bdata->timer_debounce)
Mika Westerberg9e3af042010-02-04 00:48:00 -0800116 del_timer_sync(&bdata->timer);
117
118 bdata->disabled = true;
119 }
120}
121
122/**
123 * gpio_keys_enable_button() - enables given GPIO button
124 * @bdata: button data for button to be disabled
125 *
126 * Enables given button pointed by @bdata.
127 *
128 * Make sure that @bdata->disable_lock is locked when entering
129 * this function to avoid races with concurrent threads trying
130 * to enable the same button at the same time.
131 */
132static void gpio_keys_enable_button(struct gpio_button_data *bdata)
133{
134 if (bdata->disabled) {
135 enable_irq(gpio_to_irq(bdata->button->gpio));
136 bdata->disabled = false;
137 }
138}
139
140/**
141 * gpio_keys_attr_show_helper() - fill in stringified bitmap of buttons
142 * @ddata: pointer to drvdata
143 * @buf: buffer where stringified bitmap is written
144 * @type: button type (%EV_KEY, %EV_SW)
145 * @only_disabled: does caller want only those buttons that are
146 * currently disabled or all buttons that can be
147 * disabled
148 *
149 * This function writes buttons that can be disabled to @buf. If
150 * @only_disabled is true, then @buf contains only those buttons
151 * that are currently disabled. Returns 0 on success or negative
152 * errno on failure.
153 */
154static ssize_t gpio_keys_attr_show_helper(struct gpio_keys_drvdata *ddata,
155 char *buf, unsigned int type,
156 bool only_disabled)
157{
158 int n_events = get_n_events_by_type(type);
159 unsigned long *bits;
160 ssize_t ret;
161 int i;
162
163 bits = kcalloc(BITS_TO_LONGS(n_events), sizeof(*bits), GFP_KERNEL);
164 if (!bits)
165 return -ENOMEM;
166
167 for (i = 0; i < ddata->n_buttons; i++) {
168 struct gpio_button_data *bdata = &ddata->data[i];
169
170 if (bdata->button->type != type)
171 continue;
172
173 if (only_disabled && !bdata->disabled)
174 continue;
175
176 __set_bit(bdata->button->code, bits);
177 }
178
179 ret = bitmap_scnlistprintf(buf, PAGE_SIZE - 2, bits, n_events);
180 buf[ret++] = '\n';
181 buf[ret] = '\0';
182
183 kfree(bits);
184
185 return ret;
186}
187
188/**
189 * gpio_keys_attr_store_helper() - enable/disable buttons based on given bitmap
190 * @ddata: pointer to drvdata
191 * @buf: buffer from userspace that contains stringified bitmap
192 * @type: button type (%EV_KEY, %EV_SW)
193 *
194 * This function parses stringified bitmap from @buf and disables/enables
195 * GPIO buttons accordinly. Returns 0 on success and negative error
196 * on failure.
197 */
198static ssize_t gpio_keys_attr_store_helper(struct gpio_keys_drvdata *ddata,
199 const char *buf, unsigned int type)
200{
201 int n_events = get_n_events_by_type(type);
202 unsigned long *bits;
203 ssize_t error;
204 int i;
205
206 bits = kcalloc(BITS_TO_LONGS(n_events), sizeof(*bits), GFP_KERNEL);
207 if (!bits)
208 return -ENOMEM;
209
210 error = bitmap_parselist(buf, bits, n_events);
211 if (error)
212 goto out;
213
214 /* First validate */
215 for (i = 0; i < ddata->n_buttons; i++) {
216 struct gpio_button_data *bdata = &ddata->data[i];
217
218 if (bdata->button->type != type)
219 continue;
220
221 if (test_bit(bdata->button->code, bits) &&
222 !bdata->button->can_disable) {
223 error = -EINVAL;
224 goto out;
225 }
226 }
227
228 mutex_lock(&ddata->disable_lock);
229
230 for (i = 0; i < ddata->n_buttons; i++) {
231 struct gpio_button_data *bdata = &ddata->data[i];
232
233 if (bdata->button->type != type)
234 continue;
235
236 if (test_bit(bdata->button->code, bits))
237 gpio_keys_disable_button(bdata);
238 else
239 gpio_keys_enable_button(bdata);
240 }
241
242 mutex_unlock(&ddata->disable_lock);
243
244out:
245 kfree(bits);
246 return error;
247}
248
249#define ATTR_SHOW_FN(name, type, only_disabled) \
250static ssize_t gpio_keys_show_##name(struct device *dev, \
251 struct device_attribute *attr, \
252 char *buf) \
253{ \
254 struct platform_device *pdev = to_platform_device(dev); \
255 struct gpio_keys_drvdata *ddata = platform_get_drvdata(pdev); \
256 \
257 return gpio_keys_attr_show_helper(ddata, buf, \
258 type, only_disabled); \
259}
260
261ATTR_SHOW_FN(keys, EV_KEY, false);
262ATTR_SHOW_FN(switches, EV_SW, false);
263ATTR_SHOW_FN(disabled_keys, EV_KEY, true);
264ATTR_SHOW_FN(disabled_switches, EV_SW, true);
265
266/*
267 * ATTRIBUTES:
268 *
269 * /sys/devices/platform/gpio-keys/keys [ro]
270 * /sys/devices/platform/gpio-keys/switches [ro]
271 */
272static DEVICE_ATTR(keys, S_IRUGO, gpio_keys_show_keys, NULL);
273static DEVICE_ATTR(switches, S_IRUGO, gpio_keys_show_switches, NULL);
274
275#define ATTR_STORE_FN(name, type) \
276static ssize_t gpio_keys_store_##name(struct device *dev, \
277 struct device_attribute *attr, \
278 const char *buf, \
279 size_t count) \
280{ \
281 struct platform_device *pdev = to_platform_device(dev); \
282 struct gpio_keys_drvdata *ddata = platform_get_drvdata(pdev); \
283 ssize_t error; \
284 \
285 error = gpio_keys_attr_store_helper(ddata, buf, type); \
286 if (error) \
287 return error; \
288 \
289 return count; \
290}
291
292ATTR_STORE_FN(disabled_keys, EV_KEY);
293ATTR_STORE_FN(disabled_switches, EV_SW);
294
295/*
296 * ATTRIBUTES:
297 *
298 * /sys/devices/platform/gpio-keys/disabled_keys [rw]
299 * /sys/devices/platform/gpio-keys/disables_switches [rw]
300 */
301static DEVICE_ATTR(disabled_keys, S_IWUSR | S_IRUGO,
302 gpio_keys_show_disabled_keys,
303 gpio_keys_store_disabled_keys);
304static DEVICE_ATTR(disabled_switches, S_IWUSR | S_IRUGO,
305 gpio_keys_show_disabled_switches,
306 gpio_keys_store_disabled_switches);
307
308static struct attribute *gpio_keys_attrs[] = {
309 &dev_attr_keys.attr,
310 &dev_attr_switches.attr,
311 &dev_attr_disabled_keys.attr,
312 &dev_attr_disabled_switches.attr,
313 NULL,
314};
315
316static struct attribute_group gpio_keys_attr_group = {
317 .attrs = gpio_keys_attrs,
318};
319
Daniel Mack6ee88d72009-11-30 00:04:02 -0800320static void gpio_keys_report_event(struct gpio_button_data *bdata)
Dmitry Baryshkova33466e2008-05-07 16:30:15 -0400321{
Uwe Kleine-Königce25d7e2008-08-08 12:14:36 -0400322 struct gpio_keys_button *button = bdata->button;
323 struct input_dev *input = bdata->input;
Dmitry Baryshkova33466e2008-05-07 16:30:15 -0400324 unsigned int type = button->type ?: EV_KEY;
325 int state = (gpio_get_value(button->gpio) ? 1 : 0) ^ button->active_low;
326
327 input_event(input, type, button->code, !!state);
328 input_sync(input);
329}
330
Daniel Mack6ee88d72009-11-30 00:04:02 -0800331static void gpio_keys_work_func(struct work_struct *work)
332{
333 struct gpio_button_data *bdata =
334 container_of(work, struct gpio_button_data, work);
335
336 gpio_keys_report_event(bdata);
337}
338
Jani Nikulada0d03f2009-06-28 22:38:56 -0700339static void gpio_keys_timer(unsigned long _data)
Jani Nikulaca865a72009-06-28 22:38:44 -0700340{
341 struct gpio_button_data *data = (struct gpio_button_data *)_data;
342
Jani Nikulada0d03f2009-06-28 22:38:56 -0700343 schedule_work(&data->work);
Jani Nikulaca865a72009-06-28 22:38:44 -0700344}
345
Phil Blundell78a56aa2007-01-18 00:44:09 -0500346static irqreturn_t gpio_keys_isr(int irq, void *dev_id)
347{
Uwe Kleine-König57ffe9d2008-08-08 12:14:34 -0400348 struct gpio_button_data *bdata = dev_id;
349 struct gpio_keys_button *button = bdata->button;
Phil Blundell78a56aa2007-01-18 00:44:09 -0500350
Uwe Kleine-König57ffe9d2008-08-08 12:14:34 -0400351 BUG_ON(irq != gpio_to_irq(button->gpio));
Phil Blundell78a56aa2007-01-18 00:44:09 -0500352
Grazvydas Ignotas28ed6842010-06-28 10:59:32 -0700353 if (bdata->timer_debounce)
Jani Nikulaca865a72009-06-28 22:38:44 -0700354 mod_timer(&bdata->timer,
Grazvydas Ignotas28ed6842010-06-28 10:59:32 -0700355 jiffies + msecs_to_jiffies(bdata->timer_debounce));
Jani Nikulaca865a72009-06-28 22:38:44 -0700356 else
Jani Nikulada0d03f2009-06-28 22:38:56 -0700357 schedule_work(&bdata->work);
Roman Moravcik84767d02007-05-01 00:39:13 -0400358
Uwe Kleine-König57ffe9d2008-08-08 12:14:34 -0400359 return IRQ_HANDLED;
Phil Blundell78a56aa2007-01-18 00:44:09 -0500360}
361
Mika Westerberg9e3af042010-02-04 00:48:00 -0800362static int __devinit gpio_keys_setup_key(struct platform_device *pdev,
Ben Dooksbc8f1ea2009-11-10 21:01:31 -0800363 struct gpio_button_data *bdata,
364 struct gpio_keys_button *button)
365{
366 char *desc = button->desc ? button->desc : "gpio_keys";
Mika Westerberg9e3af042010-02-04 00:48:00 -0800367 struct device *dev = &pdev->dev;
368 unsigned long irqflags;
Ben Dooksbc8f1ea2009-11-10 21:01:31 -0800369 int irq, error;
370
371 setup_timer(&bdata->timer, gpio_keys_timer, (unsigned long)bdata);
Daniel Mack6ee88d72009-11-30 00:04:02 -0800372 INIT_WORK(&bdata->work, gpio_keys_work_func);
Ben Dooksbc8f1ea2009-11-10 21:01:31 -0800373
374 error = gpio_request(button->gpio, desc);
375 if (error < 0) {
376 dev_err(dev, "failed to request GPIO %d, error %d\n",
377 button->gpio, error);
378 goto fail2;
379 }
380
381 error = gpio_direction_input(button->gpio);
382 if (error < 0) {
383 dev_err(dev, "failed to configure"
384 " direction for GPIO %d, error %d\n",
385 button->gpio, error);
386 goto fail3;
387 }
388
Grazvydas Ignotas28ed6842010-06-28 10:59:32 -0700389 if (button->debounce_interval) {
390 error = gpio_set_debounce(button->gpio,
391 button->debounce_interval * 1000);
392 /* use timer if gpiolib doesn't provide debounce */
393 if (error < 0)
394 bdata->timer_debounce = button->debounce_interval;
395 }
396
Ben Dooksbc8f1ea2009-11-10 21:01:31 -0800397 irq = gpio_to_irq(button->gpio);
398 if (irq < 0) {
399 error = irq;
400 dev_err(dev, "Unable to get irq number for GPIO %d, error %d\n",
401 button->gpio, error);
402 goto fail3;
403 }
404
Mika Westerberg9e3af042010-02-04 00:48:00 -0800405 irqflags = IRQF_TRIGGER_RISING | IRQF_TRIGGER_FALLING;
406 /*
407 * If platform has specified that the button can be disabled,
408 * we don't want it to share the interrupt line.
409 */
410 if (!button->can_disable)
411 irqflags |= IRQF_SHARED;
412
413 error = request_irq(irq, gpio_keys_isr, irqflags, desc, bdata);
Ben Dooksbc8f1ea2009-11-10 21:01:31 -0800414 if (error) {
415 dev_err(dev, "Unable to claim irq %d; error %d\n",
416 irq, error);
417 goto fail3;
418 }
419
420 return 0;
421
422fail3:
423 gpio_free(button->gpio);
424fail2:
425 return error;
426}
427
Shubhrajyoti D173bdd72010-08-03 19:44:40 -0700428static int gpio_keys_open(struct input_dev *input)
429{
430 struct gpio_keys_drvdata *ddata = input_get_drvdata(input);
431
432 return ddata->enable ? ddata->enable(input->dev.parent) : 0;
433}
434
435static void gpio_keys_close(struct input_dev *input)
436{
437 struct gpio_keys_drvdata *ddata = input_get_drvdata(input);
438
439 if (ddata->disable)
440 ddata->disable(input->dev.parent);
441}
442
Phil Blundell78a56aa2007-01-18 00:44:09 -0500443static int __devinit gpio_keys_probe(struct platform_device *pdev)
444{
445 struct gpio_keys_platform_data *pdata = pdev->dev.platform_data;
Dmitry Baryshkova33466e2008-05-07 16:30:15 -0400446 struct gpio_keys_drvdata *ddata;
Ben Dooksdb19fd82009-11-10 21:00:35 -0800447 struct device *dev = &pdev->dev;
Phil Blundell78a56aa2007-01-18 00:44:09 -0500448 struct input_dev *input;
449 int i, error;
Anti Sulline15b0212007-09-26 00:01:17 -0400450 int wakeup = 0;
Phil Blundell78a56aa2007-01-18 00:44:09 -0500451
Dmitry Baryshkova33466e2008-05-07 16:30:15 -0400452 ddata = kzalloc(sizeof(struct gpio_keys_drvdata) +
453 pdata->nbuttons * sizeof(struct gpio_button_data),
454 GFP_KERNEL);
Phil Blundell78a56aa2007-01-18 00:44:09 -0500455 input = input_allocate_device();
Dmitry Baryshkova33466e2008-05-07 16:30:15 -0400456 if (!ddata || !input) {
Ben Dooksdb19fd82009-11-10 21:00:35 -0800457 dev_err(dev, "failed to allocate state\n");
Dmitry Baryshkova33466e2008-05-07 16:30:15 -0400458 error = -ENOMEM;
459 goto fail1;
460 }
Phil Blundell78a56aa2007-01-18 00:44:09 -0500461
Mika Westerberg9e3af042010-02-04 00:48:00 -0800462 ddata->input = input;
463 ddata->n_buttons = pdata->nbuttons;
Shubhrajyoti D173bdd72010-08-03 19:44:40 -0700464 ddata->enable = pdata->enable;
465 ddata->disable = pdata->disable;
Mika Westerberg9e3af042010-02-04 00:48:00 -0800466 mutex_init(&ddata->disable_lock);
467
Dmitry Baryshkova33466e2008-05-07 16:30:15 -0400468 platform_set_drvdata(pdev, ddata);
Shubhrajyoti D173bdd72010-08-03 19:44:40 -0700469 input_set_drvdata(input, ddata);
Phil Blundell78a56aa2007-01-18 00:44:09 -0500470
471 input->name = pdev->name;
472 input->phys = "gpio-keys/input0";
Dmitry Torokhov469ba4d2007-04-12 01:34:58 -0400473 input->dev.parent = &pdev->dev;
Shubhrajyoti D173bdd72010-08-03 19:44:40 -0700474 input->open = gpio_keys_open;
475 input->close = gpio_keys_close;
Phil Blundell78a56aa2007-01-18 00:44:09 -0500476
477 input->id.bustype = BUS_HOST;
478 input->id.vendor = 0x0001;
479 input->id.product = 0x0001;
480 input->id.version = 0x0100;
481
Dominic Curranb67b4b12008-10-27 22:30:53 -0400482 /* Enable auto repeat feature of Linux input subsystem */
483 if (pdata->rep)
484 __set_bit(EV_REP, input->evbit);
485
Phil Blundell78a56aa2007-01-18 00:44:09 -0500486 for (i = 0; i < pdata->nbuttons; i++) {
Roman Moravcik84767d02007-05-01 00:39:13 -0400487 struct gpio_keys_button *button = &pdata->buttons[i];
Dmitry Baryshkova33466e2008-05-07 16:30:15 -0400488 struct gpio_button_data *bdata = &ddata->data[i];
Roman Moravcik84767d02007-05-01 00:39:13 -0400489 unsigned int type = button->type ?: EV_KEY;
Phil Blundell78a56aa2007-01-18 00:44:09 -0500490
Dmitry Baryshkova33466e2008-05-07 16:30:15 -0400491 bdata->input = input;
Uwe Kleine-König74dd4392008-07-30 10:33:43 -0400492 bdata->button = button;
Dmitry Baryshkova33466e2008-05-07 16:30:15 -0400493
Mika Westerberg9e3af042010-02-04 00:48:00 -0800494 error = gpio_keys_setup_key(pdev, bdata, button);
Ben Dooksbc8f1ea2009-11-10 21:01:31 -0800495 if (error)
Dmitry Baryshkova33466e2008-05-07 16:30:15 -0400496 goto fail2;
Roman Moravcik84767d02007-05-01 00:39:13 -0400497
Anti Sulline15b0212007-09-26 00:01:17 -0400498 if (button->wakeup)
499 wakeup = 1;
500
Roman Moravcik84767d02007-05-01 00:39:13 -0400501 input_set_capability(input, type, button->code);
Phil Blundell78a56aa2007-01-18 00:44:09 -0500502 }
503
Mika Westerberg9e3af042010-02-04 00:48:00 -0800504 error = sysfs_create_group(&pdev->dev.kobj, &gpio_keys_attr_group);
505 if (error) {
506 dev_err(dev, "Unable to export keys/switches, error: %d\n",
507 error);
508 goto fail2;
509 }
510
Phil Blundell78a56aa2007-01-18 00:44:09 -0500511 error = input_register_device(input);
512 if (error) {
Mika Westerberg9e3af042010-02-04 00:48:00 -0800513 dev_err(dev, "Unable to register input device, error: %d\n",
514 error);
515 goto fail3;
Phil Blundell78a56aa2007-01-18 00:44:09 -0500516 }
517
Daniel Mack6ee88d72009-11-30 00:04:02 -0800518 /* get current state of buttons */
519 for (i = 0; i < pdata->nbuttons; i++)
520 gpio_keys_report_event(&ddata->data[i]);
521 input_sync(input);
522
Anti Sulline15b0212007-09-26 00:01:17 -0400523 device_init_wakeup(&pdev->dev, wakeup);
524
Phil Blundell78a56aa2007-01-18 00:44:09 -0500525 return 0;
526
Mika Westerberg9e3af042010-02-04 00:48:00 -0800527 fail3:
528 sysfs_remove_group(&pdev->dev.kobj, &gpio_keys_attr_group);
Dmitry Baryshkova33466e2008-05-07 16:30:15 -0400529 fail2:
Herbert Valerio Riedel6a2e3912007-11-21 14:42:33 -0500530 while (--i >= 0) {
Uwe Kleine-König57ffe9d2008-08-08 12:14:34 -0400531 free_irq(gpio_to_irq(pdata->buttons[i].gpio), &ddata->data[i]);
Grazvydas Ignotas28ed6842010-06-28 10:59:32 -0700532 if (ddata->data[i].timer_debounce)
Jani Nikulaca865a72009-06-28 22:38:44 -0700533 del_timer_sync(&ddata->data[i].timer);
Jani Nikulada0d03f2009-06-28 22:38:56 -0700534 cancel_work_sync(&ddata->data[i].work);
Herbert Valerio Riedel6a2e3912007-11-21 14:42:33 -0500535 gpio_free(pdata->buttons[i].gpio);
536 }
Phil Blundell78a56aa2007-01-18 00:44:09 -0500537
Anti Sullin006df302007-09-26 00:01:03 -0400538 platform_set_drvdata(pdev, NULL);
Dmitry Baryshkova33466e2008-05-07 16:30:15 -0400539 fail1:
Phil Blundell78a56aa2007-01-18 00:44:09 -0500540 input_free_device(input);
Dmitry Baryshkova33466e2008-05-07 16:30:15 -0400541 kfree(ddata);
Phil Blundell78a56aa2007-01-18 00:44:09 -0500542
543 return error;
544}
545
546static int __devexit gpio_keys_remove(struct platform_device *pdev)
547{
548 struct gpio_keys_platform_data *pdata = pdev->dev.platform_data;
Dmitry Baryshkova33466e2008-05-07 16:30:15 -0400549 struct gpio_keys_drvdata *ddata = platform_get_drvdata(pdev);
550 struct input_dev *input = ddata->input;
Phil Blundell78a56aa2007-01-18 00:44:09 -0500551 int i;
552
Mika Westerberg9e3af042010-02-04 00:48:00 -0800553 sysfs_remove_group(&pdev->dev.kobj, &gpio_keys_attr_group);
554
Anti Sulline15b0212007-09-26 00:01:17 -0400555 device_init_wakeup(&pdev->dev, 0);
556
Phil Blundell78a56aa2007-01-18 00:44:09 -0500557 for (i = 0; i < pdata->nbuttons; i++) {
Philipp Zabel0d98f6b2007-02-18 01:40:46 -0500558 int irq = gpio_to_irq(pdata->buttons[i].gpio);
Uwe Kleine-König57ffe9d2008-08-08 12:14:34 -0400559 free_irq(irq, &ddata->data[i]);
Grazvydas Ignotas28ed6842010-06-28 10:59:32 -0700560 if (ddata->data[i].timer_debounce)
Jani Nikulaca865a72009-06-28 22:38:44 -0700561 del_timer_sync(&ddata->data[i].timer);
Jani Nikulada0d03f2009-06-28 22:38:56 -0700562 cancel_work_sync(&ddata->data[i].work);
Herbert Valerio Riedel6a2e3912007-11-21 14:42:33 -0500563 gpio_free(pdata->buttons[i].gpio);
Phil Blundell78a56aa2007-01-18 00:44:09 -0500564 }
565
566 input_unregister_device(input);
567
568 return 0;
569}
570
Anti Sulline15b0212007-09-26 00:01:17 -0400571
572#ifdef CONFIG_PM
Mike Rapoportae78e0e2009-07-22 23:02:54 -0700573static int gpio_keys_suspend(struct device *dev)
Anti Sulline15b0212007-09-26 00:01:17 -0400574{
Mike Rapoportae78e0e2009-07-22 23:02:54 -0700575 struct platform_device *pdev = to_platform_device(dev);
Anti Sulline15b0212007-09-26 00:01:17 -0400576 struct gpio_keys_platform_data *pdata = pdev->dev.platform_data;
577 int i;
578
579 if (device_may_wakeup(&pdev->dev)) {
580 for (i = 0; i < pdata->nbuttons; i++) {
581 struct gpio_keys_button *button = &pdata->buttons[i];
582 if (button->wakeup) {
583 int irq = gpio_to_irq(button->gpio);
584 enable_irq_wake(irq);
585 }
586 }
587 }
588
589 return 0;
590}
591
Mike Rapoportae78e0e2009-07-22 23:02:54 -0700592static int gpio_keys_resume(struct device *dev)
Anti Sulline15b0212007-09-26 00:01:17 -0400593{
Mike Rapoportae78e0e2009-07-22 23:02:54 -0700594 struct platform_device *pdev = to_platform_device(dev);
Daniel Mack6ee88d72009-11-30 00:04:02 -0800595 struct gpio_keys_drvdata *ddata = platform_get_drvdata(pdev);
Anti Sulline15b0212007-09-26 00:01:17 -0400596 struct gpio_keys_platform_data *pdata = pdev->dev.platform_data;
597 int i;
598
Daniel Mack6ee88d72009-11-30 00:04:02 -0800599 for (i = 0; i < pdata->nbuttons; i++) {
600
601 struct gpio_keys_button *button = &pdata->buttons[i];
602 if (button->wakeup && device_may_wakeup(&pdev->dev)) {
603 int irq = gpio_to_irq(button->gpio);
604 disable_irq_wake(irq);
Anti Sulline15b0212007-09-26 00:01:17 -0400605 }
Daniel Mack6ee88d72009-11-30 00:04:02 -0800606
607 gpio_keys_report_event(&ddata->data[i]);
Anti Sulline15b0212007-09-26 00:01:17 -0400608 }
Daniel Mack6ee88d72009-11-30 00:04:02 -0800609 input_sync(ddata->input);
Anti Sulline15b0212007-09-26 00:01:17 -0400610
611 return 0;
612}
Mike Rapoportae78e0e2009-07-22 23:02:54 -0700613
614static const struct dev_pm_ops gpio_keys_pm_ops = {
615 .suspend = gpio_keys_suspend,
616 .resume = gpio_keys_resume,
617};
Anti Sulline15b0212007-09-26 00:01:17 -0400618#endif
619
Uwe Kleine-König9b070442008-07-30 10:34:02 -0400620static struct platform_driver gpio_keys_device_driver = {
Phil Blundell78a56aa2007-01-18 00:44:09 -0500621 .probe = gpio_keys_probe,
622 .remove = __devexit_p(gpio_keys_remove),
Phil Blundell78a56aa2007-01-18 00:44:09 -0500623 .driver = {
624 .name = "gpio-keys",
Kay Sieversd7b52472008-04-18 00:24:42 -0400625 .owner = THIS_MODULE,
Mike Rapoportae78e0e2009-07-22 23:02:54 -0700626#ifdef CONFIG_PM
627 .pm = &gpio_keys_pm_ops,
628#endif
Phil Blundell78a56aa2007-01-18 00:44:09 -0500629 }
630};
631
632static int __init gpio_keys_init(void)
633{
634 return platform_driver_register(&gpio_keys_device_driver);
635}
636
637static void __exit gpio_keys_exit(void)
638{
639 platform_driver_unregister(&gpio_keys_device_driver);
640}
641
642module_init(gpio_keys_init);
643module_exit(gpio_keys_exit);
644
645MODULE_LICENSE("GPL");
646MODULE_AUTHOR("Phil Blundell <pb@handhelds.org>");
647MODULE_DESCRIPTION("Keyboard driver for CPU GPIOs");
Kay Sieversd7b52472008-04-18 00:24:42 -0400648MODULE_ALIAS("platform:gpio-keys");