70c80ebd72d72e3c1347af17de2715342b0eb0f8
[librecmc/librecmc.git] / target / linux / xburst / files-2.6.32 / drivers / power / jz4740-battery.c
1 /*
2  * Battery measurement code for Ingenic JZ SOC.
3  *
4  * Copyright (C) 2009 Jiejing Zhang <kzjeef@gmail.com>
5  * Copyright (C) 2010, Lars-Peter Clausen <lars@metafoo.de>
6  *
7  * based on tosa_battery.c
8  *
9  * Copyright (C) 2008 Marek Vasut <marek.vasut@gmail.com>
10 *
11  * This program is free software; you can redistribute it and/or modify
12  * it under the terms of the GNU General Public License version 2 as
13  * published by the Free Software Foundation.
14  *
15  */
16 #include <linux/kernel.h>
17 #include <linux/module.h>
18 #include <linux/power_supply.h>
19 #include <linux/delay.h>
20 #include <linux/spinlock.h>
21 #include <linux/interrupt.h>
22 #include <linux/platform_device.h>
23 #include <linux/gpio.h>
24 #include <linux/interrupt.h>
25
26 #include <linux/power/jz4740-battery.h>
27 #include <linux/jz4740-adc.h>
28
29 struct jz_battery {
30         struct jz_battery_platform_data *pdata;
31
32         int charge_irq;
33
34         int status;
35         long voltage;
36
37         struct power_supply battery;
38         struct delayed_work work;
39 };
40
41 static inline struct jz_battery *psy_to_jz_battery(struct power_supply *psy)
42 {
43         return container_of(psy, struct jz_battery, battery);
44 }
45
46 static long jz_battery_read_voltage(struct jz_battery *jz_battery)
47 {
48         struct device *adc = jz_battery->battery.dev->parent->parent;
49         enum jz_adc_battery_scale scale;
50
51         if (jz_battery->pdata->info.voltage_max_design > 2500000)
52                 scale = JZ_ADC_BATTERY_SCALE_7V5;
53         else
54                 scale = JZ_ADC_BATTERY_SCALE_2V5;
55
56         return jz4740_adc_read_battery_voltage(adc, scale);
57 }
58
59 static int jz_battery_get_capacity(struct power_supply *psy)
60 {
61         struct jz_battery *jz_battery = psy_to_jz_battery(psy);
62         struct power_supply_info *info = &jz_battery->pdata->info;
63         long voltage;
64         int ret;
65         int voltage_span;
66
67         voltage = jz_battery_read_voltage(jz_battery);
68
69         if (voltage < 0)
70                 return voltage;
71
72         voltage_span = info->voltage_max_design - info->voltage_min_design;
73         ret = ((voltage - info->voltage_min_design) * 100) / voltage_span;
74
75         if (ret > 100)
76                 ret = 100;
77         else if (ret < 0)
78                 ret = 0;
79
80         return ret;
81 }
82
83 static int jz_battery_get_property(struct power_supply *psy,
84                                 enum power_supply_property psp,
85                                 union power_supply_propval *val)
86 {
87         struct jz_battery *jz_battery = psy_to_jz_battery(psy);
88         struct power_supply_info *info = &jz_battery->pdata->info;
89         long voltage;
90
91         switch (psp) {
92         case POWER_SUPPLY_PROP_STATUS:
93                 val->intval = jz_battery->status;
94                 break;
95         case POWER_SUPPLY_PROP_TECHNOLOGY:
96                 val->intval = jz_battery->pdata->info.technology;
97                 break;
98         case POWER_SUPPLY_PROP_HEALTH:
99                 voltage = jz_battery_read_voltage(jz_battery);
100                 if (voltage < info->voltage_min_design)
101                         val->intval = POWER_SUPPLY_HEALTH_DEAD;
102                 else
103                         val->intval = POWER_SUPPLY_HEALTH_GOOD;
104                 break;
105         case POWER_SUPPLY_PROP_CAPACITY:
106                 val->intval = jz_battery_get_capacity(psy);
107                 break;
108         case POWER_SUPPLY_PROP_VOLTAGE_NOW:
109                 val->intval = jz_battery_read_voltage(jz_battery);
110                 if (val->intval < 0)
111                         return val->intval;
112                 break;
113         case POWER_SUPPLY_PROP_VOLTAGE_MAX_DESIGN:
114                 val->intval = info->voltage_max_design;
115                 break;
116         case POWER_SUPPLY_PROP_VOLTAGE_MIN_DESIGN:
117                 val->intval = info->voltage_min_design;
118                 break;
119         case POWER_SUPPLY_PROP_PRESENT:
120                 val->intval = 1;
121                 break;
122         default:
123                 return -EINVAL;
124         }
125         return 0;
126 }
127
128 static void jz_battery_external_power_changed(struct power_supply *psy)
129 {
130         struct jz_battery *jz_battery = psy_to_jz_battery(psy);
131
132         cancel_delayed_work(&jz_battery->work);
133         schedule_delayed_work(&jz_battery->work, 0);
134 }
135
136 static irqreturn_t jz_battery_charge_irq(int irq, void *data)
137 {
138         struct jz_battery *jz_battery = data;
139
140         cancel_delayed_work(&jz_battery->work);
141         schedule_delayed_work(&jz_battery->work, 0);
142
143         return IRQ_HANDLED;
144 }
145
146 static void jz_battery_update(struct jz_battery *jz_battery)
147 {
148         int status;
149         long voltage;
150         long voltage_difference;
151         bool has_changed = 0;
152
153         if (gpio_is_valid(jz_battery->pdata->gpio_charge)) {
154                 int is_charging;
155
156                 is_charging = gpio_get_value(jz_battery->pdata->gpio_charge);
157                 is_charging ^= jz_battery->pdata->gpio_charge_active_low;
158                 if (is_charging)
159                         status = POWER_SUPPLY_STATUS_CHARGING;
160                 else
161                         status = POWER_SUPPLY_STATUS_NOT_CHARGING;
162
163                 if (status != jz_battery->status) {
164                         jz_battery->status = status;
165                         has_changed = 1;
166                 }
167         }
168
169         voltage = jz_battery_read_voltage(jz_battery);
170         voltage_difference = voltage - jz_battery->voltage;
171         if (voltage_difference > 50000 || voltage_difference < 50000) {
172                 jz_battery->voltage = voltage;
173                 has_changed = 1;
174         }
175         if (has_changed)
176                 power_supply_changed(&jz_battery->battery);
177 }
178
179 static enum power_supply_property jz_battery_properties[] = {
180         POWER_SUPPLY_PROP_STATUS,
181         POWER_SUPPLY_PROP_TECHNOLOGY,
182         POWER_SUPPLY_PROP_HEALTH,
183         POWER_SUPPLY_PROP_CAPACITY,
184         POWER_SUPPLY_PROP_VOLTAGE_NOW,
185         POWER_SUPPLY_PROP_VOLTAGE_MAX_DESIGN,
186         POWER_SUPPLY_PROP_VOLTAGE_MIN_DESIGN,
187         POWER_SUPPLY_PROP_PRESENT,
188 };
189
190 static void jz_battery_work(struct work_struct *work)
191 {
192         /* Too small interval will increase system workload */
193         const int interval = HZ * 30;
194         struct jz_battery *jz_battery = container_of(work, struct jz_battery,
195                                             work.work);
196
197         jz_battery_update(jz_battery);
198         schedule_delayed_work(&jz_battery->work, interval);
199 }
200
201 static int jz_battery_probe(struct platform_device *pdev)
202 {
203         int ret = 0;
204         struct jz_battery_platform_data *pdata = pdev->dev.platform_data;
205         struct jz_battery *jz_battery;
206         struct power_supply *battery;
207
208         if (!pdev->dev.platform_data) {
209                 dev_err(&pdev->dev, "No platform data\n");
210                 return -EINVAL;
211         }
212
213         jz_battery = kzalloc(sizeof(*jz_battery), GFP_KERNEL);
214
215         if (!jz_battery) {
216                 dev_err(&pdev->dev, "Failed to allocate driver structure\n");
217                 return -ENOMEM;
218         }
219
220         battery = &jz_battery->battery;
221         battery->name = pdata->info.name;
222         battery->type = POWER_SUPPLY_TYPE_BATTERY;
223         battery->properties     = jz_battery_properties;
224         battery->num_properties = ARRAY_SIZE(jz_battery_properties);
225         battery->get_property = jz_battery_get_property;
226         battery->external_power_changed = jz_battery_external_power_changed;
227         battery->use_for_apm = 1;
228
229         jz_battery->pdata = pdata;
230
231         INIT_DELAYED_WORK(&jz_battery->work, jz_battery_work);
232
233         if (gpio_is_valid(pdata->gpio_charge)) {
234                 ret = gpio_request(pdata->gpio_charge, dev_name(&pdev->dev));
235                 if (ret) {
236                         dev_err(&pdev->dev, "charger state gpio request failed.\n");
237                         goto err_free;
238                 }
239                 ret = gpio_direction_input(pdata->gpio_charge);
240                 if (ret) {
241                         dev_err(&pdev->dev, "charger state gpio set direction failed.\n");
242                         goto err_free_gpio;
243                 }
244
245                 jz_battery->charge_irq = gpio_to_irq(pdata->gpio_charge);
246
247                 if (jz_battery->charge_irq >= 0) {
248                         ret = request_irq(jz_battery->charge_irq,
249                                     jz_battery_charge_irq,
250                                     IRQF_TRIGGER_RISING | IRQF_TRIGGER_FALLING,
251                                     dev_name(&pdev->dev), jz_battery);
252                         if (ret) {
253                                 dev_err(&pdev->dev, "Failed to request charge irq: %d\n", ret);
254                                 goto err_free_gpio;
255                         }
256                 }
257         } else {
258                 jz_battery->charge_irq = -1;
259         }
260
261
262         ret = power_supply_register(&pdev->dev, &jz_battery->battery);
263         if (ret) {
264                 dev_err(&pdev->dev, "power supply battery register failed.\n");
265                 goto err_free_irq;
266         }
267
268         platform_set_drvdata(pdev, jz_battery);
269         schedule_delayed_work(&jz_battery->work, 0);
270
271         return 0;
272
273 err_free_irq:
274         if (jz_battery->charge_irq >= 0)
275                 free_irq(jz_battery->charge_irq, jz_battery);
276 err_free_gpio:
277         if (gpio_is_valid(pdata->gpio_charge))
278                 gpio_free(jz_battery->pdata->gpio_charge);
279 err_free:
280         kfree(jz_battery);
281         return ret;
282 }
283
284 static int jz_battery_remove(struct platform_device *pdev)
285 {
286         struct jz_battery *jz_battery = platform_get_drvdata(pdev);
287
288         cancel_delayed_work_sync(&jz_battery->work);
289
290         if (gpio_is_valid(jz_battery->pdata->gpio_charge)) {
291                 if (jz_battery->charge_irq >= 0)
292                         free_irq(jz_battery->charge_irq, jz_battery);
293                 gpio_free(jz_battery->pdata->gpio_charge);
294         }
295
296         power_supply_unregister(&jz_battery->battery);
297
298         return 0;
299 }
300
301 #ifdef CONFIG_PM
302 static int jz_battery_suspend(struct platform_device *pdev, pm_message_t state)
303 {
304         struct jz_battery *jz_battery = platform_get_drvdata(pdev);
305
306         cancel_delayed_work_sync(&jz_battery->work);
307         jz_battery->status =  POWER_SUPPLY_STATUS_UNKNOWN;
308
309         return 0;
310 }
311
312 static int jz_battery_resume(struct platform_device *pdev)
313 {
314         struct jz_battery *jz_battery = platform_get_drvdata(pdev);
315
316         schedule_delayed_work(&jz_battery->work, 0);
317
318         return 0;
319 }
320 #else
321 #define jz_battery_suspend NULL
322 #define jz_battery_resume NULL
323 #endif
324
325 static struct platform_driver jz_battery_driver = {
326         .probe          = jz_battery_probe,
327         .remove         = __devexit_p(jz_battery_remove),
328         .suspend        = jz_battery_suspend,
329         .resume         = jz_battery_resume,
330         .driver = {
331                 .name = "jz4740-battery",
332                 .owner = THIS_MODULE,
333         },
334 };
335
336 static int __init jz_battery_init(void)
337 {
338         return platform_driver_register(&jz_battery_driver);
339 }
340 module_init(jz_battery_init);
341
342 static void __exit jz_battery_exit(void)
343 {
344         platform_driver_unregister(&jz_battery_driver);
345 }
346 module_exit(jz_battery_exit);
347
348 MODULE_LICENSE("GPL");
349 MODULE_AUTHOR("Jiejing Zhang <kzjeef@gmail.com>");
350 MODULE_DESCRIPTION("JZ4720/JZ4740 SoC battery driver");