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 pos; |
113 | unsigned long long 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, ccnt: &data); |
271 | if (ret) |
272 | goto out; |
273 | sum = data & 0xffff; |
274 | ret = read_ccnt(info, CCNT_POS2, ccnt: &data); |
275 | if (ret) |
276 | goto out; |
277 | sum |= (data & 0xffff) << 16; |
278 | ccnt->pos += sum; |
279 | |
280 | ret = read_ccnt(info, CCNT_NEG1, ccnt: &data); |
281 | if (ret) |
282 | goto out; |
283 | sum = data & 0xffff; |
284 | ret = read_ccnt(info, CCNT_NEG2, ccnt: &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, ccnt: &data); |
292 | if (ret) |
293 | goto out; |
294 | ccnt->spos += data; |
295 | ret = read_ccnt(info, CCNT_SNEG, ccnt: &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, ccnt: &data); |
318 | read_ccnt(info, CCNT_POS2, ccnt: &data); |
319 | read_ccnt(info, CCNT_NEG1, ccnt: &data); |
320 | read_ccnt(info, CCNT_NEG2, ccnt: &data); |
321 | read_ccnt(info, CCNT_SPOS, ccnt: &data); |
322 | read_ccnt(info, CCNT_SNEG, ccnt: &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: &data); |
342 | if (ret) |
343 | goto out; |
344 | vbatt_sum += data; |
345 | ret = measure_current(info, data: &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(lock: &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: &ocv); |
379 | break; |
380 | case OCV_MODE_SLEEP: |
381 | ret = measure_vbatt(info, OCV_MODE_SLEEP, data: &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: &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(lock: &info->lock); |
425 | /* clear ccnt since battery is attached or dettached */ |
426 | clear_ccnt(info, ccnt: &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 = 0; |
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(lock: &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(lock: &info->lock); |
498 | |
499 | ret = calc_soc(info, OCV_MODE_ACTIVE, soc: &soc); |
500 | if (ret < 0) |
501 | goto out; |
502 | |
503 | data = pm860x_reg_read(info->i2c, PM8607_POWER_UP_LOG); |
504 | bat_remove = data & BAT_WU_LOG; |
505 | |
506 | dev_dbg(info->dev, "battery wake up? %s\n" , |
507 | bat_remove != 0 ? "yes" : "no" ); |
508 | |
509 | /* restore SOC from RTC domain register */ |
510 | if (bat_remove == 0) { |
511 | buf[0] = pm860x_reg_read(info->i2c, PM8607_RTC_MISC2); |
512 | buf[1] = pm860x_reg_read(info->i2c, PM8607_RTC1); |
513 | data = ((buf[1] & 0x3) << 5) | ((buf[0] >> 3) & 0x1F); |
514 | if (data > soc + 15) |
515 | info->start_soc = soc; |
516 | else if (data < soc - 15) |
517 | info->start_soc = soc; |
518 | else |
519 | info->start_soc = data; |
520 | dev_dbg(info->dev, "soc_rtc %d, soc_ocv :%d\n" , data, soc); |
521 | } else { |
522 | pm860x_set_bits(info->i2c, PM8607_POWER_UP_LOG, |
523 | BAT_WU_LOG, BAT_WU_LOG); |
524 | info->start_soc = soc; |
525 | } |
526 | info->last_capacity = info->start_soc; |
527 | dev_dbg(info->dev, "init soc : %d\n" , info->last_capacity); |
528 | out: |
529 | return; |
530 | } |
531 | |
532 | static void set_temp_threshold(struct pm860x_battery_info *info, |
533 | int min, int max) |
534 | { |
535 | int data; |
536 | |
537 | /* (tmp << 8) / 1800 */ |
538 | if (min <= 0) |
539 | data = 0; |
540 | else |
541 | data = (min << 8) / 1800; |
542 | pm860x_reg_write(info->i2c, PM8607_GPADC1_HIGHTH, data); |
543 | dev_dbg(info->dev, "TEMP_HIGHTH : min: %d, 0x%x\n" , min, data); |
544 | |
545 | if (max <= 0) |
546 | data = 0xff; |
547 | else |
548 | data = (max << 8) / 1800; |
549 | pm860x_reg_write(info->i2c, PM8607_GPADC1_LOWTH, data); |
550 | dev_dbg(info->dev, "TEMP_LOWTH:max : %d, 0x%x\n" , max, data); |
551 | } |
552 | |
553 | static int measure_temp(struct pm860x_battery_info *info, int *data) |
554 | { |
555 | int ret; |
556 | int temp; |
557 | int min; |
558 | int max; |
559 | |
560 | if (info->temp_type == PM860X_TEMP_TINT) { |
561 | ret = measure_12bit_voltage(info, PM8607_TINT_MEAS1, data); |
562 | if (ret) |
563 | return ret; |
564 | *data = (*data - 884) * 1000 / 3611; |
565 | } else { |
566 | ret = measure_12bit_voltage(info, PM8607_GPADC1_MEAS1, data); |
567 | if (ret) |
568 | return ret; |
569 | /* meausered Vtbat(mV) / Ibias_current(11uA)*/ |
570 | *data = (*data * 1000) / GPBIAS2_GPADC1_UA; |
571 | |
572 | if (*data > TBAT_NEG_25D) { |
573 | temp = -30; /* over cold , suppose -30 roughly */ |
574 | max = TBAT_NEG_10D * GPBIAS2_GPADC1_UA / 1000; |
575 | set_temp_threshold(info, min: 0, max); |
576 | } else if (*data > TBAT_NEG_10D) { |
577 | temp = -15; /* -15 degree, code */ |
578 | max = TBAT_NEG_10D * GPBIAS2_GPADC1_UA / 1000; |
579 | set_temp_threshold(info, min: 0, max); |
580 | } else if (*data > TBAT_0D) { |
581 | temp = -5; /* -5 degree */ |
582 | min = TBAT_NEG_10D * GPBIAS2_GPADC1_UA / 1000; |
583 | max = TBAT_40D * GPBIAS2_GPADC1_UA / 1000; |
584 | set_temp_threshold(info, min, max); |
585 | } else if (*data > TBAT_10D) { |
586 | temp = 5; /* in range of (0, 10) */ |
587 | min = TBAT_NEG_10D * GPBIAS2_GPADC1_UA / 1000; |
588 | max = TBAT_40D * GPBIAS2_GPADC1_UA / 1000; |
589 | set_temp_threshold(info, min, max); |
590 | } else if (*data > TBAT_20D) { |
591 | temp = 15; /* in range of (10, 20) */ |
592 | min = TBAT_NEG_10D * GPBIAS2_GPADC1_UA / 1000; |
593 | max = TBAT_40D * GPBIAS2_GPADC1_UA / 1000; |
594 | set_temp_threshold(info, min, max); |
595 | } else if (*data > TBAT_30D) { |
596 | temp = 25; /* in range of (20, 30) */ |
597 | min = TBAT_NEG_10D * GPBIAS2_GPADC1_UA / 1000; |
598 | max = TBAT_40D * GPBIAS2_GPADC1_UA / 1000; |
599 | set_temp_threshold(info, min, max); |
600 | } else if (*data > TBAT_40D) { |
601 | temp = 35; /* in range of (30, 40) */ |
602 | min = TBAT_NEG_10D * GPBIAS2_GPADC1_UA / 1000; |
603 | max = TBAT_40D * GPBIAS2_GPADC1_UA / 1000; |
604 | set_temp_threshold(info, min, max); |
605 | } else { |
606 | min = TBAT_40D * GPBIAS2_GPADC1_UA / 1000; |
607 | set_temp_threshold(info, min, max: 0); |
608 | temp = 45; /* over heat ,suppose 45 roughly */ |
609 | } |
610 | |
611 | dev_dbg(info->dev, "temp_C:%d C,temp_mv:%d mv\n" , temp, *data); |
612 | *data = temp; |
613 | } |
614 | return 0; |
615 | } |
616 | |
617 | static int calc_resistor(struct pm860x_battery_info *info) |
618 | { |
619 | int vbatt_sum1; |
620 | int vbatt_sum2; |
621 | int chg_current; |
622 | int ibatt_sum1; |
623 | int ibatt_sum2; |
624 | int data; |
625 | int ret; |
626 | int i; |
627 | |
628 | ret = measure_current(info, data: &data); |
629 | /* make sure that charging is launched by data > 0 */ |
630 | if (ret || data < 0) |
631 | goto out; |
632 | |
633 | ret = measure_vbatt(info, OCV_MODE_ACTIVE, data: &data); |
634 | if (ret) |
635 | goto out; |
636 | /* calculate resistor only in CC charge mode */ |
637 | if (data < VBATT_RESISTOR_MIN || data > VBATT_RESISTOR_MAX) |
638 | goto out; |
639 | |
640 | /* current is saved */ |
641 | if (set_charger_current(info, data: 500, old: &chg_current)) |
642 | goto out; |
643 | |
644 | /* |
645 | * set charge current as 500mA, wait about 500ms till charging |
646 | * process is launched and stable with the newer charging current. |
647 | */ |
648 | msleep(msecs: 500); |
649 | |
650 | for (i = 0, vbatt_sum1 = 0, ibatt_sum1 = 0; i < 10; i++) { |
651 | ret = measure_vbatt(info, OCV_MODE_ACTIVE, data: &data); |
652 | if (ret) |
653 | goto out_meas; |
654 | vbatt_sum1 += data; |
655 | ret = measure_current(info, data: &data); |
656 | if (ret) |
657 | goto out_meas; |
658 | |
659 | if (data < 0) |
660 | ibatt_sum1 = ibatt_sum1 - data; /* discharging */ |
661 | else |
662 | ibatt_sum1 = ibatt_sum1 + data; /* charging */ |
663 | } |
664 | |
665 | if (set_charger_current(info, data: 100, old: &ret)) |
666 | goto out_meas; |
667 | /* |
668 | * set charge current as 100mA, wait about 500ms till charging |
669 | * process is launched and stable with the newer charging current. |
670 | */ |
671 | msleep(msecs: 500); |
672 | |
673 | for (i = 0, vbatt_sum2 = 0, ibatt_sum2 = 0; i < 10; i++) { |
674 | ret = measure_vbatt(info, OCV_MODE_ACTIVE, data: &data); |
675 | if (ret) |
676 | goto out_meas; |
677 | vbatt_sum2 += data; |
678 | ret = measure_current(info, data: &data); |
679 | if (ret) |
680 | goto out_meas; |
681 | |
682 | if (data < 0) |
683 | ibatt_sum2 = ibatt_sum2 - data; /* discharging */ |
684 | else |
685 | ibatt_sum2 = ibatt_sum2 + data; /* charging */ |
686 | } |
687 | |
688 | /* restore current setting */ |
689 | if (set_charger_current(info, data: chg_current, old: &ret)) |
690 | goto out_meas; |
691 | |
692 | if ((vbatt_sum1 > vbatt_sum2) && (ibatt_sum1 > ibatt_sum2) && |
693 | (ibatt_sum2 > 0)) { |
694 | /* calculate resistor in discharging case */ |
695 | data = 1000 * (vbatt_sum1 - vbatt_sum2) |
696 | / (ibatt_sum1 - ibatt_sum2); |
697 | if ((data - info->resistor > 0) && |
698 | (data - info->resistor < info->resistor)) |
699 | info->resistor = data; |
700 | if ((info->resistor - data > 0) && |
701 | (info->resistor - data < data)) |
702 | info->resistor = data; |
703 | } |
704 | return 0; |
705 | |
706 | out_meas: |
707 | set_charger_current(info, data: chg_current, old: &ret); |
708 | out: |
709 | return -EINVAL; |
710 | } |
711 | |
712 | static int calc_capacity(struct pm860x_battery_info *info, int *cap) |
713 | { |
714 | int ret; |
715 | int data; |
716 | int ibat; |
717 | int cap_ocv = 0; |
718 | int cap_cc = 0; |
719 | |
720 | ret = calc_ccnt(info, ccnt: &ccnt_data); |
721 | if (ret) |
722 | goto out; |
723 | soc: |
724 | data = info->max_capacity * info->start_soc / 100; |
725 | if (ccnt_data.total_dischg - ccnt_data.total_chg <= data) { |
726 | cap_cc = |
727 | data + ccnt_data.total_chg - ccnt_data.total_dischg; |
728 | } else { |
729 | clear_ccnt(info, ccnt: &ccnt_data); |
730 | calc_soc(info, OCV_MODE_ACTIVE, soc: &info->start_soc); |
731 | dev_dbg(info->dev, "restart soc = %d !\n" , |
732 | info->start_soc); |
733 | goto soc; |
734 | } |
735 | |
736 | cap_cc = cap_cc * 100 / info->max_capacity; |
737 | if (cap_cc < 0) |
738 | cap_cc = 0; |
739 | else if (cap_cc > 100) |
740 | cap_cc = 100; |
741 | |
742 | dev_dbg(info->dev, "%s, last cap : %d" , __func__, |
743 | info->last_capacity); |
744 | |
745 | ret = measure_current(info, data: &ibat); |
746 | if (ret) |
747 | goto out; |
748 | /* Calculate the capacity when discharging(ibat < 0) */ |
749 | if (ibat < 0) { |
750 | ret = calc_soc(info, OCV_MODE_ACTIVE, soc: &cap_ocv); |
751 | if (ret) |
752 | cap_ocv = info->last_capacity; |
753 | ret = measure_vbatt(info, OCV_MODE_ACTIVE, data: &data); |
754 | if (ret) |
755 | goto out; |
756 | if (data <= LOW_BAT_THRESHOLD) { |
757 | /* choose the lower capacity value to report |
758 | * between vbat and CC when vbat < 3.6v; |
759 | * than 3.6v; |
760 | */ |
761 | *cap = min(cap_ocv, cap_cc); |
762 | } else { |
763 | /* when detect vbat > 3.6v, but cap_cc < 15,and |
764 | * cap_ocv is 10% larger than cap_cc, we can think |
765 | * CC have some accumulation error, switch to OCV |
766 | * to estimate capacity; |
767 | * */ |
768 | if (cap_cc < 15 && cap_ocv - cap_cc > 10) |
769 | *cap = cap_ocv; |
770 | else |
771 | *cap = cap_cc; |
772 | } |
773 | /* when discharging, make sure current capacity |
774 | * is lower than last*/ |
775 | if (*cap > info->last_capacity) |
776 | *cap = info->last_capacity; |
777 | } else { |
778 | *cap = cap_cc; |
779 | } |
780 | info->last_capacity = *cap; |
781 | |
782 | dev_dbg(info->dev, "%s, cap_ocv:%d cap_cc:%d, cap:%d\n" , |
783 | (ibat < 0) ? "discharging" : "charging" , |
784 | cap_ocv, cap_cc, *cap); |
785 | /* |
786 | * store the current capacity to RTC domain register, |
787 | * after next power up , it will be restored. |
788 | */ |
789 | pm860x_set_bits(info->i2c, PM8607_RTC_MISC2, RTC_SOC_5LSB, |
790 | (*cap & 0x1F) << 3); |
791 | pm860x_set_bits(info->i2c, PM8607_RTC1, RTC_SOC_3MSB, |
792 | ((*cap >> 5) & 0x3)); |
793 | return 0; |
794 | out: |
795 | return ret; |
796 | } |
797 | |
798 | static void pm860x_external_power_changed(struct power_supply *psy) |
799 | { |
800 | struct pm860x_battery_info *info = dev_get_drvdata(dev: psy->dev.parent); |
801 | |
802 | calc_resistor(info); |
803 | } |
804 | |
805 | static int pm860x_batt_get_prop(struct power_supply *psy, |
806 | enum power_supply_property psp, |
807 | union power_supply_propval *val) |
808 | { |
809 | struct pm860x_battery_info *info = dev_get_drvdata(dev: psy->dev.parent); |
810 | int data; |
811 | int ret; |
812 | |
813 | switch (psp) { |
814 | case POWER_SUPPLY_PROP_PRESENT: |
815 | val->intval = info->present; |
816 | break; |
817 | case POWER_SUPPLY_PROP_CAPACITY: |
818 | ret = calc_capacity(info, cap: &data); |
819 | if (ret) |
820 | return ret; |
821 | if (data < 0) |
822 | data = 0; |
823 | else if (data > 100) |
824 | data = 100; |
825 | /* return 100 if battery is not attached */ |
826 | if (!info->present) |
827 | data = 100; |
828 | val->intval = data; |
829 | break; |
830 | case POWER_SUPPLY_PROP_TECHNOLOGY: |
831 | val->intval = POWER_SUPPLY_TECHNOLOGY_LION; |
832 | break; |
833 | case POWER_SUPPLY_PROP_VOLTAGE_NOW: |
834 | /* return real vbatt Voltage */ |
835 | ret = measure_vbatt(info, OCV_MODE_ACTIVE, data: &data); |
836 | if (ret) |
837 | return ret; |
838 | val->intval = data * 1000; |
839 | break; |
840 | case POWER_SUPPLY_PROP_VOLTAGE_AVG: |
841 | /* return Open Circuit Voltage (not measured voltage) */ |
842 | ret = calc_ocv(info, ocv: &data); |
843 | if (ret) |
844 | return ret; |
845 | val->intval = data * 1000; |
846 | break; |
847 | case POWER_SUPPLY_PROP_CURRENT_NOW: |
848 | ret = measure_current(info, data: &data); |
849 | if (ret) |
850 | return ret; |
851 | val->intval = data; |
852 | break; |
853 | case POWER_SUPPLY_PROP_TEMP: |
854 | if (info->present) { |
855 | ret = measure_temp(info, data: &data); |
856 | if (ret) |
857 | return ret; |
858 | data *= 10; |
859 | } else { |
860 | /* Fake Temp 25C Without Battery */ |
861 | data = 250; |
862 | } |
863 | val->intval = data; |
864 | break; |
865 | default: |
866 | return -ENODEV; |
867 | } |
868 | return 0; |
869 | } |
870 | |
871 | static int pm860x_batt_set_prop(struct power_supply *psy, |
872 | enum power_supply_property psp, |
873 | const union power_supply_propval *val) |
874 | { |
875 | struct pm860x_battery_info *info = dev_get_drvdata(dev: psy->dev.parent); |
876 | |
877 | switch (psp) { |
878 | case POWER_SUPPLY_PROP_CHARGE_FULL: |
879 | clear_ccnt(info, ccnt: &ccnt_data); |
880 | info->start_soc = 100; |
881 | dev_dbg(info->dev, "chg done, update soc = %d\n" , |
882 | info->start_soc); |
883 | break; |
884 | default: |
885 | return -EPERM; |
886 | } |
887 | |
888 | return 0; |
889 | } |
890 | |
891 | |
892 | static enum power_supply_property pm860x_batt_props[] = { |
893 | POWER_SUPPLY_PROP_PRESENT, |
894 | POWER_SUPPLY_PROP_CAPACITY, |
895 | POWER_SUPPLY_PROP_TECHNOLOGY, |
896 | POWER_SUPPLY_PROP_VOLTAGE_NOW, |
897 | POWER_SUPPLY_PROP_VOLTAGE_AVG, |
898 | POWER_SUPPLY_PROP_CURRENT_NOW, |
899 | POWER_SUPPLY_PROP_TEMP, |
900 | }; |
901 | |
902 | static const struct power_supply_desc pm860x_battery_desc = { |
903 | .name = "battery-monitor" , |
904 | .type = POWER_SUPPLY_TYPE_BATTERY, |
905 | .properties = pm860x_batt_props, |
906 | .num_properties = ARRAY_SIZE(pm860x_batt_props), |
907 | .get_property = pm860x_batt_get_prop, |
908 | .set_property = pm860x_batt_set_prop, |
909 | .external_power_changed = pm860x_external_power_changed, |
910 | }; |
911 | |
912 | static int pm860x_battery_probe(struct platform_device *pdev) |
913 | { |
914 | struct pm860x_chip *chip = dev_get_drvdata(dev: pdev->dev.parent); |
915 | struct pm860x_battery_info *info; |
916 | struct pm860x_power_pdata *pdata; |
917 | int ret; |
918 | |
919 | info = devm_kzalloc(dev: &pdev->dev, size: sizeof(*info), GFP_KERNEL); |
920 | if (!info) |
921 | return -ENOMEM; |
922 | |
923 | info->irq_cc = platform_get_irq(pdev, 0); |
924 | if (info->irq_cc < 0) |
925 | return info->irq_cc; |
926 | |
927 | info->irq_batt = platform_get_irq(pdev, 1); |
928 | if (info->irq_batt < 0) |
929 | return info->irq_batt; |
930 | |
931 | info->chip = chip; |
932 | info->i2c = |
933 | (chip->id == CHIP_PM8607) ? chip->client : chip->companion; |
934 | info->dev = &pdev->dev; |
935 | info->status = POWER_SUPPLY_STATUS_UNKNOWN; |
936 | pdata = pdev->dev.platform_data; |
937 | |
938 | mutex_init(&info->lock); |
939 | platform_set_drvdata(pdev, data: info); |
940 | |
941 | pm860x_init_battery(info); |
942 | |
943 | if (pdata && pdata->max_capacity) |
944 | info->max_capacity = pdata->max_capacity; |
945 | else |
946 | info->max_capacity = 1500; /* set default capacity */ |
947 | if (pdata && pdata->resistor) |
948 | info->resistor = pdata->resistor; |
949 | else |
950 | info->resistor = 300; /* set default internal resistor */ |
951 | |
952 | info->battery = devm_power_supply_register(parent: &pdev->dev, |
953 | desc: &pm860x_battery_desc, |
954 | NULL); |
955 | if (IS_ERR(ptr: info->battery)) |
956 | return PTR_ERR(ptr: info->battery); |
957 | info->battery->dev.parent = &pdev->dev; |
958 | |
959 | ret = devm_request_threaded_irq(dev: chip->dev, irq: info->irq_cc, NULL, |
960 | thread_fn: pm860x_coulomb_handler, IRQF_ONESHOT, |
961 | devname: "coulomb" , dev_id: info); |
962 | if (ret < 0) { |
963 | dev_err(chip->dev, "Failed to request IRQ: #%d: %d\n" , |
964 | info->irq_cc, ret); |
965 | return ret; |
966 | } |
967 | |
968 | ret = devm_request_threaded_irq(dev: chip->dev, irq: info->irq_batt, NULL, |
969 | thread_fn: pm860x_batt_handler, |
970 | IRQF_ONESHOT, devname: "battery" , dev_id: info); |
971 | if (ret < 0) { |
972 | dev_err(chip->dev, "Failed to request IRQ: #%d: %d\n" , |
973 | info->irq_batt, ret); |
974 | return ret; |
975 | } |
976 | |
977 | |
978 | return 0; |
979 | } |
980 | |
981 | #ifdef CONFIG_PM_SLEEP |
982 | static int pm860x_battery_suspend(struct device *dev) |
983 | { |
984 | struct platform_device *pdev = to_platform_device(dev); |
985 | struct pm860x_chip *chip = dev_get_drvdata(dev: pdev->dev.parent); |
986 | |
987 | if (device_may_wakeup(dev)) |
988 | chip->wakeup_flag |= 1 << PM8607_IRQ_CC; |
989 | return 0; |
990 | } |
991 | |
992 | static int pm860x_battery_resume(struct device *dev) |
993 | { |
994 | struct platform_device *pdev = to_platform_device(dev); |
995 | struct pm860x_chip *chip = dev_get_drvdata(dev: pdev->dev.parent); |
996 | |
997 | if (device_may_wakeup(dev)) |
998 | chip->wakeup_flag &= ~(1 << PM8607_IRQ_CC); |
999 | return 0; |
1000 | } |
1001 | #endif |
1002 | |
1003 | static SIMPLE_DEV_PM_OPS(pm860x_battery_pm_ops, |
1004 | pm860x_battery_suspend, pm860x_battery_resume); |
1005 | |
1006 | static struct platform_driver pm860x_battery_driver = { |
1007 | .driver = { |
1008 | .name = "88pm860x-battery" , |
1009 | .pm = &pm860x_battery_pm_ops, |
1010 | }, |
1011 | .probe = pm860x_battery_probe, |
1012 | }; |
1013 | module_platform_driver(pm860x_battery_driver); |
1014 | |
1015 | MODULE_DESCRIPTION("Marvell 88PM860x Battery driver" ); |
1016 | MODULE_LICENSE("GPL" ); |
1017 | |