]> git.proxmox.com Git - mirror_ubuntu-hirsute-kernel.git/blame - drivers/power/supply/cpcap-battery.c
projects / mirror_ubuntu-hirsute-kernel.git / blame
? search:
summary | shortlog | log | commit | commitdiff | tree
blob | blame (incremental) | history | HEAD
Merge tag 'powerpc-5.2-2' of git://git.kernel.org/pub/scm/linux/kernel/git/powerpc...
[mirror_ubuntu-hirsute-kernel.git] / drivers / power / supply / cpcap-battery.c
CommitLineData
874b2adb
TL		 1/*
2 * Battery driver for CPCAP PMIC
3 *
4 * Copyright (C) 2017 Tony Lindgren <tony@atomide.com>
5 *
6 * Some parts of the code based on earlie Motorola mapphone Linux kernel
7 * drivers:
8 *
9 * Copyright (C) 2009-2010 Motorola, Inc.
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 * This program is distributed "as is" WITHOUT ANY WARRANTY of any
16 * kind, whether express or implied; without even the implied warranty
17 * of MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
18 * GNU General Public License for more details.
19 */
20
21#include <linux/delay.h>
22#include <linux/err.h>
23#include <linux/interrupt.h>
24#include <linux/kernel.h>
25#include <linux/module.h>
26#include <linux/of_device.h>
27#include <linux/platform_device.h>
28#include <linux/power_supply.h>
29#include <linux/reboot.h>
30#include <linux/regmap.h>
31
32#include <linux/iio/consumer.h>
33#include <linux/iio/types.h>
34#include <linux/mfd/motorola-cpcap.h>
35
36#include <asm/div64.h>
37
38/*
39 * Register bit defines for CPCAP_REG_BPEOL. Some of these seem to
40 * map to MC13783UG.pdf "Table 5-19. Register 13, Power Control 0"
41 * to enable BATTDETEN, LOBAT and EOL features. We currently use
42 * LOBAT interrupts instead of EOL.
43 */
44#define CPCAP_REG_BPEOL_BIT_EOL9 BIT(9) /* Set for EOL irq */
45#define CPCAP_REG_BPEOL_BIT_EOL8 BIT(8) /* Set for EOL irq */
46#define CPCAP_REG_BPEOL_BIT_UNKNOWN7 BIT(7)
47#define CPCAP_REG_BPEOL_BIT_UNKNOWN6 BIT(6)
48#define CPCAP_REG_BPEOL_BIT_UNKNOWN5 BIT(5)
49#define CPCAP_REG_BPEOL_BIT_EOL_MULTI BIT(4) /* Set for multiple EOL irqs */
50#define CPCAP_REG_BPEOL_BIT_UNKNOWN3 BIT(3)
51#define CPCAP_REG_BPEOL_BIT_UNKNOWN2 BIT(2)
52#define CPCAP_REG_BPEOL_BIT_BATTDETEN BIT(1) /* Enable battery detect */
53#define CPCAP_REG_BPEOL_BIT_EOLSEL BIT(0) /* BPDET = 0, EOL = 1 */
54
55#define CPCAP_BATTERY_CC_SAMPLE_PERIOD_MS 250
56
57enum {
58 CPCAP_BATTERY_IIO_BATTDET,
59 CPCAP_BATTERY_IIO_VOLTAGE,
60 CPCAP_BATTERY_IIO_CHRG_CURRENT,
61 CPCAP_BATTERY_IIO_BATT_CURRENT,
62 CPCAP_BATTERY_IIO_NR,
63};
64
65enum cpcap_battery_irq_action {
66 CPCAP_BATTERY_IRQ_ACTION_NONE,
67 CPCAP_BATTERY_IRQ_ACTION_BATTERY_LOW,
68 CPCAP_BATTERY_IRQ_ACTION_POWEROFF,
69};
70
71struct cpcap_interrupt_desc {
72 const char *name;
73 struct list_head node;
74 int irq;
75 enum cpcap_battery_irq_action action;
76};
77
78struct cpcap_battery_config {
79 int ccm;
80 int cd_factor;
81 struct power_supply_info info;
82};
83
84struct cpcap_coulomb_counter_data {
c68b901a 85 s32 sample; /* 24 or 32 bits */
874b2adb 86 s32 accumulator;
35439b7a 87 s16 offset; /* 9 bits */
874b2adb
TL		 88};
89
90enum cpcap_battery_state {
91 CPCAP_BATTERY_STATE_PREVIOUS,
92 CPCAP_BATTERY_STATE_LATEST,
93 CPCAP_BATTERY_STATE_NR,
94};
95
96struct cpcap_battery_state_data {
97 int voltage;
98 int current_ua;
99 int counter_uah;
100 int temperature;
101 ktime_t time;
102 struct cpcap_coulomb_counter_data cc;
103};
104
105struct cpcap_battery_ddata {
106 struct device *dev;
107 struct regmap *reg;
108 struct list_head irq_list;
109 struct iio_channel *channels[CPCAP_BATTERY_IIO_NR];
110 struct power_supply *psy;
111 struct cpcap_battery_config config;
112 struct cpcap_battery_state_data state[CPCAP_BATTERY_STATE_NR];
113 atomic_t active;
114 int status;
115 u16 vendor;
116};
117
118#define CPCAP_NO_BATTERY -400
119
120static struct cpcap_battery_state_data *
121cpcap_battery_get_state(struct cpcap_battery_ddata *ddata,
122 enum cpcap_battery_state state)
123{
124 if (state >= CPCAP_BATTERY_STATE_NR)
125 return NULL;
126
127 return &ddata->state[state];
128}
129
130static struct cpcap_battery_state_data *
131cpcap_battery_latest(struct cpcap_battery_ddata *ddata)
132{
133 return cpcap_battery_get_state(ddata, CPCAP_BATTERY_STATE_LATEST);
134}
135
136static struct cpcap_battery_state_data *
137cpcap_battery_previous(struct cpcap_battery_ddata *ddata)
138{
139 return cpcap_battery_get_state(ddata, CPCAP_BATTERY_STATE_PREVIOUS);
140}
141
142static int cpcap_charger_battery_temperature(struct cpcap_battery_ddata *ddata,
143 int *value)
144{
145 struct iio_channel *channel;
146 int error;
147
148 channel = ddata->channels[CPCAP_BATTERY_IIO_BATTDET];
149 error = iio_read_channel_processed(channel, value);
150 if (error < 0) {
151 dev_warn(ddata->dev, "%s failed: %i\n", __func__, error);
152 *value = CPCAP_NO_BATTERY;
153
154 return error;
155 }
156
157 *value /= 100;
158
159 return 0;
160}
161
162static int cpcap_battery_get_voltage(struct cpcap_battery_ddata *ddata)
163{
164 struct iio_channel *channel;
165 int error, value = 0;
166
167 channel = ddata->channels[CPCAP_BATTERY_IIO_VOLTAGE];
168 error = iio_read_channel_processed(channel, &value);
169 if (error < 0) {
170 dev_warn(ddata->dev, "%s failed: %i\n", __func__, error);
171
172 return 0;
173 }
174
175 return value * 1000;
176}
177
178static int cpcap_battery_get_current(struct cpcap_battery_ddata *ddata)
179{
180 struct iio_channel *channel;
181 int error, value = 0;
182
183 channel = ddata->channels[CPCAP_BATTERY_IIO_BATT_CURRENT];
184 error = iio_read_channel_processed(channel, &value);
185 if (error < 0) {
186 dev_warn(ddata->dev, "%s failed: %i\n", __func__, error);
187
188 return 0;
189 }
190
191 return value * 1000;
192}
193
194/**
195 * cpcap_battery_cc_raw_div - calculate and divide coulomb counter μAms values
196 * @ddata: device driver data
197 * @sample: coulomb counter sample value
198 * @accumulator: coulomb counter integrator value
199 * @offset: coulomb counter offset value
200 * @divider: conversion divider
201 *
202 * Note that cc_lsb and cc_dur values are from Motorola Linux kernel
203 * function data_get_avg_curr_ua() and seem to be based on measured test
204 * results. It also has the following comment:
205 *
206 * Adjustment factors are applied here as a temp solution per the test
207 * results. Need to work out a formal solution for this adjustment.
208 *
209 * A coulomb counter for similar hardware seems to be documented in
210 * "TWL6030 Gas Gauging Basics (Rev. A)" swca095a.pdf in chapter
211 * "10 Calculating Accumulated Current". We however follow what the
212 * Motorola mapphone Linux kernel is doing as there may be either a
213 * TI or ST coulomb counter in the PMIC.
214 */
215static int cpcap_battery_cc_raw_div(struct cpcap_battery_ddata *ddata,
c68b901a 216 s32 sample, s32 accumulator,
874b2adb
TL		 217 s16 offset, u32 divider)
218{
219 s64 acc;
220 u64 tmp;
221 int avg_current;
222 u32 cc_lsb;
223
dbe7208c
TL		 224 if (!divider)
225 return 0;
226
874b2adb
TL		 227 switch (ddata->vendor) {
228 case CPCAP_VENDOR_ST:
229 cc_lsb = 95374; /* μAms per LSB */
230 break;
231 case CPCAP_VENDOR_TI:
232 cc_lsb = 91501; /* μAms per LSB */
233 break;
234 default:
235 return -EINVAL;
236 }
237
238 acc = accumulator;
239 acc = acc - ((s64)sample * offset);
240 cc_lsb = (cc_lsb * ddata->config.cd_factor) / 1000;
241
242 if (acc >= 0)
243 tmp = acc;
244 else
245 tmp = acc * -1;
246
247 tmp = tmp * cc_lsb;
248 do_div(tmp, divider);
249 avg_current = tmp;
250
251 if (acc >= 0)
252 return -avg_current;
253 else
254 return avg_current;
255}
256
257/* 3600000μAms = 1μAh */
258static int cpcap_battery_cc_to_uah(struct cpcap_battery_ddata *ddata,
c68b901a 259 s32 sample, s32 accumulator,
874b2adb
TL		 260 s16 offset)
261{
262 return cpcap_battery_cc_raw_div(ddata, sample,
263 accumulator, offset,
264 3600000);
265}
266
267static int cpcap_battery_cc_to_ua(struct cpcap_battery_ddata *ddata,
c68b901a 268 s32 sample, s32 accumulator,
874b2adb
TL		 269 s16 offset)
270{
271 return cpcap_battery_cc_raw_div(ddata, sample,
272 accumulator, offset,
273 sample *
274 CPCAP_BATTERY_CC_SAMPLE_PERIOD_MS);
275}
276
277/**
278 * cpcap_battery_read_accumulated - reads cpcap coulomb counter
279 * @ddata: device driver data
280 * @regs: coulomb counter values
281 *
282 * Based on Motorola mapphone kernel function data_read_regs().
283 * Looking at the registers, the coulomb counter seems similar to
284 * the coulomb counter in TWL6030. See "TWL6030 Gas Gauging Basics
285 * (Rev. A) swca095a.pdf for "10 Calculating Accumulated Current".
286 *
287 * Note that swca095a.pdf instructs to stop the coulomb counter
288 * before reading to avoid values changing. Motorola mapphone
289 * Linux kernel does not do it, so let's assume they've verified
290 * the data produced is correct.
291 */
292static int
293cpcap_battery_read_accumulated(struct cpcap_battery_ddata *ddata,
294 struct cpcap_coulomb_counter_data *ccd)
295{
296 u16 buf[7]; /* CPCAP_REG_CC1 to CCI */
297 int error;
298
299 ccd->sample = 0;
300 ccd->accumulator = 0;
301 ccd->offset = 0;
302
303 /* Read coulomb counter register range */
304 error = regmap_bulk_read(ddata->reg, CPCAP_REG_CCS1,
305 buf, ARRAY_SIZE(buf));
306 if (error)
307 return 0;
308
309 /* Sample value CPCAP_REG_CCS1 & 2 */
310 ccd->sample = (buf[1] & 0x0fff) << 16;
311 ccd->sample |= buf[0];
c68b901a
TL		 312 if (ddata->vendor == CPCAP_VENDOR_TI)
313 ccd->sample = sign_extend32(24, ccd->sample);
874b2adb
TL		 314
315 /* Accumulator value CPCAP_REG_CCA1 & 2 */
316 ccd->accumulator = ((s16)buf[3]) << 16;
317 ccd->accumulator |= buf[2];
318
35439b7a
TL		 319 /*
320 * Coulomb counter calibration offset is CPCAP_REG_CCM,
321 * REG_CCO seems unused
322 */
323 ccd->offset = buf[4];
324 ccd->offset = sign_extend32(ccd->offset, 9);
874b2adb
TL		 325
326 return cpcap_battery_cc_to_uah(ddata,
327 ccd->sample,
328 ccd->accumulator,
329 ccd->offset);
330}
331
332/**
333 * cpcap_battery_cc_get_avg_current - read cpcap coulumb counter
334 * @ddata: cpcap battery driver device data
335 */
336static int cpcap_battery_cc_get_avg_current(struct cpcap_battery_ddata *ddata)
337{
338 int value, acc, error;
339 s32 sample = 1;
340 s16 offset;
341
342 if (ddata->vendor == CPCAP_VENDOR_ST)
343 sample = 4;
344
345 /* Coulomb counter integrator */
346 error = regmap_read(ddata->reg, CPCAP_REG_CCI, &value);
347 if (error)
348 return error;
349
350 if ((ddata->vendor == CPCAP_VENDOR_TI) && (value > 0x2000))
351 value = value | 0xc000;
352
353 acc = (s16)value;
354
355 /* Coulomb counter sample time */
356 error = regmap_read(ddata->reg, CPCAP_REG_CCM, &value);
357 if (error)
358 return error;
359
360 if (value < 0x200)
361 offset = value;
362 else
363 offset = value | 0xfc00;
364
365 return cpcap_battery_cc_to_ua(ddata, sample, acc, offset);
366}
367
368static bool cpcap_battery_full(struct cpcap_battery_ddata *ddata)
369{
370 struct cpcap_battery_state_data *state = cpcap_battery_latest(ddata);
371
372 /* Basically anything that measures above 4347000 is full */
373 if (state->voltage >= (ddata->config.info.voltage_max_design - 4000))
374 return true;
375
376 return false;
377}
378
379static int cpcap_battery_update_status(struct cpcap_battery_ddata *ddata)
380{
381 struct cpcap_battery_state_data state, *latest, *previous;
382 ktime_t now;
383 int error;
384
385 memset(&state, 0, sizeof(state));
386 now = ktime_get();
387
388 latest = cpcap_battery_latest(ddata);
389 if (latest) {
390 s64 delta_ms = ktime_to_ms(ktime_sub(now, latest->time));
391
392 if (delta_ms < CPCAP_BATTERY_CC_SAMPLE_PERIOD_MS)
393 return delta_ms;
394 }
395
396 state.time = now;
397 state.voltage = cpcap_battery_get_voltage(ddata);
398 state.current_ua = cpcap_battery_get_current(ddata);
399 state.counter_uah = cpcap_battery_read_accumulated(ddata, &state.cc);
400
401 error = cpcap_charger_battery_temperature(ddata,
402 &state.temperature);
403 if (error)
404 return error;
405
406 previous = cpcap_battery_previous(ddata);
407 memcpy(previous, latest, sizeof(*previous));
408 memcpy(latest, &state, sizeof(*latest));
409
410 return 0;
411}
412
413static enum power_supply_property cpcap_battery_props[] = {
414 POWER_SUPPLY_PROP_STATUS,
415 POWER_SUPPLY_PROP_PRESENT,
416 POWER_SUPPLY_PROP_TECHNOLOGY,
417 POWER_SUPPLY_PROP_VOLTAGE_NOW,
418 POWER_SUPPLY_PROP_VOLTAGE_MAX_DESIGN,
419 POWER_SUPPLY_PROP_VOLTAGE_MIN_DESIGN,
420 POWER_SUPPLY_PROP_CURRENT_AVG,
421 POWER_SUPPLY_PROP_CURRENT_NOW,
422 POWER_SUPPLY_PROP_CHARGE_FULL_DESIGN,
423 POWER_SUPPLY_PROP_CHARGE_COUNTER,
424 POWER_SUPPLY_PROP_POWER_NOW,
425 POWER_SUPPLY_PROP_POWER_AVG,
426 POWER_SUPPLY_PROP_CAPACITY_LEVEL,
427 POWER_SUPPLY_PROP_SCOPE,
428 POWER_SUPPLY_PROP_TEMP,
429};
430
431static int cpcap_battery_get_property(struct power_supply *psy,
432 enum power_supply_property psp,
433 union power_supply_propval *val)
434{
435 struct cpcap_battery_ddata *ddata = power_supply_get_drvdata(psy);
436 struct cpcap_battery_state_data *latest, *previous;
437 u32 sample;
438 s32 accumulator;
439 int cached;
440 s64 tmp;
441
442 cached = cpcap_battery_update_status(ddata);
443 if (cached < 0)
444 return cached;
445
446 latest = cpcap_battery_latest(ddata);
447 previous = cpcap_battery_previous(ddata);
448
449 switch (psp) {
450 case POWER_SUPPLY_PROP_PRESENT:
451 if (latest->temperature > CPCAP_NO_BATTERY)
452 val->intval = 1;
453 else
454 val->intval = 0;
455 break;
456 case POWER_SUPPLY_PROP_STATUS:
457 if (cpcap_battery_full(ddata)) {
458 val->intval = POWER_SUPPLY_STATUS_FULL;
459 break;
460 }
461 if (cpcap_battery_cc_get_avg_current(ddata) < 0)
462 val->intval = POWER_SUPPLY_STATUS_CHARGING;
463 else
464 val->intval = POWER_SUPPLY_STATUS_DISCHARGING;
465 break;
466 case POWER_SUPPLY_PROP_TECHNOLOGY:
467 val->intval = ddata->config.info.technology;
468 break;
469 case POWER_SUPPLY_PROP_VOLTAGE_NOW:
470 val->intval = cpcap_battery_get_voltage(ddata);
471 break;
472 case POWER_SUPPLY_PROP_VOLTAGE_MAX_DESIGN:
473 val->intval = ddata->config.info.voltage_max_design;
474 break;
475 case POWER_SUPPLY_PROP_VOLTAGE_MIN_DESIGN:
476 val->intval = ddata->config.info.voltage_min_design;
477 break;
478 case POWER_SUPPLY_PROP_CURRENT_AVG:
5fc27a54
TL		 479 sample = latest->cc.sample - previous->cc.sample;
480 if (!sample) {
874b2adb
TL		 481 val->intval = cpcap_battery_cc_get_avg_current(ddata);
482 break;
483 }
874b2adb
TL		 484 accumulator = latest->cc.accumulator - previous->cc.accumulator;
485 val->intval = cpcap_battery_cc_to_ua(ddata, sample,
486 accumulator,
487 latest->cc.offset);
488 break;
489 case POWER_SUPPLY_PROP_CURRENT_NOW:
490 val->intval = latest->current_ua;
491 break;
492 case POWER_SUPPLY_PROP_CHARGE_COUNTER:
493 val->intval = latest->counter_uah;
494 break;
495 case POWER_SUPPLY_PROP_POWER_NOW:
496 tmp = (latest->voltage / 10000) * latest->current_ua;
497 val->intval = div64_s64(tmp, 100);
498 break;
499 case POWER_SUPPLY_PROP_POWER_AVG:
5fc27a54
TL		 500 sample = latest->cc.sample - previous->cc.sample;
501 if (!sample) {
874b2adb
TL		 502 tmp = cpcap_battery_cc_get_avg_current(ddata);
503 tmp *= (latest->voltage / 10000);
504 val->intval = div64_s64(tmp, 100);
505 break;
506 }
874b2adb
TL		 507 accumulator = latest->cc.accumulator - previous->cc.accumulator;
508 tmp = cpcap_battery_cc_to_ua(ddata, sample, accumulator,
509 latest->cc.offset);
510 tmp *= ((latest->voltage + previous->voltage) / 20000);
511 val->intval = div64_s64(tmp, 100);
512 break;
513 case POWER_SUPPLY_PROP_CAPACITY_LEVEL:
514 if (cpcap_battery_full(ddata))
515 val->intval = POWER_SUPPLY_CAPACITY_LEVEL_FULL;
516 else if (latest->voltage >= 3750000)
517 val->intval = POWER_SUPPLY_CAPACITY_LEVEL_HIGH;
518 else if (latest->voltage >= 3300000)
519 val->intval = POWER_SUPPLY_CAPACITY_LEVEL_NORMAL;
520 else if (latest->voltage > 3100000)
521 val->intval = POWER_SUPPLY_CAPACITY_LEVEL_LOW;
522 else if (latest->voltage <= 3100000)
523 val->intval = POWER_SUPPLY_CAPACITY_LEVEL_CRITICAL;
524 else
525 val->intval = POWER_SUPPLY_CAPACITY_LEVEL_UNKNOWN;
526 break;
527 case POWER_SUPPLY_PROP_CHARGE_FULL_DESIGN:
528 val->intval = ddata->config.info.charge_full_design;
529 break;
530 case POWER_SUPPLY_PROP_SCOPE:
531 val->intval = POWER_SUPPLY_SCOPE_SYSTEM;
532 break;
533 case POWER_SUPPLY_PROP_TEMP:
534 val->intval = latest->temperature;
535 break;
536 default:
537 return -EINVAL;
538 }
539
540 return 0;
541}
542
543static irqreturn_t cpcap_battery_irq_thread(int irq, void *data)
544{
545 struct cpcap_battery_ddata *ddata = data;
546 struct cpcap_battery_state_data *latest;
547 struct cpcap_interrupt_desc *d;
548
549 if (!atomic_read(&ddata->active))
550 return IRQ_NONE;
551
552 list_for_each_entry(d, &ddata->irq_list, node) {
553 if (irq == d->irq)
554 break;
555 }
556
557 if (!d)
558 return IRQ_NONE;
559
560 latest = cpcap_battery_latest(ddata);
561
562 switch (d->action) {
563 case CPCAP_BATTERY_IRQ_ACTION_BATTERY_LOW:
1a9aadc8 564 if (latest->current_ua >= 0)
874b2adb
TL		 565 dev_warn(ddata->dev, "Battery low at 3.3V!\n");
566 break;
567 case CPCAP_BATTERY_IRQ_ACTION_POWEROFF:
1a9aadc8 568 if (latest->current_ua >= 0) {
874b2adb
TL		 569 dev_emerg(ddata->dev,
570 "Battery empty at 3.1V, powering off\n");
571 orderly_poweroff(true);
572 }
573 break;
574 default:
575 break;
576 }
577
578 power_supply_changed(ddata->psy);
579
580 return IRQ_HANDLED;
581}
582
583static int cpcap_battery_init_irq(struct platform_device *pdev,
584 struct cpcap_battery_ddata *ddata,
585 const char *name)
586{
587 struct cpcap_interrupt_desc *d;
588 int irq, error;
589
590 irq = platform_get_irq_byname(pdev, name);
aac79904
AY		 591 if (irq < 0)
592 return irq;
874b2adb
TL		 593
594 error = devm_request_threaded_irq(ddata->dev, irq, NULL,
595 cpcap_battery_irq_thread,
596 IRQF_SHARED,
597 name, ddata);
598 if (error) {
599 dev_err(ddata->dev, "could not get irq %s: %i\n",
600 name, error);
601
602 return error;
603 }
604
605 d = devm_kzalloc(ddata->dev, sizeof(*d), GFP_KERNEL);
606 if (!d)
607 return -ENOMEM;
608
609 d->name = name;
610 d->irq = irq;
611
612 if (!strncmp(name, "lowbph", 6))
613 d->action = CPCAP_BATTERY_IRQ_ACTION_BATTERY_LOW;
614 else if (!strncmp(name, "lowbpl", 6))
615 d->action = CPCAP_BATTERY_IRQ_ACTION_POWEROFF;
616
617 list_add(&d->node, &ddata->irq_list);
618
619 return 0;
620}
621
622static int cpcap_battery_init_interrupts(struct platform_device *pdev,
623 struct cpcap_battery_ddata *ddata)
624{
bd82ef08 625 static const char * const cpcap_battery_irqs[] = {
874b2adb
TL		 626 "eol", "lowbph", "lowbpl",
627 "chrgcurr1", "battdetb"
628 };
629 int i, error;
630
631 for (i = 0; i < ARRAY_SIZE(cpcap_battery_irqs); i++) {
632 error = cpcap_battery_init_irq(pdev, ddata,
633 cpcap_battery_irqs[i]);
634 if (error)
635 return error;
636 }
637
638 /* Enable low battery interrupts for 3.3V high and 3.1V low */
639 error = regmap_update_bits(ddata->reg, CPCAP_REG_BPEOL,
640 0xffff,
641 CPCAP_REG_BPEOL_BIT_BATTDETEN);
642 if (error)
643 return error;
644
645 return 0;
646}
647
648static int cpcap_battery_init_iio(struct cpcap_battery_ddata *ddata)
649{
650 const char * const names[CPCAP_BATTERY_IIO_NR] = {
651 "battdetb", "battp", "chg_isense", "batti",
652 };
653 int error, i;
654
655 for (i = 0; i < CPCAP_BATTERY_IIO_NR; i++) {
656 ddata->channels[i] = devm_iio_channel_get(ddata->dev,
657 names[i]);
658 if (IS_ERR(ddata->channels[i])) {
659 error = PTR_ERR(ddata->channels[i]);
660 goto out_err;
661 }
662
663 if (!ddata->channels[i]->indio_dev) {
664 error = -ENXIO;
665 goto out_err;
666 }
667 }
668
669 return 0;
670
671out_err:
ffaf6f67
TL		 672 if (error != -EPROBE_DEFER)
673 dev_err(ddata->dev, "could not initialize VBUS or ID IIO: %i\n",
674 error);
874b2adb
TL		 675
676 return error;
677}
678
679/*
680 * Based on the values from Motorola mapphone Linux kernel. In the
681 * the Motorola mapphone Linux kernel tree the value for pm_cd_factor
682 * is passed to the kernel via device tree. If it turns out to be
683 * something device specific we can consider that too later.
684 *
685 * And looking at the battery full and shutdown values for the stock
686 * kernel on droid 4, full is 4351000 and software initiates shutdown
687 * at 3078000. The device will die around 2743000.
688 */
689static const struct cpcap_battery_config cpcap_battery_default_data = {
690 .ccm = 0x3ff,
691 .cd_factor = 0x3cc,
692 .info.technology = POWER_SUPPLY_TECHNOLOGY_LION,
693 .info.voltage_max_design = 4351000,
694 .info.voltage_min_design = 3100000,
695 .info.charge_full_design = 1740000,
696};
697
698#ifdef CONFIG_OF
699static const struct of_device_id cpcap_battery_id_table[] = {
700 {
701 .compatible = "motorola,cpcap-battery",
702 .data = &cpcap_battery_default_data,
703 },
704 {},
705};
706MODULE_DEVICE_TABLE(of, cpcap_battery_id_table);
707#endif
708
709static int cpcap_battery_probe(struct platform_device *pdev)
710{
711 struct power_supply_desc *psy_desc;
712 struct cpcap_battery_ddata *ddata;
713 const struct of_device_id *match;
714 struct power_supply_config psy_cfg = {};
715 int error;
716
717 match = of_match_device(of_match_ptr(cpcap_battery_id_table),
718 &pdev->dev);
719 if (!match)
720 return -EINVAL;
721
722 if (!match->data) {
723 dev_err(&pdev->dev, "no configuration data found\n");
724
725 return -ENODEV;
726 }
727
728 ddata = devm_kzalloc(&pdev->dev, sizeof(*ddata), GFP_KERNEL);
729 if (!ddata)
730 return -ENOMEM;
731
732 INIT_LIST_HEAD(&ddata->irq_list);
733 ddata->dev = &pdev->dev;
734 memcpy(&ddata->config, match->data, sizeof(ddata->config));
735
736 ddata->reg = dev_get_regmap(ddata->dev->parent, NULL);
737 if (!ddata->reg)
738 return -ENODEV;
739
740 error = cpcap_get_vendor(ddata->dev, ddata->reg, &ddata->vendor);
741 if (error)
742 return error;
743
744 platform_set_drvdata(pdev, ddata);
745
746 error = regmap_update_bits(ddata->reg, CPCAP_REG_CCM,
747 0xffff, ddata->config.ccm);
748 if (error)
749 return error;
750
751 error = cpcap_battery_init_interrupts(pdev, ddata);
752 if (error)
753 return error;
754
755 error = cpcap_battery_init_iio(ddata);
756 if (error)
757 return error;
758
759 psy_desc = devm_kzalloc(ddata->dev, sizeof(*psy_desc), GFP_KERNEL);
760 if (!psy_desc)
761 return -ENOMEM;
762
763 psy_desc->name = "battery",
764 psy_desc->type = POWER_SUPPLY_TYPE_BATTERY,
765 psy_desc->properties = cpcap_battery_props,
766 psy_desc->num_properties = ARRAY_SIZE(cpcap_battery_props),
767 psy_desc->get_property = cpcap_battery_get_property,
768
769 psy_cfg.of_node = pdev->dev.of_node;
770 psy_cfg.drv_data = ddata;
771
772 ddata->psy = devm_power_supply_register(ddata->dev, psy_desc,
773 &psy_cfg);
774 error = PTR_ERR_OR_ZERO(ddata->psy);
775 if (error) {
776 dev_err(ddata->dev, "failed to register power supply\n");
777 return error;
778 }
779
780 atomic_set(&ddata->active, 1);
781
782 return 0;
783}
784
785static int cpcap_battery_remove(struct platform_device *pdev)
786{
787 struct cpcap_battery_ddata *ddata = platform_get_drvdata(pdev);
788 int error;
789
790 atomic_set(&ddata->active, 0);
791 error = regmap_update_bits(ddata->reg, CPCAP_REG_BPEOL,
792 0xffff, 0);
793 if (error)
794 dev_err(&pdev->dev, "could not disable: %i\n", error);
795
796 return 0;
797}
798
799static struct platform_driver cpcap_battery_driver = {
800 .driver = {
801 .name = "cpcap_battery",
802 .of_match_table = of_match_ptr(cpcap_battery_id_table),
803 },
804 .probe = cpcap_battery_probe,
805 .remove = cpcap_battery_remove,
806};
807module_platform_driver(cpcap_battery_driver);
808
809MODULE_LICENSE("GPL v2");
810MODULE_AUTHOR("Tony Lindgren <tony@atomide.com>");
811MODULE_DESCRIPTION("CPCAP PMIC Battery Driver");
Ubuntu Hirsute Linux kernel mirror