?  search:
summary | log | graphiclog1 | graphiclog2 | commit | commitdiff | tree | refs | edit | fork
blame | history | raw | HEAD
dm writecache: add cond_resched to loop in persistent_memory_claim()
[linux/fpc-iii.git] / drivers / power / supply / 88pm860x_battery.c
blob5ca047b3f58fbdeb7040cacaa4e678c9f4d88065
1 // SPDX-License-Identifier: GPL-2.0-only
2 /*
3 * Battery driver for Marvell 88PM860x PMIC
4 *
5 * Copyright (c) 2012 Marvell International Ltd.
6 * Author: Jett Zhou <jtzhou@marvell.com>
7 * Haojian Zhuang <haojian.zhuang@marvell.com>
8 */
9
10 #include <linux/kernel.h>
11 #include <linux/module.h>
12 #include <linux/platform_device.h>
13 #include <linux/slab.h>
14 #include <linux/mutex.h>
15 #include <linux/string.h>
16 #include <linux/power_supply.h>
17 #include <linux/mfd/88pm860x.h>
18 #include <linux/delay.h>
19
20 /* bit definitions of Status Query Interface 2 */
21 #define STATUS2_CHG (1 << 2)
22 #define STATUS2_BAT (1 << 3)
23 #define STATUS2_VBUS (1 << 4)
24
25 /* bit definitions of Measurement Enable 1 Register */
26 #define MEAS1_TINT (1 << 3)
27 #define MEAS1_GP1 (1 << 5)
28
29 /* bit definitions of Measurement Enable 3 Register */
30 #define MEAS3_IBAT (1 << 0)
31 #define MEAS3_BAT_DET (1 << 1)
32 #define MEAS3_CC (1 << 2)
33
34 /* bit definitions of Measurement Off Time Register */
35 #define MEAS_OFF_SLEEP_EN (1 << 1)
36
37 /* bit definitions of GPADC Bias Current 2 Register */
38 #define GPBIAS2_GPADC1_SET (2 << 4)
39 /* GPADC1 Bias Current value in uA unit */
40 #define GPBIAS2_GPADC1_UA ((GPBIAS2_GPADC1_SET >> 4) * 5 + 1)
41
42 /* bit definitions of GPADC Misc 1 Register */
43 #define GPMISC1_GPADC_EN (1 << 0)
44
45 /* bit definitions of Charger Control 6 Register */
46 #define CC6_BAT_DET_GPADC1 1
47
48 /* bit definitions of Coulomb Counter Reading Register */
49 #define CCNT_AVG_SEL (4 << 3)
50
51 /* bit definitions of RTC miscellaneous Register1 */
52 #define RTC_SOC_5LSB (0x1F << 3)
53
54 /* bit definitions of RTC Register1 */
55 #define RTC_SOC_3MSB (0x7)
56
57 /* bit definitions of Power up Log register */
58 #define BAT_WU_LOG (1<<6)
59
60 /* coulomb counter index */
61 #define CCNT_POS1 0
62 #define CCNT_POS2 1
63 #define CCNT_NEG1 2
64 #define CCNT_NEG2 3
65 #define CCNT_SPOS 4
66 #define CCNT_SNEG 5
67
68 /* OCV -- Open Circuit Voltage */
69 #define OCV_MODE_ACTIVE 0
70 #define OCV_MODE_SLEEP 1
71
72 /* Vbat range of CC for measuring Rbat */
73 #define LOW_BAT_THRESHOLD 3600
74 #define VBATT_RESISTOR_MIN 3800
75 #define VBATT_RESISTOR_MAX 4100
76
77 /* TBAT for batt, TINT for chip itself */
78 #define PM860X_TEMP_TINT (0)
79 #define PM860X_TEMP_TBAT (1)
80
81 /*
82 * Battery temperature based on NTC resistor, defined
83 * corresponding resistor value -- Ohm / C degeree.
84 */
85 #define TBAT_NEG_25D 127773 /* -25 */
86 #define TBAT_NEG_10D 54564 /* -10 */
87 #define TBAT_0D 32330 /* 0 */
88 #define TBAT_10D 19785 /* 10 */
89 #define TBAT_20D 12468 /* 20 */
90 #define TBAT_30D 8072 /* 30 */
91 #define TBAT_40D 5356 /* 40 */
92
93 struct pm860x_battery_info {
94 struct pm860x_chip *chip;
95 struct i2c_client *i2c;
96 struct device *dev;
97
98 struct power_supply *battery;
99 struct mutex lock;
100 int status;
101 int irq_cc;
102 int irq_batt;
103 int max_capacity;
104 int resistor; /* Battery Internal Resistor */
105 int last_capacity;
106 int start_soc;
107 unsigned present:1;
108 unsigned temp_type:1; /* TINT or TBAT */
109 };
110
111 struct ccnt {
112 unsigned long long int pos;
113 unsigned long long int neg;
114 unsigned int spos;
115 unsigned int sneg;
116
117 int total_chg; /* mAh(3.6C) */
118 int total_dischg; /* mAh(3.6C) */
119 };
120
121 /*
122 * State of Charge.
123 * The first number is mAh(=3.6C), and the second number is percent point.
124 */
125 static int array_soc[][2] = {
126 {4170, 100}, {4154, 99}, {4136, 98}, {4122, 97}, {4107, 96},
127 {4102, 95}, {4088, 94}, {4081, 93}, {4070, 92}, {4060, 91},
128 {4053, 90}, {4044, 89}, {4035, 88}, {4028, 87}, {4019, 86},
129 {4013, 85}, {4006, 84}, {3995, 83}, {3987, 82}, {3982, 81},
130 {3976, 80}, {3968, 79}, {3962, 78}, {3954, 77}, {3946, 76},
131 {3941, 75}, {3934, 74}, {3929, 73}, {3922, 72}, {3916, 71},
132 {3910, 70}, {3904, 69}, {3898, 68}, {3892, 67}, {3887, 66},
133 {3880, 65}, {3874, 64}, {3868, 63}, {3862, 62}, {3854, 61},
134 {3849, 60}, {3843, 59}, {3840, 58}, {3833, 57}, {3829, 56},
135 {3824, 55}, {3818, 54}, {3815, 53}, {3810, 52}, {3808, 51},
136 {3804, 50}, {3801, 49}, {3798, 48}, {3796, 47}, {3792, 46},
137 {3789, 45}, {3785, 44}, {3784, 43}, {3782, 42}, {3780, 41},
138 {3777, 40}, {3776, 39}, {3774, 38}, {3772, 37}, {3771, 36},
139 {3769, 35}, {3768, 34}, {3764, 33}, {3763, 32}, {3760, 31},
140 {3760, 30}, {3754, 29}, {3750, 28}, {3749, 27}, {3744, 26},
141 {3740, 25}, {3734, 24}, {3732, 23}, {3728, 22}, {3726, 21},
142 {3720, 20}, {3716, 19}, {3709, 18}, {3703, 17}, {3698, 16},
143 {3692, 15}, {3683, 14}, {3675, 13}, {3670, 12}, {3665, 11},
144 {3661, 10}, {3649, 9}, {3637, 8}, {3622, 7}, {3609, 6},
145 {3580, 5}, {3558, 4}, {3540, 3}, {3510, 2}, {3429, 1},
146 };
147
148 static struct ccnt ccnt_data;
149
150 /*
151 * register 1 bit[7:0] -- bit[11:4] of measured value of voltage
152 * register 0 bit[3:0] -- bit[3:0] of measured value of voltage
153 */
154 static int measure_12bit_voltage(struct pm860x_battery_info *info,
155 int offset, int *data)
156 {
157 unsigned char buf[2];
158 int ret;
159
160 ret = pm860x_bulk_read(info->i2c, offset, 2, buf);
161 if (ret < 0)
162 return ret;
163
164 *data = ((buf[0] & 0xff) << 4) | (buf[1] & 0x0f);
165 /* V_MEAS(mV) = data * 1.8 * 1000 / (2^12) */
166 *data = ((*data & 0xfff) * 9 * 25) >> 9;
167 return 0;
168 }
169
170 static int measure_vbatt(struct pm860x_battery_info *info, int state,
171 int *data)
172 {
173 unsigned char buf[5];
174 int ret;
175
176 switch (state) {
177 case OCV_MODE_ACTIVE:
178 ret = measure_12bit_voltage(info, PM8607_VBAT_MEAS1, data);
179 if (ret)
180 return ret;
181 /* V_BATT_MEAS(mV) = value * 3 * 1.8 * 1000 / (2^12) */
182 *data *= 3;
183 break;
184 case OCV_MODE_SLEEP:
185 /*
186 * voltage value of VBATT in sleep mode is saved in different
187 * registers.
188 * bit[11:10] -- bit[7:6] of LDO9(0x18)
189 * bit[9:8] -- bit[7:6] of LDO8(0x17)
190 * bit[7:6] -- bit[7:6] of LDO7(0x16)
191 * bit[5:4] -- bit[7:6] of LDO6(0x15)
192 * bit[3:0] -- bit[7:4] of LDO5(0x14)
193 */
194 ret = pm860x_bulk_read(info->i2c, PM8607_LDO5, 5, buf);
195 if (ret < 0)
196 return ret;
197 ret = ((buf[4] >> 6) << 10) | ((buf[3] >> 6) << 8)
198 | ((buf[2] >> 6) << 6) | ((buf[1] >> 6) << 4)
199 | (buf[0] >> 4);
200 /* V_BATT_MEAS(mV) = data * 3 * 1.8 * 1000 / (2^12) */
201 *data = ((*data & 0xff) * 27 * 25) >> 9;
202 break;
203 default:
204 return -EINVAL;
205 }
206 return 0;
207 }
208
209 /*
210 * Return value is signed data.
211 * Negative value means discharging, and positive value means charging.
212 */
213 static int measure_current(struct pm860x_battery_info *info, int *data)
214 {
215 unsigned char buf[2];
216 short s;
217 int ret;
218
219 ret = pm860x_bulk_read(info->i2c, PM8607_IBAT_MEAS1, 2, buf);
220 if (ret < 0)
221 return ret;
222
223 s = ((buf[0] & 0xff) << 8) | (buf[1] & 0xff);
224 /* current(mA) = value * 0.125 */
225 *data = s >> 3;
226 return 0;
227 }
228
229 static int set_charger_current(struct pm860x_battery_info *info, int data,
230 int *old)
231 {
232 int ret;
233
234 if (data < 50 || data > 1600 || !old)
235 return -EINVAL;
236
237 data = ((data - 50) / 50) & 0x1f;
238 *old = pm860x_reg_read(info->i2c, PM8607_CHG_CTRL2);
239 *old = (*old & 0x1f) * 50 + 50;
240 ret = pm860x_set_bits(info->i2c, PM8607_CHG_CTRL2, 0x1f, data);
241 if (ret < 0)
242 return ret;
243 return 0;
244 }
245
246 static int read_ccnt(struct pm860x_battery_info *info, int offset,
247 int *ccnt)
248 {
249 unsigned char buf[2];
250 int ret;
251
252 ret = pm860x_set_bits(info->i2c, PM8607_CCNT, 7, offset & 7);
253 if (ret < 0)
254 goto out;
255 ret = pm860x_bulk_read(info->i2c, PM8607_CCNT_MEAS1, 2, buf);
256 if (ret < 0)
257 goto out;
258 *ccnt = ((buf[0] & 0xff) << 8) | (buf[1] & 0xff);
259 return 0;
260 out:
261 return ret;
262 }
263
264 static int calc_ccnt(struct pm860x_battery_info *info, struct ccnt *ccnt)
265 {
266 unsigned int sum;
267 int ret;
268 int data;
269
270 ret = read_ccnt(info, CCNT_POS1, &data);
271 if (ret)
272 goto out;
273 sum = data & 0xffff;
274 ret = read_ccnt(info, CCNT_POS2, &data);
275 if (ret)
276 goto out;
277 sum |= (data & 0xffff) << 16;
278 ccnt->pos += sum;
279
280 ret = read_ccnt(info, CCNT_NEG1, &data);
281 if (ret)
282 goto out;
283 sum = data & 0xffff;
284 ret = read_ccnt(info, CCNT_NEG2, &data);
285 if (ret)
286 goto out;
287 sum |= (data & 0xffff) << 16;
288 sum = ~sum + 1; /* since it's negative */
289 ccnt->neg += sum;
290
291 ret = read_ccnt(info, CCNT_SPOS, &data);
292 if (ret)
293 goto out;
294 ccnt->spos += data;
295 ret = read_ccnt(info, CCNT_SNEG, &data);
296 if (ret)
297 goto out;
298
299 /*
300 * charge(mAh) = count * 1.6984 * 1e(-8)
301 * = count * 16984 * 1.024 * 1.024 * 1.024 / (2 ^ 40)
302 * = count * 18236 / (2 ^ 40)
303 */
304 ccnt->total_chg = (int) ((ccnt->pos * 18236) >> 40);
305 ccnt->total_dischg = (int) ((ccnt->neg * 18236) >> 40);
306 return 0;
307 out:
308 return ret;
309 }
310
311 static int clear_ccnt(struct pm860x_battery_info *info, struct ccnt *ccnt)
312 {
313 int data;
314
315 memset(ccnt, 0, sizeof(*ccnt));
316 /* read to clear ccnt */
317 read_ccnt(info, CCNT_POS1, &data);
318 read_ccnt(info, CCNT_POS2, &data);
319 read_ccnt(info, CCNT_NEG1, &data);
320 read_ccnt(info, CCNT_NEG2, &data);
321 read_ccnt(info, CCNT_SPOS, &data);
322 read_ccnt(info, CCNT_SNEG, &data);
323 return 0;
324 }
325
326 /* Calculate Open Circuit Voltage */
327 static int calc_ocv(struct pm860x_battery_info *info, int *ocv)
328 {
329 int ret;
330 int i;
331 int data;
332 int vbatt_avg;
333 int vbatt_sum;
334 int ibatt_avg;
335 int ibatt_sum;
336
337 if (!ocv)
338 return -EINVAL;
339
340 for (i = 0, ibatt_sum = 0, vbatt_sum = 0; i < 10; i++) {
341 ret = measure_vbatt(info, OCV_MODE_ACTIVE, &data);
342 if (ret)
343 goto out;
344 vbatt_sum += data;
345 ret = measure_current(info, &data);
346 if (ret)
347 goto out;
348 ibatt_sum += data;
349 }
350 vbatt_avg = vbatt_sum / 10;
351 ibatt_avg = ibatt_sum / 10;
352
353 mutex_lock(&info->lock);
354 if (info->present)
355 *ocv = vbatt_avg - ibatt_avg * info->resistor / 1000;
356 else
357 *ocv = vbatt_avg;
358 mutex_unlock(&info->lock);
359 dev_dbg(info->dev, "VBAT average:%d, OCV:%d\n", vbatt_avg, *ocv);
360 return 0;
361 out:
362 return ret;
363 }
364
365 /* Calculate State of Charge (percent points) */
366 static int calc_soc(struct pm860x_battery_info *info, int state, int *soc)
367 {
368 int i;
369 int ocv;
370 int count;
371 int ret = -EINVAL;
372
373 if (!soc)
374 return -EINVAL;
375
376 switch (state) {
377 case OCV_MODE_ACTIVE:
378 ret = calc_ocv(info, &ocv);
379 break;
380 case OCV_MODE_SLEEP:
381 ret = measure_vbatt(info, OCV_MODE_SLEEP, &ocv);
382 break;
383 }
384 if (ret)
385 return ret;
386
387 count = ARRAY_SIZE(array_soc);
388 if (ocv < array_soc[count - 1][0]) {
389 *soc = 0;
390 return 0;
391 }
392
393 for (i = 0; i < count; i++) {
394 if (ocv >= array_soc[i][0]) {
395 *soc = array_soc[i][1];
396 break;
397 }
398 }
399 return 0;
400 }
401
402 static irqreturn_t pm860x_coulomb_handler(int irq, void *data)
403 {
404 struct pm860x_battery_info *info = data;
405
406 calc_ccnt(info, &ccnt_data);
407 return IRQ_HANDLED;
408 }
409
410 static irqreturn_t pm860x_batt_handler(int irq, void *data)
411 {
412 struct pm860x_battery_info *info = data;
413 int ret;
414
415 mutex_lock(&info->lock);
416 ret = pm860x_reg_read(info->i2c, PM8607_STATUS_2);
417 if (ret & STATUS2_BAT) {
418 info->present = 1;
419 info->temp_type = PM860X_TEMP_TBAT;
420 } else {
421 info->present = 0;
422 info->temp_type = PM860X_TEMP_TINT;
423 }
424 mutex_unlock(&info->lock);
425 /* clear ccnt since battery is attached or dettached */
426 clear_ccnt(info, &ccnt_data);
427 return IRQ_HANDLED;
428 }
429
430 static void pm860x_init_battery(struct pm860x_battery_info *info)
431 {
432 unsigned char buf[2];
433 int ret;
434 int data;
435 int bat_remove;
436 int soc;
437
438 /* measure enable on GPADC1 */
439 data = MEAS1_GP1;
440 if (info->temp_type == PM860X_TEMP_TINT)
441 data |= MEAS1_TINT;
442 ret = pm860x_set_bits(info->i2c, PM8607_MEAS_EN1, data, data);
443 if (ret)
444 goto out;
445
446 /* measure enable on IBAT, BAT_DET, CC. IBAT is depend on CC. */
447 data = MEAS3_IBAT | MEAS3_BAT_DET | MEAS3_CC;
448 ret = pm860x_set_bits(info->i2c, PM8607_MEAS_EN3, data, data);
449 if (ret)
450 goto out;
451
452 /* measure disable CC in sleep time */
453 ret = pm860x_reg_write(info->i2c, PM8607_MEAS_OFF_TIME1, 0x82);
454 if (ret)
455 goto out;
456 ret = pm860x_reg_write(info->i2c, PM8607_MEAS_OFF_TIME2, 0x6c);
457 if (ret)
458 goto out;
459
460 /* enable GPADC */
461 ret = pm860x_set_bits(info->i2c, PM8607_GPADC_MISC1,
462 GPMISC1_GPADC_EN, GPMISC1_GPADC_EN);
463 if (ret < 0)
464 goto out;
465
466 /* detect battery via GPADC1 */
467 ret = pm860x_set_bits(info->i2c, PM8607_CHG_CTRL6,
468 CC6_BAT_DET_GPADC1, CC6_BAT_DET_GPADC1);
469 if (ret < 0)
470 goto out;
471
472 ret = pm860x_set_bits(info->i2c, PM8607_CCNT, 7 << 3,
473 CCNT_AVG_SEL);
474 if (ret < 0)
475 goto out;
476
477 /* set GPADC1 bias */
478 ret = pm860x_set_bits(info->i2c, PM8607_GP_BIAS2, 0xF << 4,
479 GPBIAS2_GPADC1_SET);
480 if (ret < 0)
481 goto out;
482
483 /* check whether battery present) */
484 mutex_lock(&info->lock);
485 ret = pm860x_reg_read(info->i2c, PM8607_STATUS_2);
486 if (ret < 0) {
487 mutex_unlock(&info->lock);
488 goto out;
489 }
490 if (ret & STATUS2_BAT) {
491 info->present = 1;
492 info->temp_type = PM860X_TEMP_TBAT;
493 } else {
494 info->present = 0;
495 info->temp_type = PM860X_TEMP_TINT;
496 }
497 mutex_unlock(&info->lock);
498
499 calc_soc(info, OCV_MODE_ACTIVE, &soc);
500
501 data = pm860x_reg_read(info->i2c, PM8607_POWER_UP_LOG);
502 bat_remove = data & BAT_WU_LOG;
503
504 dev_dbg(info->dev, "battery wake up? %s\n",
505 bat_remove != 0 ? "yes" : "no");
506
507 /* restore SOC from RTC domain register */
508 if (bat_remove == 0) {
509 buf[0] = pm860x_reg_read(info->i2c, PM8607_RTC_MISC2);
510 buf[1] = pm860x_reg_read(info->i2c, PM8607_RTC1);
511 data = ((buf[1] & 0x3) << 5) | ((buf[0] >> 3) & 0x1F);
512 if (data > soc + 15)
513 info->start_soc = soc;
514 else if (data < soc - 15)
515 info->start_soc = soc;
516 else
517 info->start_soc = data;
518 dev_dbg(info->dev, "soc_rtc %d, soc_ocv :%d\n", data, soc);
519 } else {
520 pm860x_set_bits(info->i2c, PM8607_POWER_UP_LOG,
521 BAT_WU_LOG, BAT_WU_LOG);
522 info->start_soc = soc;
523 }
524 info->last_capacity = info->start_soc;
525 dev_dbg(info->dev, "init soc : %d\n", info->last_capacity);
526 out:
527 return;
528 }
529
530 static void set_temp_threshold(struct pm860x_battery_info *info,
531 int min, int max)
532 {
533 int data;
534
535 /* (tmp << 8) / 1800 */
536 if (min <= 0)
537 data = 0;
538 else
539 data = (min << 8) / 1800;
540 pm860x_reg_write(info->i2c, PM8607_GPADC1_HIGHTH, data);
541 dev_dbg(info->dev, "TEMP_HIGHTH : min: %d, 0x%x\n", min, data);
542
543 if (max <= 0)
544 data = 0xff;
545 else
546 data = (max << 8) / 1800;
547 pm860x_reg_write(info->i2c, PM8607_GPADC1_LOWTH, data);
548 dev_dbg(info->dev, "TEMP_LOWTH:max : %d, 0x%x\n", max, data);
549 }
550
551 static int measure_temp(struct pm860x_battery_info *info, int *data)
552 {
553 int ret;
554 int temp;
555 int min;
556 int max;
557
558 if (info->temp_type == PM860X_TEMP_TINT) {
559 ret = measure_12bit_voltage(info, PM8607_TINT_MEAS1, data);
560 if (ret)
561 return ret;
562 *data = (*data - 884) * 1000 / 3611;
563 } else {
564 ret = measure_12bit_voltage(info, PM8607_GPADC1_MEAS1, data);
565 if (ret)
566 return ret;
567 /* meausered Vtbat(mV) / Ibias_current(11uA)*/
568 *data = (*data * 1000) / GPBIAS2_GPADC1_UA;
569
570 if (*data > TBAT_NEG_25D) {
571 temp = -30; /* over cold , suppose -30 roughly */
572 max = TBAT_NEG_10D * GPBIAS2_GPADC1_UA / 1000;
573 set_temp_threshold(info, 0, max);
574 } else if (*data > TBAT_NEG_10D) {
575 temp = -15; /* -15 degree, code */
576 max = TBAT_NEG_10D * GPBIAS2_GPADC1_UA / 1000;
577 set_temp_threshold(info, 0, max);
578 } else if (*data > TBAT_0D) {
579 temp = -5; /* -5 degree */
580 min = TBAT_NEG_10D * GPBIAS2_GPADC1_UA / 1000;
581 max = TBAT_40D * GPBIAS2_GPADC1_UA / 1000;
582 set_temp_threshold(info, min, max);
583 } else if (*data > TBAT_10D) {
584 temp = 5; /* in range of (0, 10) */
585 min = TBAT_NEG_10D * GPBIAS2_GPADC1_UA / 1000;
586 max = TBAT_40D * GPBIAS2_GPADC1_UA / 1000;
587 set_temp_threshold(info, min, max);
588 } else if (*data > TBAT_20D) {
589 temp = 15; /* in range of (10, 20) */
590 min = TBAT_NEG_10D * GPBIAS2_GPADC1_UA / 1000;
591 max = TBAT_40D * GPBIAS2_GPADC1_UA / 1000;
592 set_temp_threshold(info, min, max);
593 } else if (*data > TBAT_30D) {
594 temp = 25; /* in range of (20, 30) */
595 min = TBAT_NEG_10D * GPBIAS2_GPADC1_UA / 1000;
596 max = TBAT_40D * GPBIAS2_GPADC1_UA / 1000;
597 set_temp_threshold(info, min, max);
598 } else if (*data > TBAT_40D) {
599 temp = 35; /* in range of (30, 40) */
600 min = TBAT_NEG_10D * GPBIAS2_GPADC1_UA / 1000;
601 max = TBAT_40D * GPBIAS2_GPADC1_UA / 1000;
602 set_temp_threshold(info, min, max);
603 } else {
604 min = TBAT_40D * GPBIAS2_GPADC1_UA / 1000;
605 set_temp_threshold(info, min, 0);
606 temp = 45; /* over heat ,suppose 45 roughly */
607 }
608
609 dev_dbg(info->dev, "temp_C:%d C,temp_mv:%d mv\n", temp, *data);
610 *data = temp;
611 }
612 return 0;
613 }
614
615 static int calc_resistor(struct pm860x_battery_info *info)
616 {
617 int vbatt_sum1;
618 int vbatt_sum2;
619 int chg_current;
620 int ibatt_sum1;
621 int ibatt_sum2;
622 int data;
623 int ret;
624 int i;
625
626 ret = measure_current(info, &data);
627 /* make sure that charging is launched by data > 0 */
628 if (ret || data < 0)
629 goto out;
630
631 ret = measure_vbatt(info, OCV_MODE_ACTIVE, &data);
632 if (ret)
633 goto out;
634 /* calculate resistor only in CC charge mode */
635 if (data < VBATT_RESISTOR_MIN || data > VBATT_RESISTOR_MAX)
636 goto out;
637
638 /* current is saved */
639 if (set_charger_current(info, 500, &chg_current))
640 goto out;
641
642 /*
643 * set charge current as 500mA, wait about 500ms till charging
644 * process is launched and stable with the newer charging current.
645 */
646 msleep(500);
647
648 for (i = 0, vbatt_sum1 = 0, ibatt_sum1 = 0; i < 10; i++) {
649 ret = measure_vbatt(info, OCV_MODE_ACTIVE, &data);
650 if (ret)
651 goto out_meas;
652 vbatt_sum1 += data;
653 ret = measure_current(info, &data);
654 if (ret)
655 goto out_meas;
656
657 if (data < 0)
658 ibatt_sum1 = ibatt_sum1 - data; /* discharging */
659 else
660 ibatt_sum1 = ibatt_sum1 + data; /* charging */
661 }
662
663 if (set_charger_current(info, 100, &ret))
664 goto out_meas;
665 /*
666 * set charge current as 100mA, wait about 500ms till charging
667 * process is launched and stable with the newer charging current.
668 */
669 msleep(500);
670
671 for (i = 0, vbatt_sum2 = 0, ibatt_sum2 = 0; i < 10; i++) {
672 ret = measure_vbatt(info, OCV_MODE_ACTIVE, &data);
673 if (ret)
674 goto out_meas;
675 vbatt_sum2 += data;
676 ret = measure_current(info, &data);
677 if (ret)
678 goto out_meas;
679
680 if (data < 0)
681 ibatt_sum2 = ibatt_sum2 - data; /* discharging */
682 else
683 ibatt_sum2 = ibatt_sum2 + data; /* charging */
684 }
685
686 /* restore current setting */
687 if (set_charger_current(info, chg_current, &ret))
688 goto out_meas;
689
690 if ((vbatt_sum1 > vbatt_sum2) && (ibatt_sum1 > ibatt_sum2) &&
691 (ibatt_sum2 > 0)) {
692 /* calculate resistor in discharging case */
693 data = 1000 * (vbatt_sum1 - vbatt_sum2)
694 / (ibatt_sum1 - ibatt_sum2);
695 if ((data - info->resistor > 0) &&
696 (data - info->resistor < info->resistor))
697 info->resistor = data;
698 if ((info->resistor - data > 0) &&
699 (info->resistor - data < data))
700 info->resistor = data;
701 }
702 return 0;
703
704 out_meas:
705 set_charger_current(info, chg_current, &ret);
706 out:
707 return -EINVAL;
708 }
709
710 static int calc_capacity(struct pm860x_battery_info *info, int *cap)
711 {
712 int ret;
713 int data;
714 int ibat;
715 int cap_ocv = 0;
716 int cap_cc = 0;
717
718 ret = calc_ccnt(info, &ccnt_data);
719 if (ret)
720 goto out;
721 soc:
722 data = info->max_capacity * info->start_soc / 100;
723 if (ccnt_data.total_dischg - ccnt_data.total_chg <= data) {
724 cap_cc =
725 data + ccnt_data.total_chg - ccnt_data.total_dischg;
726 } else {
727 clear_ccnt(info, &ccnt_data);
728 calc_soc(info, OCV_MODE_ACTIVE, &info->start_soc);
729 dev_dbg(info->dev, "restart soc = %d !\n",
730 info->start_soc);
731 goto soc;
732 }
733
734 cap_cc = cap_cc * 100 / info->max_capacity;
735 if (cap_cc < 0)
736 cap_cc = 0;
737 else if (cap_cc > 100)
738 cap_cc = 100;
739
740 dev_dbg(info->dev, "%s, last cap : %d", __func__,
741 info->last_capacity);
742
743 ret = measure_current(info, &ibat);
744 if (ret)
745 goto out;
746 /* Calculate the capacity when discharging(ibat < 0) */
747 if (ibat < 0) {
748 ret = calc_soc(info, OCV_MODE_ACTIVE, &cap_ocv);
749 if (ret)
750 cap_ocv = info->last_capacity;
751 ret = measure_vbatt(info, OCV_MODE_ACTIVE, &data);
752 if (ret)
753 goto out;
754 if (data <= LOW_BAT_THRESHOLD) {
755 /* choose the lower capacity value to report
756 * between vbat and CC when vbat < 3.6v;
757 * than 3.6v;
758 */
759 *cap = min(cap_ocv, cap_cc);
760 } else {
761 /* when detect vbat > 3.6v, but cap_cc < 15,and
762 * cap_ocv is 10% larger than cap_cc, we can think
763 * CC have some accumulation error, switch to OCV
764 * to estimate capacity;
765 * */
766 if (cap_cc < 15 && cap_ocv - cap_cc > 10)
767 *cap = cap_ocv;
768 else
769 *cap = cap_cc;
770 }
771 /* when discharging, make sure current capacity
772 * is lower than last*/
773 if (*cap > info->last_capacity)
774 *cap = info->last_capacity;
775 } else {
776 *cap = cap_cc;
777 }
778 info->last_capacity = *cap;
779
780 dev_dbg(info->dev, "%s, cap_ocv:%d cap_cc:%d, cap:%d\n",
781 (ibat < 0) ? "discharging" : "charging",
782 cap_ocv, cap_cc, *cap);
783 /*
784 * store the current capacity to RTC domain register,
785 * after next power up , it will be restored.
786 */
787 pm860x_set_bits(info->i2c, PM8607_RTC_MISC2, RTC_SOC_5LSB,
788 (*cap & 0x1F) << 3);
789 pm860x_set_bits(info->i2c, PM8607_RTC1, RTC_SOC_3MSB,
790 ((*cap >> 5) & 0x3));
791 return 0;
792 out:
793 return ret;
794 }
795
796 static void pm860x_external_power_changed(struct power_supply *psy)
797 {
798 struct pm860x_battery_info *info = dev_get_drvdata(psy->dev.parent);
799
800 calc_resistor(info);
801 }
802
803 static int pm860x_batt_get_prop(struct power_supply *psy,
804 enum power_supply_property psp,
805 union power_supply_propval *val)
806 {
807 struct pm860x_battery_info *info = dev_get_drvdata(psy->dev.parent);
808 int data;
809 int ret;
810
811 switch (psp) {
812 case POWER_SUPPLY_PROP_PRESENT:
813 val->intval = info->present;
814 break;
815 case POWER_SUPPLY_PROP_CAPACITY:
816 ret = calc_capacity(info, &data);
817 if (ret)
818 return ret;
819 if (data < 0)
820 data = 0;
821 else if (data > 100)
822 data = 100;
823 /* return 100 if battery is not attached */
824 if (!info->present)
825 data = 100;
826 val->intval = data;
827 break;
828 case POWER_SUPPLY_PROP_TECHNOLOGY:
829 val->intval = POWER_SUPPLY_TECHNOLOGY_LION;
830 break;
831 case POWER_SUPPLY_PROP_VOLTAGE_NOW:
832 /* return real vbatt Voltage */
833 ret = measure_vbatt(info, OCV_MODE_ACTIVE, &data);
834 if (ret)
835 return ret;
836 val->intval = data * 1000;
837 break;
838 case POWER_SUPPLY_PROP_VOLTAGE_AVG:
839 /* return Open Circuit Voltage (not measured voltage) */
840 ret = calc_ocv(info, &data);
841 if (ret)
842 return ret;
843 val->intval = data * 1000;
844 break;
845 case POWER_SUPPLY_PROP_CURRENT_NOW:
846 ret = measure_current(info, &data);
847 if (ret)
848 return ret;
849 val->intval = data;
850 break;
851 case POWER_SUPPLY_PROP_TEMP:
852 if (info->present) {
853 ret = measure_temp(info, &data);
854 if (ret)
855 return ret;
856 data *= 10;
857 } else {
858 /* Fake Temp 25C Without Battery */
859 data = 250;
860 }
861 val->intval = data;
862 break;
863 default:
864 return -ENODEV;
865 }
866 return 0;
867 }
868
869 static int pm860x_batt_set_prop(struct power_supply *psy,
870 enum power_supply_property psp,
871 const union power_supply_propval *val)
872 {
873 struct pm860x_battery_info *info = dev_get_drvdata(psy->dev.parent);
874
875 switch (psp) {
876 case POWER_SUPPLY_PROP_CHARGE_FULL:
877 clear_ccnt(info, &ccnt_data);
878 info->start_soc = 100;
879 dev_dbg(info->dev, "chg done, update soc = %d\n",
880 info->start_soc);
881 break;
882 default:
883 return -EPERM;
884 }
885
886 return 0;
887 }
888
889
890 static enum power_supply_property pm860x_batt_props[] = {
891 POWER_SUPPLY_PROP_PRESENT,
892 POWER_SUPPLY_PROP_CAPACITY,
893 POWER_SUPPLY_PROP_TECHNOLOGY,
894 POWER_SUPPLY_PROP_VOLTAGE_NOW,
895 POWER_SUPPLY_PROP_VOLTAGE_AVG,
896 POWER_SUPPLY_PROP_CURRENT_NOW,
897 POWER_SUPPLY_PROP_TEMP,
898 };
899
900 static const struct power_supply_desc pm860x_battery_desc = {
901 .name = "battery-monitor",
902 .type = POWER_SUPPLY_TYPE_BATTERY,
903 .properties = pm860x_batt_props,
904 .num_properties = ARRAY_SIZE(pm860x_batt_props),
905 .get_property = pm860x_batt_get_prop,
906 .set_property = pm860x_batt_set_prop,
907 .external_power_changed = pm860x_external_power_changed,
908 };
909
910 static int pm860x_battery_probe(struct platform_device *pdev)
911 {
912 struct pm860x_chip *chip = dev_get_drvdata(pdev->dev.parent);
913 struct pm860x_battery_info *info;
914 struct pm860x_power_pdata *pdata;
915 int ret;
916
917 info = devm_kzalloc(&pdev->dev, sizeof(*info), GFP_KERNEL);
918 if (!info)
919 return -ENOMEM;
920
921 info->irq_cc = platform_get_irq(pdev, 0);
922 if (info->irq_cc <= 0) {
923 dev_err(&pdev->dev, "No IRQ resource!\n");
924 return -EINVAL;
925 }
926
927 info->irq_batt = platform_get_irq(pdev, 1);
928 if (info->irq_batt <= 0) {
929 dev_err(&pdev->dev, "No IRQ resource!\n");
930 return -EINVAL;
931 }
932
933 info->chip = chip;
934 info->i2c =
935 (chip->id == CHIP_PM8607) ? chip->client : chip->companion;
936 info->dev = &pdev->dev;
937 info->status = POWER_SUPPLY_STATUS_UNKNOWN;
938 pdata = pdev->dev.platform_data;
939
940 mutex_init(&info->lock);
941 platform_set_drvdata(pdev, info);
942
943 pm860x_init_battery(info);
944
945 if (pdata && pdata->max_capacity)
946 info->max_capacity = pdata->max_capacity;
947 else
948 info->max_capacity = 1500; /* set default capacity */
949 if (pdata && pdata->resistor)
950 info->resistor = pdata->resistor;
951 else
952 info->resistor = 300; /* set default internal resistor */
953
954 info->battery = devm_power_supply_register(&pdev->dev,
955 &pm860x_battery_desc,
956 NULL);
957 if (IS_ERR(info->battery))
958 return PTR_ERR(info->battery);
959 info->battery->dev.parent = &pdev->dev;
960
961 ret = devm_request_threaded_irq(chip->dev, info->irq_cc, NULL,
962 pm860x_coulomb_handler, IRQF_ONESHOT,
963 "coulomb", info);
964 if (ret < 0) {
965 dev_err(chip->dev, "Failed to request IRQ: #%d: %d\n",
966 info->irq_cc, ret);
967 return ret;
968 }
969
970 ret = devm_request_threaded_irq(chip->dev, info->irq_batt, NULL,
971 pm860x_batt_handler,
972 IRQF_ONESHOT, "battery", info);
973 if (ret < 0) {
974 dev_err(chip->dev, "Failed to request IRQ: #%d: %d\n",
975 info->irq_batt, ret);
976 return ret;
977 }
978
979
980 return 0;
981 }
982
983 #ifdef CONFIG_PM_SLEEP
984 static int pm860x_battery_suspend(struct device *dev)
985 {
986 struct platform_device *pdev = to_platform_device(dev);
987 struct pm860x_chip *chip = dev_get_drvdata(pdev->dev.parent);
988
989 if (device_may_wakeup(dev))
990 chip->wakeup_flag |= 1 << PM8607_IRQ_CC;
991 return 0;
992 }
993
994 static int pm860x_battery_resume(struct device *dev)
995 {
996 struct platform_device *pdev = to_platform_device(dev);
997 struct pm860x_chip *chip = dev_get_drvdata(pdev->dev.parent);
998
999 if (device_may_wakeup(dev))
1000 chip->wakeup_flag &= ~(1 << PM8607_IRQ_CC);
1001 return 0;
1002 }
1003 #endif
1004
1005 static SIMPLE_DEV_PM_OPS(pm860x_battery_pm_ops,
1006 pm860x_battery_suspend, pm860x_battery_resume);
1007
1008 static struct platform_driver pm860x_battery_driver = {
1009 .driver = {
1010 .name = "88pm860x-battery",
1011 .pm = &pm860x_battery_pm_ops,
1012 },
1013 .probe = pm860x_battery_probe,
1014 };
1015 module_platform_driver(pm860x_battery_driver);
1016
1017 MODULE_DESCRIPTION("Marvell 88PM860x Battery driver");
1018 MODULE_LICENSE("GPL");
Linux with added FPC-III support