Root/
Source at commit 97d812a created 13 years 11 months ago. By Lars-Peter Clausen, Add gpio chager driver | |
---|---|
1 | /* |
2 | * Copyright (C) 2010, Lars-Peter Clausen <lars@metafoo.de> |
3 | * Driver for chargers indicating their status through a GPIO pin |
4 | * |
5 | * This program is free software; you can redistribute it and/or modify it |
6 | * under the terms of the GNU General Public License as published by the |
7 | * Free Software Foundation; either version 2 of the License, or (at your |
8 | * option) any later version. |
9 | * |
10 | * You should have received a copy of the GNU General Public License along |
11 | * with this program; if not, write to the Free Software Foundation, Inc., |
12 | * 675 Mass Ave, Cambridge, MA 02139, USA. |
13 | * |
14 | */ |
15 | |
16 | #include <linux/device.h> |
17 | #include <linux/gpio.h> |
18 | #include <linux/init.h> |
19 | #include <linux/interrupt.h> |
20 | #include <linux/kernel.h> |
21 | #include <linux/module.h> |
22 | #include <linux/platform_device.h> |
23 | #include <linux/power_supply.h> |
24 | #include <linux/slab.h> |
25 | #include <linux/types.h> |
26 | |
27 | #include <linux/power/gpio-charger.h> |
28 | |
29 | struct gpio_charger { |
30 | const struct gpio_charger_platform_data *pdata; |
31 | |
32 | int irq; |
33 | |
34 | struct power_supply charger; |
35 | }; |
36 | |
37 | static irqreturn_t gpio_charger_irq(int irq, void *devid) |
38 | { |
39 | struct power_supply *charger = devid; |
40 | power_supply_changed(charger); |
41 | |
42 | return IRQ_HANDLED; |
43 | } |
44 | |
45 | static inline struct gpio_charger *psy_to_gpio_charger(struct power_supply *psy) |
46 | { |
47 | return container_of(psy, struct gpio_charger, charger); |
48 | } |
49 | |
50 | static int gpio_charger_get_property(struct power_supply *psy, |
51 | enum power_supply_property psp, union power_supply_propval *val) |
52 | { |
53 | struct gpio_charger *gpio_charger = psy_to_gpio_charger(psy); |
54 | const struct gpio_charger_platform_data *pdata = gpio_charger->pdata; |
55 | |
56 | switch (psp) { |
57 | case POWER_SUPPLY_PROP_ONLINE: |
58 | val->intval = gpio_get_value(pdata->gpio); |
59 | val->intval ^= pdata->gpio_active_low; |
60 | break; |
61 | default: |
62 | return -EINVAL; |
63 | } |
64 | |
65 | return 0; |
66 | } |
67 | |
68 | static enum power_supply_property gpio_charger_properties[] = { |
69 | POWER_SUPPLY_PROP_ONLINE, |
70 | }; |
71 | |
72 | static int __devinit gpio_charger_probe(struct platform_device *pdev) |
73 | { |
74 | const struct gpio_charger_platform_data *pdata = pdev->dev.platform_data; |
75 | struct gpio_charger *gpio_charger; |
76 | struct power_supply *charger; |
77 | int ret; |
78 | |
79 | if (!pdata) { |
80 | dev_err(&pdev->dev, "No platform data"); |
81 | return -EINVAL; |
82 | } |
83 | |
84 | gpio_charger = kzalloc(sizeof(*gpio_charger), GFP_KERNEL); |
85 | |
86 | charger = &gpio_charger->charger; |
87 | |
88 | charger->name = pdata->name; |
89 | charger->type = pdata->type; |
90 | charger->properties = gpio_charger_properties; |
91 | charger->num_properties = ARRAY_SIZE(gpio_charger_properties); |
92 | charger->get_property = gpio_charger_get_property; |
93 | charger->supplied_to = pdata->batteries; |
94 | charger->num_supplicants = pdata->num_batteries; |
95 | |
96 | if (gpio_is_valid(pdata->gpio)) { |
97 | ret = gpio_request(pdata->gpio, dev_name(&pdev->dev)); |
98 | if (ret) { |
99 | dev_err(&pdev->dev, "Failed to request gpio pin: %d\n", ret); |
100 | goto err; |
101 | } |
102 | ret = gpio_direction_input(pdata->gpio); |
103 | if (ret) { |
104 | dev_err(&pdev->dev, "Failed to set gpio to input: %d\n", ret); |
105 | goto err_gpio_free; |
106 | } |
107 | |
108 | gpio_charger->irq = gpio_to_irq(pdata->gpio); |
109 | if (gpio_charger->irq >= 0) { |
110 | ret = request_irq(gpio_charger->irq, gpio_charger_irq, |
111 | IRQF_TRIGGER_RISING | IRQF_TRIGGER_FALLING, |
112 | dev_name(&pdev->dev), charger); |
113 | if (ret) { |
114 | dev_warn(&pdev->dev, "Failed to request online gpio irq: %d\n", ret); |
115 | gpio_charger->irq = -1; |
116 | } |
117 | } |
118 | } |
119 | |
120 | gpio_charger->pdata = pdata; |
121 | |
122 | ret = power_supply_register(&pdev->dev, charger); |
123 | if (ret < 0) { |
124 | dev_err(&pdev->dev, "Failed to register power supply: %d\n", ret); |
125 | goto err_gpio_free; |
126 | } |
127 | |
128 | platform_set_drvdata(pdev, gpio_charger); |
129 | |
130 | return 0; |
131 | |
132 | err_gpio_free: |
133 | if (gpio_is_valid(pdata->gpio)) { |
134 | if (gpio_charger->irq >= 0) |
135 | free_irq(gpio_charger->irq, charger); |
136 | gpio_free(pdata->gpio); |
137 | } |
138 | err: |
139 | return ret; |
140 | } |
141 | |
142 | static int __devexit gpio_charger_remove(struct platform_device *pdev) |
143 | { |
144 | struct gpio_charger *gpio_charger = platform_get_drvdata(pdev); |
145 | const struct gpio_charger_platform_data *pdata = gpio_charger->pdata; |
146 | |
147 | power_supply_unregister(&gpio_charger->charger); |
148 | |
149 | if (gpio_is_valid(pdata->gpio)) { |
150 | if (gpio_charger->irq >= 0) |
151 | free_irq(gpio_charger->irq, &gpio_charger->charger); |
152 | gpio_free(pdata->gpio); |
153 | } |
154 | |
155 | platform_set_drvdata(pdev, NULL); |
156 | kfree(gpio_charger); |
157 | |
158 | return 0; |
159 | } |
160 | |
161 | static struct platform_driver gpio_charger_driver = { |
162 | .probe = gpio_charger_probe, |
163 | .remove = __devexit_p(gpio_charger_remove), |
164 | .driver = { |
165 | .name = "gpio-charger", |
166 | .owner = THIS_MODULE, |
167 | }, |
168 | }; |
169 | |
170 | static int __init gpio_charger_init(void) |
171 | { |
172 | return platform_driver_register(&gpio_charger_driver); |
173 | } |
174 | module_init(gpio_charger_init); |
175 | |
176 | static void __exit gpio_charger_exit(void) |
177 | { |
178 | platform_driver_unregister(&gpio_charger_driver); |
179 | } |
180 | module_exit(gpio_charger_exit); |
181 | |
182 | MODULE_AUTHOR("Lars-Peter Clausen <lars@metafoo.de>"); |
183 | MODULE_DESCRIPTION("Driver for chargers indicating their status through a gpio"); |
184 | MODULE_LICENSE("GPL"); |
185 | MODULE_ALIAS("platform:gpio-charger"); |
186 |
Branches:
ben-wpan
ben-wpan-stefan
javiroman/ks7010
jz-2.6.34
jz-2.6.34-rc5
jz-2.6.34-rc6
jz-2.6.34-rc7
jz-2.6.35
jz-2.6.36
jz-2.6.37
jz-2.6.38
jz-2.6.39
jz-3.0
jz-3.1
jz-3.11
jz-3.12
jz-3.13
jz-3.15
jz-3.16
jz-3.18-dt
jz-3.2
jz-3.3
jz-3.4
jz-3.5
jz-3.6
jz-3.6-rc2-pwm
jz-3.9
jz-3.9-clk
jz-3.9-rc8
jz47xx
jz47xx-2.6.38
master
Tags:
od-2011-09-04
od-2011-09-18
v2.6.34-rc5
v2.6.34-rc6
v2.6.34-rc7
v3.9