Input: Generic GPIO Input device.
[linux-2.6.git] / drivers / input / misc / gpio_output.c
1 /* drivers/input/misc/gpio_output.c
2  *
3  * Copyright (C) 2007 Google, Inc.
4  *
5  * This software is licensed under the terms of the GNU General Public
6  * License version 2, as published by the Free Software Foundation, and
7  * may be copied, distributed, and modified under those terms.
8  *
9  * This program is distributed in the hope that it will be useful,
10  * but WITHOUT ANY WARRANTY; without even the implied warranty of
11  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
12  * GNU General Public License for more details.
13  *
14  */
15
16 #include <linux/kernel.h>
17 #include <linux/gpio.h>
18 #include <linux/gpio_event.h>
19
20 int gpio_event_output_event(
21         struct gpio_event_input_devs *input_devs, struct gpio_event_info *info,
22         void **data, unsigned int dev, unsigned int type,
23         unsigned int code, int value)
24 {
25         int i;
26         struct gpio_event_output_info *oi;
27         oi = container_of(info, struct gpio_event_output_info, info);
28         if (type != oi->type)
29                 return 0;
30         if (!(oi->flags & GPIOEDF_ACTIVE_HIGH))
31                 value = !value;
32         for (i = 0; i < oi->keymap_size; i++)
33                 if (dev == oi->keymap[i].dev && code == oi->keymap[i].code)
34                         gpio_set_value(oi->keymap[i].gpio, value);
35         return 0;
36 }
37
38 int gpio_event_output_func(
39         struct gpio_event_input_devs *input_devs, struct gpio_event_info *info,
40         void **data, int func)
41 {
42         int ret;
43         int i;
44         struct gpio_event_output_info *oi;
45         oi = container_of(info, struct gpio_event_output_info, info);
46
47         if (func == GPIO_EVENT_FUNC_SUSPEND || func == GPIO_EVENT_FUNC_RESUME)
48                 return 0;
49
50         if (func == GPIO_EVENT_FUNC_INIT) {
51                 int output_level = !(oi->flags & GPIOEDF_ACTIVE_HIGH);
52
53                 for (i = 0; i < oi->keymap_size; i++) {
54                         int dev = oi->keymap[i].dev;
55                         if (dev >= input_devs->count) {
56                                 pr_err("gpio_event_output_func: bad device "
57                                         "index %d >= %d for key code %d\n",
58                                         dev, input_devs->count,
59                                         oi->keymap[i].code);
60                                 ret = -EINVAL;
61                                 goto err_bad_keymap;
62                         }
63                         input_set_capability(input_devs->dev[dev], oi->type,
64                                              oi->keymap[i].code);
65                 }
66
67                 for (i = 0; i < oi->keymap_size; i++) {
68                         ret = gpio_request(oi->keymap[i].gpio,
69                                            "gpio_event_output");
70                         if (ret) {
71                                 pr_err("gpio_event_output_func: gpio_request "
72                                         "failed for %d\n", oi->keymap[i].gpio);
73                                 goto err_gpio_request_failed;
74                         }
75                         ret = gpio_direction_output(oi->keymap[i].gpio,
76                                                     output_level);
77                         if (ret) {
78                                 pr_err("gpio_event_output_func: "
79                                         "gpio_direction_output failed for %d\n",
80                                         oi->keymap[i].gpio);
81                                 goto err_gpio_direction_output_failed;
82                         }
83                 }
84                 return 0;
85         }
86
87         ret = 0;
88         for (i = oi->keymap_size - 1; i >= 0; i--) {
89 err_gpio_direction_output_failed:
90                 gpio_free(oi->keymap[i].gpio);
91 err_gpio_request_failed:
92                 ;
93         }
94 err_bad_keymap:
95         return ret;
96 }
97