Version:  2.0.40 2.2.26 2.4.37 3.0 3.1 3.2 3.3 3.4 3.5 3.6 3.7 3.8 3.9 3.10 3.11 3.12 3.13 3.14 3.15 3.16

Linux/drivers/power/88pm860x_battery.c

  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;
802 
803         info = container_of(psy, struct pm860x_battery_info, battery);
804         calc_resistor(info);
805 }
806 
807 static 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 
873 static 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 
894 static 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 
904 static 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 
981 out_coulomb:
982         free_irq(info->irq_cc, info);
983 out_reg:
984         power_supply_unregister(&info->battery);
985         return ret;
986 }
987 
988 static 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
999 static 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 
1009 static 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 
1020 static SIMPLE_DEV_PM_OPS(pm860x_battery_pm_ops,
1021                         pm860x_battery_suspend, pm860x_battery_resume);
1022 
1023 static 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 };
1032 module_platform_driver(pm860x_battery_driver);
1033 
1034 MODULE_DESCRIPTION("Marvell 88PM860x Battery driver");
1035 MODULE_LICENSE("GPL");
1036 

This page was automatically generated by LXR 0.3.1 (source).  •  Linux is a registered trademark of Linus Torvalds  •  Contact us