Commit | Line | Data |
---|---|---|
b2998049 AV |
1 | /* |
2 | * Common power driver for PDAs and phones with one or two external | |
3 | * power supplies (AC/USB) connected to main and backup batteries, | |
4 | * and optional builtin charger. | |
5 | * | |
6 | * Copyright © 2007 Anton Vorontsov <cbou@mail.ru> | |
7 | * | |
8 | * This program is free software; you can redistribute it and/or modify | |
9 | * it under the terms of the GNU General Public License version 2 as | |
10 | * published by the Free Software Foundation. | |
11 | */ | |
12 | ||
13 | #include <linux/module.h> | |
14 | #include <linux/platform_device.h> | |
15 | #include <linux/interrupt.h> | |
16 | #include <linux/power_supply.h> | |
17 | #include <linux/pda_power.h> | |
18 | #include <linux/timer.h> | |
19 | #include <linux/jiffies.h> | |
20 | ||
21 | static inline unsigned int get_irq_flags(struct resource *res) | |
22 | { | |
23 | unsigned int flags = IRQF_DISABLED | IRQF_SHARED; | |
24 | ||
25 | flags |= res->flags & IRQF_TRIGGER_MASK; | |
26 | ||
27 | return flags; | |
28 | } | |
29 | ||
30 | static struct device *dev; | |
31 | static struct pda_power_pdata *pdata; | |
32 | static struct resource *ac_irq, *usb_irq; | |
33 | static struct timer_list charger_timer; | |
34 | static struct timer_list supply_timer; | |
35 | ||
36 | static int pda_power_get_property(struct power_supply *psy, | |
37 | enum power_supply_property psp, | |
38 | union power_supply_propval *val) | |
39 | { | |
40 | switch (psp) { | |
41 | case POWER_SUPPLY_PROP_ONLINE: | |
42 | if (psy->type == POWER_SUPPLY_TYPE_MAINS) | |
43 | val->intval = pdata->is_ac_online ? | |
44 | pdata->is_ac_online() : 0; | |
45 | else | |
46 | val->intval = pdata->is_usb_online ? | |
47 | pdata->is_usb_online() : 0; | |
48 | break; | |
49 | default: | |
50 | return -EINVAL; | |
51 | } | |
52 | return 0; | |
53 | } | |
54 | ||
55 | static enum power_supply_property pda_power_props[] = { | |
56 | POWER_SUPPLY_PROP_ONLINE, | |
57 | }; | |
58 | ||
59 | static char *pda_power_supplied_to[] = { | |
60 | "main-battery", | |
61 | "backup-battery", | |
62 | }; | |
63 | ||
64 | static struct power_supply pda_power_supplies[] = { | |
65 | { | |
66 | .name = "ac", | |
67 | .type = POWER_SUPPLY_TYPE_MAINS, | |
68 | .supplied_to = pda_power_supplied_to, | |
69 | .num_supplicants = ARRAY_SIZE(pda_power_supplied_to), | |
70 | .properties = pda_power_props, | |
71 | .num_properties = ARRAY_SIZE(pda_power_props), | |
72 | .get_property = pda_power_get_property, | |
73 | }, | |
74 | { | |
75 | .name = "usb", | |
76 | .type = POWER_SUPPLY_TYPE_USB, | |
77 | .supplied_to = pda_power_supplied_to, | |
78 | .num_supplicants = ARRAY_SIZE(pda_power_supplied_to), | |
79 | .properties = pda_power_props, | |
80 | .num_properties = ARRAY_SIZE(pda_power_props), | |
81 | .get_property = pda_power_get_property, | |
82 | }, | |
83 | }; | |
84 | ||
85 | static void update_charger(void) | |
86 | { | |
87 | if (!pdata->set_charge) | |
88 | return; | |
89 | ||
90 | if (pdata->is_ac_online && pdata->is_ac_online()) { | |
91 | dev_dbg(dev, "charger on (AC)\n"); | |
92 | pdata->set_charge(PDA_POWER_CHARGE_AC); | |
93 | } else if (pdata->is_usb_online && pdata->is_usb_online()) { | |
94 | dev_dbg(dev, "charger on (USB)\n"); | |
95 | pdata->set_charge(PDA_POWER_CHARGE_USB); | |
96 | } else { | |
97 | dev_dbg(dev, "charger off\n"); | |
98 | pdata->set_charge(0); | |
99 | } | |
b2998049 AV |
100 | } |
101 | ||
5ebf6e6a | 102 | static void supply_timer_func(unsigned long power_supply_ptr) |
b2998049 | 103 | { |
5ebf6e6a JG |
104 | void *power_supply = (void *)power_supply_ptr; |
105 | ||
106 | power_supply_changed(power_supply); | |
b2998049 AV |
107 | } |
108 | ||
5ebf6e6a | 109 | static void charger_timer_func(unsigned long power_supply_ptr) |
b2998049 AV |
110 | { |
111 | update_charger(); | |
112 | ||
113 | /* Okay, charger set. Now wait a bit before notifying supplicants, | |
114 | * charge power should stabilize. */ | |
5ebf6e6a | 115 | supply_timer.data = power_supply_ptr; |
b2998049 AV |
116 | mod_timer(&supply_timer, |
117 | jiffies + msecs_to_jiffies(pdata->wait_for_charger)); | |
b2998049 AV |
118 | } |
119 | ||
5ebf6e6a | 120 | static irqreturn_t power_changed_isr(int irq, void *power_supply) |
b2998049 AV |
121 | { |
122 | /* Wait a bit before reading ac/usb line status and setting charger, | |
123 | * because ac/usb status readings may lag from irq. */ | |
5ebf6e6a | 124 | charger_timer.data = (unsigned long)power_supply; |
b2998049 AV |
125 | mod_timer(&charger_timer, |
126 | jiffies + msecs_to_jiffies(pdata->wait_for_status)); | |
127 | return IRQ_HANDLED; | |
128 | } | |
129 | ||
130 | static int pda_power_probe(struct platform_device *pdev) | |
131 | { | |
132 | int ret = 0; | |
133 | ||
134 | dev = &pdev->dev; | |
135 | ||
136 | if (pdev->id != -1) { | |
137 | dev_err(dev, "it's meaningless to register several " | |
138 | "pda_powers; use id = -1\n"); | |
139 | ret = -EINVAL; | |
140 | goto wrongid; | |
141 | } | |
142 | ||
143 | pdata = pdev->dev.platform_data; | |
144 | ||
145 | update_charger(); | |
146 | ||
147 | if (!pdata->wait_for_status) | |
148 | pdata->wait_for_status = 500; | |
149 | ||
150 | if (!pdata->wait_for_charger) | |
151 | pdata->wait_for_charger = 500; | |
152 | ||
153 | setup_timer(&charger_timer, charger_timer_func, 0); | |
154 | setup_timer(&supply_timer, supply_timer_func, 0); | |
155 | ||
156 | ac_irq = platform_get_resource_byname(pdev, IORESOURCE_IRQ, "ac"); | |
157 | usb_irq = platform_get_resource_byname(pdev, IORESOURCE_IRQ, "usb"); | |
158 | if (!ac_irq && !usb_irq) { | |
159 | dev_err(dev, "no ac/usb irq specified\n"); | |
160 | ret = -ENODEV; | |
161 | goto noirqs; | |
162 | } | |
163 | ||
164 | if (pdata->supplied_to) { | |
165 | pda_power_supplies[0].supplied_to = pdata->supplied_to; | |
166 | pda_power_supplies[1].supplied_to = pdata->supplied_to; | |
167 | pda_power_supplies[0].num_supplicants = pdata->num_supplicants; | |
168 | pda_power_supplies[1].num_supplicants = pdata->num_supplicants; | |
169 | } | |
170 | ||
9ef45106 DB |
171 | if (pdata->is_ac_online) { |
172 | ret = power_supply_register(&pdev->dev, &pda_power_supplies[0]); | |
173 | if (ret) { | |
174 | dev_err(dev, "failed to register %s power supply\n", | |
175 | pda_power_supplies[0].name); | |
176 | goto ac_supply_failed; | |
177 | } | |
b2998049 | 178 | |
9ef45106 DB |
179 | if (ac_irq) { |
180 | ret = request_irq(ac_irq->start, power_changed_isr, | |
181 | get_irq_flags(ac_irq), ac_irq->name, | |
182 | &pda_power_supplies[0]); | |
183 | if (ret) { | |
184 | dev_err(dev, "request ac irq failed\n"); | |
185 | goto ac_irq_failed; | |
186 | } | |
187 | } | |
b2998049 AV |
188 | } |
189 | ||
9ef45106 DB |
190 | if (pdata->is_usb_online) { |
191 | ret = power_supply_register(&pdev->dev, &pda_power_supplies[1]); | |
b2998049 | 192 | if (ret) { |
9ef45106 DB |
193 | dev_err(dev, "failed to register %s power supply\n", |
194 | pda_power_supplies[1].name); | |
195 | goto usb_supply_failed; | |
b2998049 | 196 | } |
b2998049 | 197 | |
9ef45106 DB |
198 | if (usb_irq) { |
199 | ret = request_irq(usb_irq->start, power_changed_isr, | |
200 | get_irq_flags(usb_irq), | |
201 | usb_irq->name, | |
202 | &pda_power_supplies[1]); | |
203 | if (ret) { | |
204 | dev_err(dev, "request usb irq failed\n"); | |
205 | goto usb_irq_failed; | |
206 | } | |
b2998049 AV |
207 | } |
208 | } | |
209 | ||
9ef45106 | 210 | return 0; |
b2998049 AV |
211 | |
212 | usb_irq_failed: | |
9ef45106 DB |
213 | if (pdata->is_usb_online) |
214 | power_supply_unregister(&pda_power_supplies[1]); | |
215 | usb_supply_failed: | |
216 | if (pdata->is_ac_online && ac_irq) | |
b2998049 AV |
217 | free_irq(ac_irq->start, &pda_power_supplies[0]); |
218 | ac_irq_failed: | |
9ef45106 DB |
219 | if (pdata->is_ac_online) |
220 | power_supply_unregister(&pda_power_supplies[0]); | |
221 | ac_supply_failed: | |
b2998049 AV |
222 | noirqs: |
223 | wrongid: | |
b2998049 AV |
224 | return ret; |
225 | } | |
226 | ||
227 | static int pda_power_remove(struct platform_device *pdev) | |
228 | { | |
9ef45106 | 229 | if (pdata->is_usb_online && usb_irq) |
b2998049 | 230 | free_irq(usb_irq->start, &pda_power_supplies[1]); |
9ef45106 | 231 | if (pdata->is_ac_online && ac_irq) |
b2998049 AV |
232 | free_irq(ac_irq->start, &pda_power_supplies[0]); |
233 | del_timer_sync(&charger_timer); | |
234 | del_timer_sync(&supply_timer); | |
9ef45106 DB |
235 | if (pdata->is_usb_online) |
236 | power_supply_unregister(&pda_power_supplies[1]); | |
237 | if (pdata->is_ac_online) | |
238 | power_supply_unregister(&pda_power_supplies[0]); | |
b2998049 AV |
239 | return 0; |
240 | } | |
241 | ||
242 | static struct platform_driver pda_power_pdrv = { | |
243 | .driver = { | |
244 | .name = "pda-power", | |
245 | }, | |
246 | .probe = pda_power_probe, | |
247 | .remove = pda_power_remove, | |
248 | }; | |
249 | ||
250 | static int __init pda_power_init(void) | |
251 | { | |
252 | return platform_driver_register(&pda_power_pdrv); | |
253 | } | |
254 | ||
255 | static void __exit pda_power_exit(void) | |
256 | { | |
257 | platform_driver_unregister(&pda_power_pdrv); | |
b2998049 AV |
258 | } |
259 | ||
260 | module_init(pda_power_init); | |
261 | module_exit(pda_power_exit); | |
262 | MODULE_LICENSE("GPL"); | |
263 | MODULE_AUTHOR("Anton Vorontsov <cbou@mail.ru>"); |