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 96struct 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 114struct 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 */ 128static 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 151static 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 */ 157static 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 173static 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 */ 216static 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 232static 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 249static 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; 263out: 264 return ret; 265} 266 267static 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; 310out: 311 return ret; 312} 313 314static 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 */ 330static 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; 364out: 365 return ret; 366} 367 368/* Calculate State of Charge (percent points) */ 369static 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 405static 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 413static 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 433static 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); 529out: 530 return; 531} 532 533static 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 554static 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 618static 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 707out_meas: 708 set_charger_current(info, chg_current, &ret); 709out: 710 return -EINVAL; 711} 712 713static 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; 724soc: 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; 795out: 796 return ret; 797} 798 799static void pm860x_external_power_changed(struct power_supply *psy) 800{ 801 struct pm860x_battery_info *info; 802 803 info = container_of(psy, struct pm860x_battery_info, battery); 804 calc_resistor(info); 805} 806 807static int pm860x_batt_get_prop(struct power_supply *psy, 808 enum power_supply_property psp, 809 union power_supply_propval *val) 810{ 811 struct pm860x_battery_info *info = dev_get_drvdata(psy->dev->parent); 812 int data; 813 int ret; 814 815 switch (psp) { 816 case POWER_SUPPLY_PROP_PRESENT: 817 val->intval = info->present; 818 break; 819 case POWER_SUPPLY_PROP_CAPACITY: 820 ret = calc_capacity(info, &data); 821 if (ret) 822 return ret; 823 if (data < 0) 824 data = 0; 825 else if (data > 100) 826 data = 100; 827 /* return 100 if battery is not attached */ 828 if (!info->present) 829 data = 100; 830 val->intval = data; 831 break; 832 case POWER_SUPPLY_PROP_TECHNOLOGY: 833 val->intval = POWER_SUPPLY_TECHNOLOGY_LION; 834 break; 835 case POWER_SUPPLY_PROP_VOLTAGE_NOW: 836 /* return real vbatt Voltage */ 837 ret = measure_vbatt(info, OCV_MODE_ACTIVE, &data); 838 if (ret) 839 return ret; 840 val->intval = data * 1000; 841 break; 842 case POWER_SUPPLY_PROP_VOLTAGE_AVG: 843 /* return Open Circuit Voltage (not measured voltage) */ 844 ret = calc_ocv(info, &data); 845 if (ret) 846 return ret; 847 val->intval = data * 1000; 848 break; 849 case POWER_SUPPLY_PROP_CURRENT_NOW: 850 ret = measure_current(info, &data); 851 if (ret) 852 return ret; 853 val->intval = data; 854 break; 855 case POWER_SUPPLY_PROP_TEMP: 856 if (info->present) { 857 ret = measure_temp(info, &data); 858 if (ret) 859 return ret; 860 data *= 10; 861 } else { 862 /* Fake Temp 25C Without Battery */ 863 data = 250; 864 } 865 val->intval = data; 866 break; 867 default: 868 return -ENODEV; 869 } 870 return 0; 871} 872 873static int pm860x_batt_set_prop(struct power_supply *psy, 874 enum power_supply_property psp, 875 const union power_supply_propval *val) 876{ 877 struct pm860x_battery_info *info = dev_get_drvdata(psy->dev->parent); 878 879 switch (psp) { 880 case POWER_SUPPLY_PROP_CHARGE_FULL: 881 clear_ccnt(info, &ccnt_data); 882 info->start_soc = 100; 883 dev_dbg(info->dev, "chg done, update soc = %d\n", 884 info->start_soc); 885 break; 886 default: 887 return -EPERM; 888 } 889 890 return 0; 891} 892 893 894static enum power_supply_property pm860x_batt_props[] = { 895 POWER_SUPPLY_PROP_PRESENT, 896 POWER_SUPPLY_PROP_CAPACITY, 897 POWER_SUPPLY_PROP_TECHNOLOGY, 898 POWER_SUPPLY_PROP_VOLTAGE_NOW, 899 POWER_SUPPLY_PROP_VOLTAGE_AVG, 900 POWER_SUPPLY_PROP_CURRENT_NOW, 901 POWER_SUPPLY_PROP_TEMP, 902}; 903 904static int pm860x_battery_probe(struct platform_device *pdev) 905{ 906 struct pm860x_chip *chip = dev_get_drvdata(pdev->dev.parent); 907 struct pm860x_battery_info *info; 908 struct pm860x_power_pdata *pdata; 909 int ret; 910 911 info = devm_kzalloc(&pdev->dev, sizeof(*info), GFP_KERNEL); 912 if (!info) 913 return -ENOMEM; 914 915 info->irq_cc = platform_get_irq(pdev, 0); 916 if (info->irq_cc <= 0) { 917 dev_err(&pdev->dev, "No IRQ resource!\n"); 918 return -EINVAL; 919 } 920 921 info->irq_batt = platform_get_irq(pdev, 1); 922 if (info->irq_batt <= 0) { 923 dev_err(&pdev->dev, "No IRQ resource!\n"); 924 return -EINVAL; 925 } 926 927 info->chip = chip; 928 info->i2c = 929 (chip->id == CHIP_PM8607) ? chip->client : chip->companion; 930 info->dev = &pdev->dev; 931 info->status = POWER_SUPPLY_STATUS_UNKNOWN; 932 pdata = pdev->dev.platform_data; 933 934 mutex_init(&info->lock); 935 platform_set_drvdata(pdev, info); 936 937 pm860x_init_battery(info); 938 939 info->battery.name = "battery-monitor"; 940 info->battery.type = POWER_SUPPLY_TYPE_BATTERY; 941 info->battery.properties = pm860x_batt_props; 942 info->battery.num_properties = ARRAY_SIZE(pm860x_batt_props); 943 info->battery.get_property = pm860x_batt_get_prop; 944 info->battery.set_property = pm860x_batt_set_prop; 945 info->battery.external_power_changed = pm860x_external_power_changed; 946 947 if (pdata && pdata->max_capacity) 948 info->max_capacity = pdata->max_capacity; 949 else 950 info->max_capacity = 1500; /* set default capacity */ 951 if (pdata && pdata->resistor) 952 info->resistor = pdata->resistor; 953 else 954 info->resistor = 300; /* set default internal resistor */ 955 956 ret = power_supply_register(&pdev->dev, &info->battery); 957 if (ret) 958 return ret; 959 info->battery.dev->parent = &pdev->dev; 960 961 ret = request_threaded_irq(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 goto out_reg; 968 } 969 970 ret = request_threaded_irq(info->irq_batt, NULL, pm860x_batt_handler, 971 IRQF_ONESHOT, "battery", info); 972 if (ret < 0) { 973 dev_err(chip->dev, "Failed to request IRQ: #%d: %d\n", 974 info->irq_batt, ret); 975 goto out_coulomb; 976 } 977 978 979 return 0; 980 981out_coulomb: 982 free_irq(info->irq_cc, info); 983out_reg: 984 power_supply_unregister(&info->battery); 985 return ret; 986} 987 988static int pm860x_battery_remove(struct platform_device *pdev) 989{ 990 struct pm860x_battery_info *info = platform_get_drvdata(pdev); 991 992 free_irq(info->irq_batt, info); 993 free_irq(info->irq_cc, info); 994 power_supply_unregister(&info->battery); 995 return 0; 996} 997 998#ifdef CONFIG_PM_SLEEP 999static int pm860x_battery_suspend(struct device *dev) 1000{ 1001 struct platform_device *pdev = to_platform_device(dev); 1002 struct pm860x_chip *chip = dev_get_drvdata(pdev->dev.parent); 1003 1004 if (device_may_wakeup(dev)) 1005 chip->wakeup_flag |= 1 << PM8607_IRQ_CC; 1006 return 0; 1007} 1008 1009static int pm860x_battery_resume(struct device *dev) 1010{ 1011 struct platform_device *pdev = to_platform_device(dev); 1012 struct pm860x_chip *chip = dev_get_drvdata(pdev->dev.parent); 1013 1014 if (device_may_wakeup(dev)) 1015 chip->wakeup_flag &= ~(1 << PM8607_IRQ_CC); 1016 return 0; 1017} 1018#endif 1019 1020static SIMPLE_DEV_PM_OPS(pm860x_battery_pm_ops, 1021 pm860x_battery_suspend, pm860x_battery_resume); 1022 1023static struct platform_driver pm860x_battery_driver = { 1024 .driver = { 1025 .name = "88pm860x-battery", 1026 .owner = THIS_MODULE, 1027 .pm = &pm860x_battery_pm_ops, 1028 }, 1029 .probe = pm860x_battery_probe, 1030 .remove = pm860x_battery_remove, 1031}; 1032module_platform_driver(pm860x_battery_driver); 1033 1034MODULE_DESCRIPTION("Marvell 88PM860x Battery driver"); 1035MODULE_LICENSE("GPL"); 1036