drivers/power/supply/88pm860x_battery.c

   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");