[media] gpio-ir-recv: a couple signedness bugs
[linux-2.6.git] / drivers / media / rc / gpio-ir-recv.c
blob0d875450c5ce3d92f1295445b852f77617ed5364
1 /* Copyright (c) 2012, Code Aurora Forum. All rights reserved.
3 * This program is free software; you can redistribute it and/or modify
4 * it under the terms of the GNU General Public License version 2 and
5 * only version 2 as published by the Free Software Foundation.
7 * This program is distributed in the hope that it will be useful,
8 * but WITHOUT ANY WARRANTY; without even the implied warranty of
9 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
10 * GNU General Public License for more details.
13 #include <linux/kernel.h>
14 #include <linux/init.h>
15 #include <linux/module.h>
16 #include <linux/interrupt.h>
17 #include <linux/gpio.h>
18 #include <linux/slab.h>
19 #include <linux/platform_device.h>
20 #include <linux/irq.h>
21 #include <media/rc-core.h>
22 #include <media/gpio-ir-recv.h>
24 #define GPIO_IR_DRIVER_NAME "gpio-rc-recv"
25 #define GPIO_IR_DEVICE_NAME "gpio_ir_recv"
27 struct gpio_rc_dev {
28 struct rc_dev *rcdev;
29 int gpio_nr;
30 bool active_low;
33 static irqreturn_t gpio_ir_recv_irq(int irq, void *dev_id)
35 struct gpio_rc_dev *gpio_dev = dev_id;
36 int gval;
37 int rc = 0;
38 enum raw_event_type type = IR_SPACE;
40 gval = gpio_get_value_cansleep(gpio_dev->gpio_nr);
42 if (gval < 0)
43 goto err_get_value;
45 if (gpio_dev->active_low)
46 gval = !gval;
48 if (gval == 1)
49 type = IR_PULSE;
51 rc = ir_raw_event_store_edge(gpio_dev->rcdev, type);
52 if (rc < 0)
53 goto err_get_value;
55 ir_raw_event_handle(gpio_dev->rcdev);
57 err_get_value:
58 return IRQ_HANDLED;
61 static int __devinit gpio_ir_recv_probe(struct platform_device *pdev)
63 struct gpio_rc_dev *gpio_dev;
64 struct rc_dev *rcdev;
65 const struct gpio_ir_recv_platform_data *pdata =
66 pdev->dev.platform_data;
67 int rc;
69 if (!pdata)
70 return -EINVAL;
72 if (pdata->gpio_nr < 0)
73 return -EINVAL;
75 gpio_dev = kzalloc(sizeof(struct gpio_rc_dev), GFP_KERNEL);
76 if (!gpio_dev)
77 return -ENOMEM;
79 rcdev = rc_allocate_device();
80 if (!rcdev) {
81 rc = -ENOMEM;
82 goto err_allocate_device;
85 rcdev->driver_type = RC_DRIVER_IR_RAW;
86 rcdev->allowed_protos = RC_TYPE_ALL;
87 rcdev->input_name = GPIO_IR_DEVICE_NAME;
88 rcdev->input_id.bustype = BUS_HOST;
89 rcdev->driver_name = GPIO_IR_DRIVER_NAME;
90 rcdev->map_name = RC_MAP_EMPTY;
92 gpio_dev->rcdev = rcdev;
93 gpio_dev->gpio_nr = pdata->gpio_nr;
94 gpio_dev->active_low = pdata->active_low;
96 rc = gpio_request(pdata->gpio_nr, "gpio-ir-recv");
97 if (rc < 0)
98 goto err_gpio_request;
99 rc = gpio_direction_input(pdata->gpio_nr);
100 if (rc < 0)
101 goto err_gpio_direction_input;
103 rc = rc_register_device(rcdev);
104 if (rc < 0) {
105 dev_err(&pdev->dev, "failed to register rc device\n");
106 goto err_register_rc_device;
109 platform_set_drvdata(pdev, gpio_dev);
111 rc = request_any_context_irq(gpio_to_irq(pdata->gpio_nr),
112 gpio_ir_recv_irq,
113 IRQF_TRIGGER_FALLING | IRQF_TRIGGER_RISING,
114 "gpio-ir-recv-irq", gpio_dev);
115 if (rc < 0)
116 goto err_request_irq;
118 return 0;
120 err_request_irq:
121 platform_set_drvdata(pdev, NULL);
122 rc_unregister_device(rcdev);
123 err_register_rc_device:
124 err_gpio_direction_input:
125 gpio_free(pdata->gpio_nr);
126 err_gpio_request:
127 rc_free_device(rcdev);
128 rcdev = NULL;
129 err_allocate_device:
130 kfree(gpio_dev);
131 return rc;
134 static int __devexit gpio_ir_recv_remove(struct platform_device *pdev)
136 struct gpio_rc_dev *gpio_dev = platform_get_drvdata(pdev);
138 free_irq(gpio_to_irq(gpio_dev->gpio_nr), gpio_dev);
139 platform_set_drvdata(pdev, NULL);
140 rc_unregister_device(gpio_dev->rcdev);
141 gpio_free(gpio_dev->gpio_nr);
142 rc_free_device(gpio_dev->rcdev);
143 kfree(gpio_dev);
144 return 0;
147 #ifdef CONFIG_PM
148 static int gpio_ir_recv_suspend(struct device *dev)
150 struct platform_device *pdev = to_platform_device(dev);
151 struct gpio_rc_dev *gpio_dev = platform_get_drvdata(pdev);
153 if (device_may_wakeup(dev))
154 enable_irq_wake(gpio_to_irq(gpio_dev->gpio_nr));
155 else
156 disable_irq(gpio_to_irq(gpio_dev->gpio_nr));
158 return 0;
161 static int gpio_ir_recv_resume(struct device *dev)
163 struct platform_device *pdev = to_platform_device(dev);
164 struct gpio_rc_dev *gpio_dev = platform_get_drvdata(pdev);
166 if (device_may_wakeup(dev))
167 disable_irq_wake(gpio_to_irq(gpio_dev->gpio_nr));
168 else
169 enable_irq(gpio_to_irq(gpio_dev->gpio_nr));
171 return 0;
174 static const struct dev_pm_ops gpio_ir_recv_pm_ops = {
175 .suspend = gpio_ir_recv_suspend,
176 .resume = gpio_ir_recv_resume,
178 #endif
180 static struct platform_driver gpio_ir_recv_driver = {
181 .probe = gpio_ir_recv_probe,
182 .remove = __devexit_p(gpio_ir_recv_remove),
183 .driver = {
184 .name = GPIO_IR_DRIVER_NAME,
185 .owner = THIS_MODULE,
186 #ifdef CONFIG_PM
187 .pm = &gpio_ir_recv_pm_ops,
188 #endif
192 static int __init gpio_ir_recv_init(void)
194 return platform_driver_register(&gpio_ir_recv_driver);
196 module_init(gpio_ir_recv_init);
198 static void __exit gpio_ir_recv_exit(void)
200 platform_driver_unregister(&gpio_ir_recv_driver);
202 module_exit(gpio_ir_recv_exit);
204 MODULE_DESCRIPTION("GPIO IR Receiver driver");
205 MODULE_LICENSE("GPL v2");