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