1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17#include <linux/interrupt.h>
18#include <linux/kernel.h>
19#include <linux/module.h>
20#include <linux/platform_device.h>
21#include <linux/slab.h>
22#include <linux/io.h>
23
24#include <linux/delay.h>
25#include <linux/err.h>
26#include <linux/gpio.h>
27#include <linux/mfd/core.h>
28#include <linux/power_supply.h>
29
30#include <linux/power/jz4740-battery.h>
31#include <linux/jz4740-adc.h>
32
33struct jz_battery {
34 struct jz_battery_platform_data *pdata;
35 struct platform_device *pdev;
36
37 void __iomem *base;
38
39 int irq;
40 int charge_irq;
41
42 const struct mfd_cell *cell;
43
44 int status;
45 long voltage;
46
47 struct completion read_completion;
48
49 struct power_supply *battery;
50 struct power_supply_desc battery_desc;
51 struct delayed_work work;
52
53 struct mutex lock;
54};
55
56static inline struct jz_battery *psy_to_jz_battery(struct power_supply *psy)
57{
58 return power_supply_get_drvdata(psy);
59}
60
61static irqreturn_t jz_battery_irq_handler(int irq, void *devid)
62{
63 struct jz_battery *battery = devid;
64
65 complete(&battery->read_completion);
66 return IRQ_HANDLED;
67}
68
69static long jz_battery_read_voltage(struct jz_battery *battery)
70{
71 long t;
72 unsigned long val;
73 long voltage;
74
75 mutex_lock(&battery->lock);
76
77 reinit_completion(&battery->read_completion);
78
79 enable_irq(battery->irq);
80 battery->cell->enable(battery->pdev);
81
82 t = wait_for_completion_interruptible_timeout(&battery->read_completion,
83 HZ);
84
85 if (t > 0) {
86 val = readw(battery->base) & 0xfff;
87
88 if (battery->pdata->info.voltage_max_design <= 2500000)
89 val = (val * 78125UL) >> 7UL;
90 else
91 val = ((val * 924375UL) >> 9UL) + 33000;
92 voltage = (long)val;
93 } else {
94 voltage = t ? t : -ETIMEDOUT;
95 }
96
97 battery->cell->disable(battery->pdev);
98 disable_irq(battery->irq);
99
100 mutex_unlock(&battery->lock);
101
102 return voltage;
103}
104
105static int jz_battery_get_capacity(struct power_supply *psy)
106{
107 struct jz_battery *jz_battery = psy_to_jz_battery(psy);
108 struct power_supply_info *info = &jz_battery->pdata->info;
109 long voltage;
110 int ret;
111 int voltage_span;
112
113 voltage = jz_battery_read_voltage(jz_battery);
114
115 if (voltage < 0)
116 return voltage;
117
118 voltage_span = info->voltage_max_design - info->voltage_min_design;
119 ret = ((voltage - info->voltage_min_design) * 100) / voltage_span;
120
121 if (ret > 100)
122 ret = 100;
123 else if (ret < 0)
124 ret = 0;
125
126 return ret;
127}
128
129static int jz_battery_get_property(struct power_supply *psy,
130 enum power_supply_property psp, union power_supply_propval *val)
131{
132 struct jz_battery *jz_battery = psy_to_jz_battery(psy);
133 struct power_supply_info *info = &jz_battery->pdata->info;
134 long voltage;
135
136 switch (psp) {
137 case POWER_SUPPLY_PROP_STATUS:
138 val->intval = jz_battery->status;
139 break;
140 case POWER_SUPPLY_PROP_TECHNOLOGY:
141 val->intval = jz_battery->pdata->info.technology;
142 break;
143 case POWER_SUPPLY_PROP_HEALTH:
144 voltage = jz_battery_read_voltage(jz_battery);
145 if (voltage < info->voltage_min_design)
146 val->intval = POWER_SUPPLY_HEALTH_DEAD;
147 else
148 val->intval = POWER_SUPPLY_HEALTH_GOOD;
149 break;
150 case POWER_SUPPLY_PROP_CAPACITY:
151 val->intval = jz_battery_get_capacity(psy);
152 break;
153 case POWER_SUPPLY_PROP_VOLTAGE_NOW:
154 val->intval = jz_battery_read_voltage(jz_battery);
155 if (val->intval < 0)
156 return val->intval;
157 break;
158 case POWER_SUPPLY_PROP_VOLTAGE_MAX_DESIGN:
159 val->intval = info->voltage_max_design;
160 break;
161 case POWER_SUPPLY_PROP_VOLTAGE_MIN_DESIGN:
162 val->intval = info->voltage_min_design;
163 break;
164 case POWER_SUPPLY_PROP_PRESENT:
165 val->intval = 1;
166 break;
167 default:
168 return -EINVAL;
169 }
170 return 0;
171}
172
173static void jz_battery_external_power_changed(struct power_supply *psy)
174{
175 struct jz_battery *jz_battery = psy_to_jz_battery(psy);
176
177 mod_delayed_work(system_wq, &jz_battery->work, 0);
178}
179
180static irqreturn_t jz_battery_charge_irq(int irq, void *data)
181{
182 struct jz_battery *jz_battery = data;
183
184 mod_delayed_work(system_wq, &jz_battery->work, 0);
185
186 return IRQ_HANDLED;
187}
188
189static void jz_battery_update(struct jz_battery *jz_battery)
190{
191 int status;
192 long voltage;
193 bool has_changed = false;
194 int is_charging;
195
196 if (gpio_is_valid(jz_battery->pdata->gpio_charge)) {
197 is_charging = gpio_get_value(jz_battery->pdata->gpio_charge);
198 is_charging ^= jz_battery->pdata->gpio_charge_active_low;
199 if (is_charging)
200 status = POWER_SUPPLY_STATUS_CHARGING;
201 else
202 status = POWER_SUPPLY_STATUS_NOT_CHARGING;
203
204 if (status != jz_battery->status) {
205 jz_battery->status = status;
206 has_changed = true;
207 }
208 }
209
210 voltage = jz_battery_read_voltage(jz_battery);
211 if (voltage >= 0 && abs(voltage - jz_battery->voltage) > 50000) {
212 jz_battery->voltage = voltage;
213 has_changed = true;
214 }
215
216 if (has_changed)
217 power_supply_changed(jz_battery->battery);
218}
219
220static enum power_supply_property jz_battery_properties[] = {
221 POWER_SUPPLY_PROP_STATUS,
222 POWER_SUPPLY_PROP_TECHNOLOGY,
223 POWER_SUPPLY_PROP_HEALTH,
224 POWER_SUPPLY_PROP_CAPACITY,
225 POWER_SUPPLY_PROP_VOLTAGE_NOW,
226 POWER_SUPPLY_PROP_VOLTAGE_MAX_DESIGN,
227 POWER_SUPPLY_PROP_VOLTAGE_MIN_DESIGN,
228 POWER_SUPPLY_PROP_PRESENT,
229};
230
231static void jz_battery_work(struct work_struct *work)
232{
233
234 const int interval = HZ * 30;
235 struct jz_battery *jz_battery = container_of(work, struct jz_battery,
236 work.work);
237
238 jz_battery_update(jz_battery);
239 schedule_delayed_work(&jz_battery->work, interval);
240}
241
242static int jz_battery_probe(struct platform_device *pdev)
243{
244 int ret = 0;
245 struct jz_battery_platform_data *pdata = pdev->dev.parent->platform_data;
246 struct power_supply_config psy_cfg = {};
247 struct jz_battery *jz_battery;
248 struct power_supply_desc *battery_desc;
249 struct resource *mem;
250
251 if (!pdata) {
252 dev_err(&pdev->dev, "No platform_data supplied\n");
253 return -ENXIO;
254 }
255
256 jz_battery = devm_kzalloc(&pdev->dev, sizeof(*jz_battery), GFP_KERNEL);
257 if (!jz_battery) {
258 dev_err(&pdev->dev, "Failed to allocate driver structure\n");
259 return -ENOMEM;
260 }
261
262 jz_battery->cell = mfd_get_cell(pdev);
263
264 jz_battery->irq = platform_get_irq(pdev, 0);
265 if (jz_battery->irq < 0) {
266 dev_err(&pdev->dev, "Failed to get platform irq: %d\n", ret);
267 return jz_battery->irq;
268 }
269
270 mem = platform_get_resource(pdev, IORESOURCE_MEM, 0);
271
272 jz_battery->base = devm_ioremap_resource(&pdev->dev, mem);
273 if (IS_ERR(jz_battery->base))
274 return PTR_ERR(jz_battery->base);
275
276 battery_desc = &jz_battery->battery_desc;
277 battery_desc->name = pdata->info.name;
278 battery_desc->type = POWER_SUPPLY_TYPE_BATTERY;
279 battery_desc->properties = jz_battery_properties;
280 battery_desc->num_properties = ARRAY_SIZE(jz_battery_properties);
281 battery_desc->get_property = jz_battery_get_property;
282 battery_desc->external_power_changed =
283 jz_battery_external_power_changed;
284 battery_desc->use_for_apm = 1;
285
286 psy_cfg.drv_data = jz_battery;
287
288 jz_battery->pdata = pdata;
289 jz_battery->pdev = pdev;
290
291 init_completion(&jz_battery->read_completion);
292 mutex_init(&jz_battery->lock);
293
294 INIT_DELAYED_WORK(&jz_battery->work, jz_battery_work);
295
296 ret = request_irq(jz_battery->irq, jz_battery_irq_handler, 0, pdev->name,
297 jz_battery);
298 if (ret) {
299 dev_err(&pdev->dev, "Failed to request irq %d\n", ret);
300 return ret;
301 }
302 disable_irq(jz_battery->irq);
303
304 if (gpio_is_valid(pdata->gpio_charge)) {
305 ret = gpio_request(pdata->gpio_charge, dev_name(&pdev->dev));
306 if (ret) {
307 dev_err(&pdev->dev, "charger state gpio request failed.\n");
308 goto err_free_irq;
309 }
310 ret = gpio_direction_input(pdata->gpio_charge);
311 if (ret) {
312 dev_err(&pdev->dev, "charger state gpio set direction failed.\n");
313 goto err_free_gpio;
314 }
315
316 jz_battery->charge_irq = gpio_to_irq(pdata->gpio_charge);
317
318 if (jz_battery->charge_irq >= 0) {
319 ret = request_irq(jz_battery->charge_irq,
320 jz_battery_charge_irq,
321 IRQF_TRIGGER_RISING | IRQF_TRIGGER_FALLING,
322 dev_name(&pdev->dev), jz_battery);
323 if (ret) {
324 dev_err(&pdev->dev, "Failed to request charge irq: %d\n", ret);
325 goto err_free_gpio;
326 }
327 }
328 } else {
329 jz_battery->charge_irq = -1;
330 }
331
332 if (jz_battery->pdata->info.voltage_max_design <= 2500000)
333 jz4740_adc_set_config(pdev->dev.parent, JZ_ADC_CONFIG_BAT_MB,
334 JZ_ADC_CONFIG_BAT_MB);
335 else
336 jz4740_adc_set_config(pdev->dev.parent, JZ_ADC_CONFIG_BAT_MB, 0);
337
338 jz_battery->battery = power_supply_register(&pdev->dev, battery_desc,
339 &psy_cfg);
340 if (IS_ERR(jz_battery->battery)) {
341 dev_err(&pdev->dev, "power supply battery register failed.\n");
342 ret = PTR_ERR(jz_battery->battery);
343 goto err_free_charge_irq;
344 }
345
346 platform_set_drvdata(pdev, jz_battery);
347 schedule_delayed_work(&jz_battery->work, 0);
348
349 return 0;
350
351err_free_charge_irq:
352 if (jz_battery->charge_irq >= 0)
353 free_irq(jz_battery->charge_irq, jz_battery);
354err_free_gpio:
355 if (gpio_is_valid(pdata->gpio_charge))
356 gpio_free(jz_battery->pdata->gpio_charge);
357err_free_irq:
358 free_irq(jz_battery->irq, jz_battery);
359 return ret;
360}
361
362static int jz_battery_remove(struct platform_device *pdev)
363{
364 struct jz_battery *jz_battery = platform_get_drvdata(pdev);
365
366 cancel_delayed_work_sync(&jz_battery->work);
367
368 if (gpio_is_valid(jz_battery->pdata->gpio_charge)) {
369 if (jz_battery->charge_irq >= 0)
370 free_irq(jz_battery->charge_irq, jz_battery);
371 gpio_free(jz_battery->pdata->gpio_charge);
372 }
373
374 power_supply_unregister(jz_battery->battery);
375
376 free_irq(jz_battery->irq, jz_battery);
377
378 return 0;
379}
380
381#ifdef CONFIG_PM
382static int jz_battery_suspend(struct device *dev)
383{
384 struct jz_battery *jz_battery = dev_get_drvdata(dev);
385
386 cancel_delayed_work_sync(&jz_battery->work);
387 jz_battery->status = POWER_SUPPLY_STATUS_UNKNOWN;
388
389 return 0;
390}
391
392static int jz_battery_resume(struct device *dev)
393{
394 struct jz_battery *jz_battery = dev_get_drvdata(dev);
395
396 schedule_delayed_work(&jz_battery->work, 0);
397
398 return 0;
399}
400
401static const struct dev_pm_ops jz_battery_pm_ops = {
402 .suspend = jz_battery_suspend,
403 .resume = jz_battery_resume,
404};
405
406#define JZ_BATTERY_PM_OPS (&jz_battery_pm_ops)
407#else
408#define JZ_BATTERY_PM_OPS NULL
409#endif
410
411static struct platform_driver jz_battery_driver = {
412 .probe = jz_battery_probe,
413 .remove = jz_battery_remove,
414 .driver = {
415 .name = "jz4740-battery",
416 .pm = JZ_BATTERY_PM_OPS,
417 },
418};
419
420module_platform_driver(jz_battery_driver);
421
422MODULE_ALIAS("platform:jz4740-battery");
423MODULE_LICENSE("GPL");
424MODULE_AUTHOR("Lars-Peter Clausen <lars@metafoo.de>");
425MODULE_DESCRIPTION("JZ4740 SoC battery driver");
426
