drivers/power/wm831x_power.c

   1 /*
   2  * PMU driver for Wolfson Microelectronics wm831x PMICs
   3  *
   4  * Copyright 2009 Wolfson Microelectronics PLC.
   5  *
   6  * This program is free software; you can redistribute it and/or modify
   7  * it under the terms of the GNU General Public License version 2 as
   8  * published by the Free Software Foundation.
   9  */
  10
  11 #include <linux/module.h>
  12 #include <linux/err.h>
  13 #include <linux/platform_device.h>
  14 #include <linux/power_supply.h>
  15 #include <linux/slab.h>
  16
  17 #include <linux/mfd/wm831x/core.h>
  18 #include <linux/mfd/wm831x/auxadc.h>
  19 #include <linux/mfd/wm831x/pmu.h>
  20 #include <linux/mfd/wm831x/pdata.h>
  21
  22 #define WM831X_DEBUG
  23 #undef  WM831X_DEBUG
  24
  25 #ifdef WM831X_DEBUG
  26 #define WM_BATT_DBG(x...) printk(KERN_INFO x)
  27 #else
  28 #define WM_BATT_DBG(x...)  do {} while (0)
  29 #endif
  30
  31 #define WM831X_CHG_SYSLO_SHIFT   4
  32 #define WM831X_CHG_SYSOK_SHIFT   0
  33 #define WM831X_CHG_SYSLO_MASK  ~(0x7 << 4)
  34 #define WM831X_CHG_SYSOK_MASK  ~(0x7 << 0)
  35 #define batt_num   57
  36 static int batt_chg_step_table[batt_num]={
  37     3650,3700,3710,3720,3730,3740,3745,3755,3760, //+200
  38         3770,3790,3805,3820,3830,3840, //+190
  39         3842,3850,3860,3870,3880,3885, //+180
  40
  41         3900,3910,3920,3930,3940,3950,3960,3970,3980,3990,   //+170
  42         4000,4010,4020,4030,4040,4050,4070,4090,4095,4100,4105,4110,4115,4120,4125,4130,
  43         4135,4140,4145,4150,4155,4160,4165,4170,4175,4180
  44 };
  45
  46 static int batt_step_table[batt_num]={
  47     3450,3500,3510,3520,3530,3540,3545,3555,3560,
  48         3580,3600,3615,3630,3640,3650,
  49         3660,3670,3680,3690,3700,3710,
  50         3720,3730,3740,3750,3760,3770,3780,3790,3800,3810,
  51         3815,3830,3845,3860,3875,3890,3900,3910,3920,3930,3940,3950,3960,3970,3985,4000,
  52         4005,4010,4015,4020,4030,4040,4050,4060,4070,4180
  53 };
  54
  55 static int batt_disp_table[batt_num]={
  56     0,2,4,6,8,10,12,14,15,
  57         18,20,23,26,28,30,
  58         33,37,40,43,47,50,
  59         52,54,57,60,62,64,66,68,69,70,
  60         72,74,76,78,79,80,81,82,83,84,85,86,87,88,89,90,
  61         91,92,93,94,95,96,97,98,99,100
  62 };
  63
  64
  65 #define TIMER_MS_COUNTS 1000
  66 struct wm_batt_priv_data {
  67         enum power_supply_property online;
  68         enum power_supply_property status;
  69         enum power_supply_property voltage;
  70         enum power_supply_property health;
  71         enum power_supply_property type;
  72         enum power_supply_property temp;
  73         int old_level;
  74         int charging_level;
  75 };
  76
  77 struct wm831x_power {
  78         struct wm831x *wm831x;
  79         struct power_supply wall;
  80         struct power_supply usb;
  81         struct power_supply battery;
  82         struct work_struct batt_work;
  83         struct timer_list timer;
  84         struct wm_batt_priv_data priv;
  85         int interval;
  86 };
  87
  88 struct wm831x_power *g_wm831x_power;
  89
  90 extern void wm831x_batt_vol_level(struct wm831x_power *power, int batt_val, int *level);
  91 static DEFINE_MUTEX(charging_mutex);
  92 static int g_read_level_cnt = 0;
  93
  94 int wm831x_read_on_pin_status(void)
  95 {
  96         int ret;
  97
  98         if(!g_wm831x_power)
  99         {
 100                 printk("err:%s:g_wm831x_power address is 0\n",__FUNCTION__);
 101                 return -1;
 102         }
 103
 104         ret = wm831x_reg_read(g_wm831x_power->wm831x, WM831X_ON_PIN_CONTROL);
 105         if (ret < 0)
 106                 return ret;
 107
 108         return !(ret & WM831X_ON_PIN_STS) ? 1 : 0;
 109 }
 110
 111 static int wm831x_power_check_online(struct wm831x *wm831x, int supply,
 112                                      union power_supply_propval *val)
 113 {
 114         int ret;
 115
 116         ret = wm831x_reg_read(wm831x, WM831X_SYSTEM_STATUS);
 117         if (ret < 0)
 118                 return ret;
 119
 120         if (ret & supply)
 121                 val->intval = 1;
 122         else
 123                 val->intval = 0;
 124
 125         return 0;
 126 }
 127
 128 int wm831x_read_chg_status(void)
 129 {
 130         int ret, usb_chg = 0, wall_chg = 0;
 131
 132         if(!g_wm831x_power)
 133         {
 134                 printk("err:%s:g_wm831x_power address is 0\n",__FUNCTION__);
 135                 return -1;
 136         }
 137
 138         ret = wm831x_reg_read(g_wm831x_power->wm831x, WM831X_SYSTEM_STATUS);
 139         if (ret < 0)
 140                 return ret;
 141
 142         if (ret & WM831X_PWR_USB)
 143                 usb_chg = 1;
 144         if (ret & WM831X_PWR_WALL)
 145                 wall_chg = 1;
 146
 147         return ((usb_chg | wall_chg) ? 1 : 0);
 148 }
 149
 150 static int wm831x_power_read_voltage(struct wm831x *wm831x,
 151                                      enum wm831x_auxadc src,
 152                                      union power_supply_propval *val)
 153 {
 154         int ret;
 155 #if 0
 156         int loop = 0, vol_sum = 0;
 157
 158         for (loop = 0; loop < 10; loop++) {
 159                 ret = wm831x_auxadc_read_uv(wm831x, src);
 160                 if (ret >= 0) {
 161                         vol_sum += ret / 1000;
 162                 }
 163         }
 164
 165         val->intval = vol_sum / 10;
 166
 167         return val->intval;
 168 #else
 169         ret = wm831x_auxadc_read_uv(wm831x, src);
 170         if (ret >= 0)
 171                 val->intval = ret / 1000;
 172         return ret ;
 173 #endif
 174 }
 175
 176 int wm831x_read_batt_voltage(void)
 177 {
 178         int ret = 0;
 179
 180         if(!g_wm831x_power)
 181         {
 182                 printk("err:%s:g_wm831x_power address is 0\n",__FUNCTION__);
 183                 return -1;
 184         }
 185
 186         ret = wm831x_auxadc_read_uv(g_wm831x_power->wm831x, WM831X_AUX_BATT);
 187         return ret / 1000;
 188 }
 189 //EXPORT_SYMBOL_GPL(wm831x_get_batt_voltage);
 190
 191 /*********************************************************************
 192  *              WALL Power
 193  *********************************************************************/
 194 static int wm831x_wall_get_prop(struct power_supply *psy,
 195                                 enum power_supply_property psp,
 196                                 union power_supply_propval *val)
 197 {
 198         struct wm831x_power *wm831x_power = dev_get_drvdata(psy->dev->parent);
 199         struct wm831x *wm831x = wm831x_power->wm831x;
 200         int ret = 0;
 201
 202         switch (psp) {
 203         case POWER_SUPPLY_PROP_ONLINE:
 204                 ret = wm831x_power_check_online(wm831x, WM831X_PWR_WALL, val);
 205                 break;
 206         case POWER_SUPPLY_PROP_VOLTAGE_NOW:
 207                 ret = wm831x_power_read_voltage(wm831x, WM831X_AUX_WALL, val);
 208                 break;
 209         default:
 210                 ret = -EINVAL;
 211                 break;
 212         }
 213
 214         return ret;
 215 }
 216
 217 static enum power_supply_property wm831x_wall_props[] = {
 218         POWER_SUPPLY_PROP_ONLINE,
 219         POWER_SUPPLY_PROP_VOLTAGE_NOW,
 220 };
 221
 222 /*********************************************************************
 223  *              USB Power
 224  *********************************************************************/
 225 static int wm831x_usb_get_prop(struct power_supply *psy,
 226                                enum power_supply_property psp,
 227                                union power_supply_propval *val)
 228 {
 229         struct wm831x_power *wm831x_power = dev_get_drvdata(psy->dev->parent);
 230         struct wm831x *wm831x = wm831x_power->wm831x;
 231         int ret = 0;
 232
 233         switch (psp) {
 234         case POWER_SUPPLY_PROP_ONLINE:
 235                 ret = wm831x_power_check_online(wm831x, WM831X_PWR_USB, val);
 236                 break;
 237         case POWER_SUPPLY_PROP_VOLTAGE_NOW:
 238                 ret = wm831x_power_read_voltage(wm831x, WM831X_AUX_USB, val);
 239                 break;
 240         default:
 241                 ret = -EINVAL;
 242                 break;
 243         }
 244
 245         return ret;
 246 }
 247
 248 static enum power_supply_property wm831x_usb_props[] = {
 249         POWER_SUPPLY_PROP_ONLINE,
 250         POWER_SUPPLY_PROP_VOLTAGE_NOW,
 251 };
 252
 253 /*********************************************************************
 254  *              Battery properties
 255  *********************************************************************/
 256
 257 struct chg_map {
 258         int val;
 259         int reg_val;
 260 };
 261
 262 static struct chg_map trickle_ilims[] = {
 263         {  50, 0 << WM831X_CHG_TRKL_ILIM_SHIFT },
 264         { 100, 1 << WM831X_CHG_TRKL_ILIM_SHIFT },
 265         { 150, 2 << WM831X_CHG_TRKL_ILIM_SHIFT },
 266         { 200, 3 << WM831X_CHG_TRKL_ILIM_SHIFT },
 267 };
 268
 269 static struct chg_map vsels[] = {
 270         { 4050, 0 << WM831X_CHG_VSEL_SHIFT },
 271         { 4100, 1 << WM831X_CHG_VSEL_SHIFT },
 272         { 4150, 2 << WM831X_CHG_VSEL_SHIFT },
 273         { 4200, 3 << WM831X_CHG_VSEL_SHIFT },
 274 };
 275
 276 static struct chg_map fast_ilims[] = {
 277         {    0,  0 << WM831X_CHG_FAST_ILIM_SHIFT },
 278         {   50,  1 << WM831X_CHG_FAST_ILIM_SHIFT },
 279         {  100,  2 << WM831X_CHG_FAST_ILIM_SHIFT },
 280         {  150,  3 << WM831X_CHG_FAST_ILIM_SHIFT },
 281         {  200,  4 << WM831X_CHG_FAST_ILIM_SHIFT },
 282         {  250,  5 << WM831X_CHG_FAST_ILIM_SHIFT },
 283         {  300,  6 << WM831X_CHG_FAST_ILIM_SHIFT },
 284         {  350,  7 << WM831X_CHG_FAST_ILIM_SHIFT },
 285         {  400,  8 << WM831X_CHG_FAST_ILIM_SHIFT },
 286         {  450,  9 << WM831X_CHG_FAST_ILIM_SHIFT },
 287         {  500, 10 << WM831X_CHG_FAST_ILIM_SHIFT },
 288         {  600, 11 << WM831X_CHG_FAST_ILIM_SHIFT },
 289         {  700, 12 << WM831X_CHG_FAST_ILIM_SHIFT },
 290         {  800, 13 << WM831X_CHG_FAST_ILIM_SHIFT },
 291         {  900, 14 << WM831X_CHG_FAST_ILIM_SHIFT },
 292         { 1000, 15 << WM831X_CHG_FAST_ILIM_SHIFT },
 293 };
 294
 295 static struct chg_map eoc_iterms[] = {
 296         { 20, 0 << WM831X_CHG_ITERM_SHIFT },
 297         { 30, 1 << WM831X_CHG_ITERM_SHIFT },
 298         { 40, 2 << WM831X_CHG_ITERM_SHIFT },
 299         { 50, 3 << WM831X_CHG_ITERM_SHIFT },
 300         { 60, 4 << WM831X_CHG_ITERM_SHIFT },
 301         { 70, 5 << WM831X_CHG_ITERM_SHIFT },
 302         { 80, 6 << WM831X_CHG_ITERM_SHIFT },
 303         { 90, 7 << WM831X_CHG_ITERM_SHIFT },
 304 };
 305
 306 static struct chg_map chg_times[] = {
 307         {  60,  0 << WM831X_CHG_TIME_SHIFT },
 308         {  90,  1 << WM831X_CHG_TIME_SHIFT },
 309         { 120,  2 << WM831X_CHG_TIME_SHIFT },
 310         { 150,  3 << WM831X_CHG_TIME_SHIFT },
 311         { 180,  4 << WM831X_CHG_TIME_SHIFT },
 312         { 210,  5 << WM831X_CHG_TIME_SHIFT },
 313         { 240,  6 << WM831X_CHG_TIME_SHIFT },
 314         { 270,  7 << WM831X_CHG_TIME_SHIFT },
 315         { 300,  8 << WM831X_CHG_TIME_SHIFT },
 316         { 330,  9 << WM831X_CHG_TIME_SHIFT },
 317         { 360, 10 << WM831X_CHG_TIME_SHIFT },
 318         { 390, 11 << WM831X_CHG_TIME_SHIFT },
 319         { 420, 12 << WM831X_CHG_TIME_SHIFT },
 320         { 450, 13 << WM831X_CHG_TIME_SHIFT },
 321         { 480, 14 << WM831X_CHG_TIME_SHIFT },
 322         { 510, 15 << WM831X_CHG_TIME_SHIFT },
 323 };
 324
 325 static struct chg_map chg_syslos[] = {
 326         { 2800, 0 << WM831X_CHG_SYSLO_SHIFT},
 327         { 2900, 1 << WM831X_CHG_SYSLO_SHIFT},
 328         { 3000, 2 << WM831X_CHG_SYSLO_SHIFT},
 329         { 3100, 3 << WM831X_CHG_SYSLO_SHIFT},
 330         { 3200, 4 << WM831X_CHG_SYSLO_SHIFT},
 331         { 3300, 5 << WM831X_CHG_SYSLO_SHIFT},
 332         { 3400, 6 << WM831X_CHG_SYSLO_SHIFT},
 333         { 3500, 7 << WM831X_CHG_SYSLO_SHIFT},
 334 };
 335
 336 static struct chg_map chg_sysoks[] = {
 337         { 2800, 0 << WM831X_CHG_SYSOK_SHIFT},
 338         { 2900, 1 << WM831X_CHG_SYSOK_SHIFT},
 339         { 3000, 2 << WM831X_CHG_SYSOK_SHIFT},
 340         { 3100, 3 << WM831X_CHG_SYSOK_SHIFT},
 341         { 3200, 4 << WM831X_CHG_SYSOK_SHIFT},
 342         { 3300, 5 << WM831X_CHG_SYSOK_SHIFT},
 343         { 3400, 6 << WM831X_CHG_SYSOK_SHIFT},
 344         { 3500, 7 << WM831X_CHG_SYSOK_SHIFT},
 345 };
 346
 347 static void wm831x_battey_apply_config(struct wm831x *wm831x,
 348                                        struct chg_map *map, int count, int val,
 349                                        int *reg, const char *name,
 350                                        const char *units)
 351 {
 352         int i;
 353         for (i = 0; i < count; i++)
 354                 if (val == map[i].val)
 355                         break;
 356         if (i == count) {
 357                 dev_err(wm831x->dev, "Invalid %s %d%s\n",
 358                         name, val, units);
 359         } else {
 360                 *reg |= map[i].reg_val;
 361                 dev_dbg(wm831x->dev, "Set %s of %d%s\n", name, val, units);
 362         }
 363 }
 364
 365 static void wm831x_config_battery(struct wm831x *wm831x)
 366 {
 367         struct wm831x_pdata *wm831x_pdata = wm831x->dev->platform_data;
 368         struct wm831x_battery_pdata *pdata;
 369         int ret, reg1, reg2, reg3;
 370
 371         if (!wm831x_pdata || !wm831x_pdata->battery) {
 372                 dev_warn(wm831x->dev,
 373                          "No battery charger configuration\n");
 374                 return;
 375         }
 376
 377         pdata = wm831x_pdata->battery;
 378
 379         reg1 = 0;
 380         reg2 = 0;
 381         reg3 = 0;
 382
 383         if (!pdata->enable) {
 384                 dev_info(wm831x->dev, "Battery charger disabled\n");
 385                 return;
 386         }
 387
 388         reg1 |= WM831X_CHG_ENA;
 389         if (pdata->off_mask)
 390                 reg2 |= WM831X_CHG_OFF_MSK;
 391         if (pdata->fast_enable)
 392                 reg1 |= WM831X_CHG_FAST;
 393
 394         wm831x_battey_apply_config(wm831x, trickle_ilims,
 395                                    ARRAY_SIZE(trickle_ilims),
 396                                    pdata->trickle_ilim, &reg2,
 397                                    "trickle charge current limit", "mA");
 398
 399         wm831x_battey_apply_config(wm831x, vsels, ARRAY_SIZE(vsels),
 400                                    pdata->vsel, &reg2,
 401                                    "target voltage", "mV");
 402
 403         wm831x_battey_apply_config(wm831x, fast_ilims, ARRAY_SIZE(fast_ilims),
 404                                    pdata->fast_ilim, &reg2,
 405                                    "fast charge current limit", "mA");
 406
 407         wm831x_battey_apply_config(wm831x, eoc_iterms, ARRAY_SIZE(eoc_iterms),
 408                                    pdata->eoc_iterm, &reg1,
 409                                    "end of charge current threshold", "mA");
 410
 411         wm831x_battey_apply_config(wm831x, chg_times, ARRAY_SIZE(chg_times),
 412                                    pdata->timeout, &reg2,
 413                                    "charger timeout", "min");
 414
 415         wm831x_battey_apply_config(wm831x, chg_syslos, ARRAY_SIZE(chg_syslos),
 416                                    pdata->syslo, &reg3,
 417                                    "syslo voltage", "mV");
 418
 419         wm831x_battey_apply_config(wm831x, chg_sysoks, ARRAY_SIZE(chg_sysoks),
 420                                    pdata->sysok, &reg3,
 421                                    "sysok voltage", "mV");
 422
 423         ret = wm831x_reg_unlock(wm831x);
 424         if (ret != 0) {
 425                 dev_err(wm831x->dev, "Failed to unlock registers: %d\n", ret);
 426                 return;
 427         }
 428
 429         ret = wm831x_set_bits(wm831x, WM831X_CHARGER_CONTROL_1,
 430                               WM831X_CHG_ENA_MASK |
 431                               WM831X_CHG_FAST_MASK |
 432                               WM831X_CHG_ITERM_MASK,
 433                               reg1);
 434         if (ret != 0) {
 435                 dev_err(wm831x->dev, "Failed to set charger control 1: %d\n",
 436                         ret);
 437         }
 438         ret = wm831x_set_bits(wm831x, WM831X_CHARGER_CONTROL_2,
 439                               WM831X_CHG_OFF_MSK |
 440                               WM831X_CHG_TIME_MASK |
 441                               WM831X_CHG_FAST_ILIM_MASK |
 442                               WM831X_CHG_TRKL_ILIM_MASK |
 443                               WM831X_CHG_VSEL_MASK,
 444                               reg2);
 445         if (ret != 0) {
 446                 dev_err(wm831x->dev, "Failed to set charger control 2: %d\n",
 447                         ret);
 448         }
 449
 450         ret = wm831x_set_bits(wm831x, WM831X_SYSVDD_CONTROL,
 451                                           WM831X_CHG_SYSLO_MASK |
 452                                                   WM831X_CHG_SYSOK_MASK,
 453                                                   reg3);
 454         if (ret < 0) {
 455                 dev_err(wm831x->dev, "Failed to set sysvdd control reg: %d\n",ret);
 456         }
 457
 458         wm831x_reg_lock(wm831x);
 459 }
 460
 461 static int wm831x_bat_check_status(struct wm831x *wm831x, int *status)
 462 {
 463         int ret;
 464
 465         ret = wm831x_reg_read(wm831x, WM831X_SYSTEM_STATUS);
 466         if (ret < 0)
 467                 return ret;
 468
 469         if (ret & WM831X_PWR_SRC_BATT) {
 470                 *status = POWER_SUPPLY_STATUS_DISCHARGING;
 471                 return 0;
 472         }
 473
 474         ret = wm831x_reg_read(wm831x, WM831X_CHARGER_STATUS);
 475         if (ret < 0)
 476                 return ret;
 477
 478
 479         switch (ret & WM831X_CHG_STATE_MASK) {
 480         case WM831X_CHG_STATE_OFF:
 481                 *status = POWER_SUPPLY_STATUS_NOT_CHARGING;
 482                 break;
 483         case WM831X_CHG_STATE_TRICKLE:
 484         case WM831X_CHG_STATE_FAST:
 485                 *status = POWER_SUPPLY_STATUS_CHARGING;
 486                 break;
 487
 488         default:
 489                 *status = POWER_SUPPLY_STATUS_UNKNOWN;
 490                 break;
 491         }
 492
 493         return 0;
 494 }
 495 int wm831x_read_bat_charging_status(void)
 496 {
 497         int ret, status;
 498
 499         if(!g_wm831x_power)
 500         {
 501                 printk("err:%s:g_wm831x_power address is 0\n",__FUNCTION__);
 502                 return -1;
 503         }
 504
 505         ret = wm831x_bat_check_status(g_wm831x_power->wm831x, &status);
 506         if (ret < 0)
 507                 return ret;
 508         if (status == POWER_SUPPLY_STATUS_CHARGING)
 509                 return 1;
 510         return 0;
 511 }
 512
 513 static int wm831x_bat_check_type(struct wm831x *wm831x, int *type)
 514 {
 515         int ret;
 516 #ifdef WM831X_DEBUG
 517         ret = wm831x_reg_read(wm831x, WM831X_POWER_STATE);
 518         if (ret < 0)
 519                 return ret;
 520         WM_BATT_DBG("%s: wm831x power status %#x\n", __FUNCTION__, ret);
 521
 522         ret = wm831x_reg_read(wm831x, WM831X_SYSTEM_STATUS);
 523         if (ret < 0)
 524                 return ret;
 525         WM_BATT_DBG("%s: wm831x system status %#x\n", __FUNCTION__, ret);
 526
 527         ret = wm831x_reg_read(wm831x, WM831X_CHARGER_CONTROL_1);
 528         if (ret < 0)
 529                 return ret;
 530         WM_BATT_DBG("%s: wm831x charger control1 %#x\n", __FUNCTION__, ret);
 531
 532         ret = wm831x_reg_read(wm831x, WM831X_CHARGER_CONTROL_2);
 533         if (ret < 0)
 534                 return ret;
 535         WM_BATT_DBG("%s: wm831x charger control2 %#x\n", __FUNCTION__, ret);
 536
 537         ret = wm831x_reg_read(wm831x, WM831X_CHARGER_STATUS);
 538         if (ret < 0)
 539                 return ret;
 540         WM_BATT_DBG("%s: wm831x charger status %#x\n\n", __FUNCTION__, ret);
 541 #endif
 542
 543         ret = wm831x_reg_read(wm831x, WM831X_CHARGER_STATUS);
 544         if (ret < 0)
 545                 return ret;
 546
 547         switch (ret & WM831X_CHG_STATE_MASK) {
 548         case WM831X_CHG_STATE_TRICKLE:
 549         case WM831X_CHG_STATE_TRICKLE_OT:
 550                 *type = POWER_SUPPLY_CHARGE_TYPE_TRICKLE;
 551                 break;
 552         case WM831X_CHG_STATE_FAST:
 553         case WM831X_CHG_STATE_FAST_OT:
 554                 *type = POWER_SUPPLY_CHARGE_TYPE_FAST;
 555                 break;
 556         default:
 557                 *type = POWER_SUPPLY_CHARGE_TYPE_NONE;
 558                 break;
 559         }
 560
 561         return 0;
 562 }
 563
 564 static int wm831x_bat_check_health(struct wm831x *wm831x, int *health)
 565 {
 566         int ret;
 567
 568         ret = wm831x_reg_read(wm831x, WM831X_CHARGER_STATUS);
 569         if (ret < 0)
 570                 return ret;
 571
 572         if (ret & WM831X_BATT_HOT_STS) {
 573                 *health = POWER_SUPPLY_HEALTH_OVERHEAT;
 574                 return 0;
 575         }
 576
 577         if (ret & WM831X_BATT_COLD_STS) {
 578                 *health = POWER_SUPPLY_HEALTH_COLD;
 579                 return 0;
 580         }
 581
 582         if (ret & WM831X_BATT_OV_STS) {
 583                 *health = POWER_SUPPLY_HEALTH_OVERVOLTAGE;
 584                 return 0;
 585         }
 586
 587         switch (ret & WM831X_CHG_STATE_MASK) {
 588         case WM831X_CHG_STATE_TRICKLE_OT:
 589         case WM831X_CHG_STATE_FAST_OT:
 590                 *health = POWER_SUPPLY_HEALTH_OVERHEAT;
 591                 break;
 592         case WM831X_CHG_STATE_DEFECTIVE:
 593                 *health = POWER_SUPPLY_HEALTH_UNSPEC_FAILURE;
 594                 break;
 595         default:
 596                 *health = POWER_SUPPLY_HEALTH_GOOD;
 597                 break;
 598         }
 599
 600         return 0;
 601 }
 602
 603 static int wm831x_bat_get_prop(struct power_supply *psy,
 604                                enum power_supply_property psp,
 605                                union power_supply_propval *val)
 606 {
 607         struct wm831x_power *wm831x_power = dev_get_drvdata(psy->dev->parent);
 608         struct wm831x *wm831x = wm831x_power->wm831x;
 609         int level, ret = 0;
 610
 611         switch (psp) {
 612         case POWER_SUPPLY_PROP_STATUS:
 613                 ret = wm831x_bat_check_status(wm831x, &val->intval);
 614                 break;
 615         case POWER_SUPPLY_PROP_PRESENT:
 616         case POWER_SUPPLY_PROP_ONLINE:
 617                 ret = wm831x_power_check_online(wm831x, WM831X_PWR_SRC_BATT,
 618                                                 val);
 619                 break;
 620         case POWER_SUPPLY_PROP_VOLTAGE_NOW:
 621                 ret = wm831x_power_read_voltage(wm831x, WM831X_AUX_BATT, val);
 622                 break;
 623         case POWER_SUPPLY_PROP_HEALTH:
 624                 ret = wm831x_bat_check_health(wm831x, &val->intval);
 625                 break;
 626         case POWER_SUPPLY_PROP_CHARGE_TYPE:
 627                 ret = wm831x_bat_check_type(wm831x, &val->intval);
 628                 break;
 629         case POWER_SUPPLY_PROP_CAPACITY:
 630                 ret = wm831x_power_read_voltage(wm831x, WM831X_AUX_BATT, val);
 631                 wm831x_batt_vol_level(wm831x_power, val->intval, &level);
 632                 val->intval = level;
 633                 break;
 634         case POWER_SUPPLY_PROP_TEMP:
 635                 val->intval = 0;
 636                 break;
 637         case POWER_SUPPLY_PROP_TECHNOLOGY:
 638                 val->intval = POWER_SUPPLY_TECHNOLOGY_LION;
 639                 break;
 640         default:
 641                 ret = -EINVAL;
 642                 break;
 643         }
 644
 645         return ret;
 646 }
 647
 648 static enum power_supply_property wm831x_bat_props[] = {
 649         POWER_SUPPLY_PROP_STATUS,
 650         POWER_SUPPLY_PROP_HEALTH,
 651         POWER_SUPPLY_PROP_PRESENT,
 652         POWER_SUPPLY_PROP_VOLTAGE_NOW,
 653         POWER_SUPPLY_PROP_CAPACITY, /* in percents! */
 654         POWER_SUPPLY_PROP_TECHNOLOGY,
 655         POWER_SUPPLY_PROP_TEMP,
 656         POWER_SUPPLY_PROP_CHARGE_TYPE,
 657 };
 658
 659 static const char *wm831x_bat_irqs[] = {
 660         "BATT HOT",
 661         "BATT COLD",
 662         "BATT FAIL",
 663         "OV",
 664         "END",
 665         "TO",
 666         "MODE",
 667         "START",
 668 };
 669
 670 static irqreturn_t wm831x_bat_irq(int irq, void *data)
 671 {
 672         struct wm831x_power *wm831x_power = data;
 673         struct wm831x *wm831x = wm831x_power->wm831x;
 674
 675         dev_dbg(wm831x->dev, "Battery status changed: %d\n", irq);
 676         WM_BATT_DBG("%s:Battery status changed %d\n", __FUNCTION__, irq);
 677         /* The battery charger is autonomous so we don't need to do
 678          * anything except kick user space */
 679         power_supply_changed(&wm831x_power->battery);
 680
 681         return IRQ_HANDLED;
 682 }
 683
 684
 685 /*********************************************************************
 686  *              Initialisation
 687  *********************************************************************/
 688
 689 static irqreturn_t wm831x_syslo_irq(int irq, void *data)
 690 {
 691         struct wm831x_power *wm831x_power = data;
 692         struct wm831x *wm831x = wm831x_power->wm831x;
 693
 694         /* Not much we can actually *do* but tell people for
 695          * posterity, we're probably about to run out of power. */
 696         dev_crit(wm831x->dev, "SYSVDD under voltage\n");
 697         return IRQ_HANDLED;
 698 }
 699
 700 static irqreturn_t wm831x_pwr_src_irq(int irq, void *data)
 701 {
 702         struct wm831x_power *wm831x_power = data;
 703         struct wm831x *wm831x = wm831x_power->wm831x;
 704
 705         dev_dbg(wm831x->dev, "Power source changed\n");
 706         WM_BATT_DBG("%s:Power source changed\n", __FUNCTION__);
 707         /* Just notify for everything - little harm in overnotifying. */
 708         power_supply_changed(&wm831x_power->battery);
 709         power_supply_changed(&wm831x_power->usb);
 710         power_supply_changed(&wm831x_power->wall);
 711
 712
 713         return IRQ_HANDLED;
 714 }
 715
 716 static void wm831x_batt_timer_handler(unsigned long data)
 717 {
 718         struct wm831x_power *wm831x_power = (struct wm831x_power*)data;
 719         schedule_work(&wm831x_power->batt_work);
 720 }
 721
 722 void wm831x_batt_vol_level(struct wm831x_power *wm831x_power, int batt_val, int *level)
 723 {
 724         int i, ret, status;
 725         static int count = 0;
 726     union power_supply_propval val;
 727
 728         ret = wm831x_bat_check_status(wm831x_power->wm831x, &status);
 729         if (status == POWER_SUPPLY_STATUS_CHARGING) {
 730                 for(i = 0; i < batt_num; i++){
 731                         if((batt_chg_step_table[i] <= batt_val) &&
 732                                          (batt_chg_step_table[i+1] > batt_val))
 733                                 break;
 734                 }
 735                 *level = batt_disp_table[i];
 736                 if (batt_val < 3650)
 737                         *level = 0;
 738                 count++;
 739                 if (*level < wm831x_power->priv.old_level && count > 20)
 740                         *level = wm831x_power->priv.old_level;
 741
 742                 if (*level >= 100)
 743                         *level = 97;
 744
 745                 if (*level < 0)
 746                         *level = 0;
 747
 748         }
 749         else {
 750                 for(i = 0; i < batt_num; i++){
 751                         if((batt_step_table[i] <= batt_val) &&
 752                                          (batt_step_table[i+1] > batt_val))
 753                                 break;
 754                 }
 755                 *level = batt_disp_table[i];
 756                 if (batt_val < 3450)
 757                         *level = 0;
 758
 759                 if ((wm831x_power->priv.old_level - *level) > 5)
 760                         *level = wm831x_power->priv.old_level - 5;
 761
 762                 //if (g_read_level_cnt >= 10 && *level > wm831x_power->priv.old_level)
 763                 if (*level > wm831x_power->priv.old_level)
 764                         *level = wm831x_power->priv.old_level;
 765
 766                 if (*level > 100)
 767                         *level = 100;
 768                 if (*level < 0)
 769                         *level = 0;
 770         }
 771 }
 772
 773 static void wm831x_batt_work(struct work_struct *work)
 774 {
 775         int ret, online, status,health,level;
 776     union power_supply_propval val;
 777         struct wm831x_power *power = container_of(work, struct wm831x_power, batt_work);
 778
 779         ret = wm831x_power_check_online(power->wm831x, WM831X_PWR_SRC_BATT, &val);
 780         if (ret < 0) {
 781                 printk("%s: check bat online failer...  err = %d\n", __FUNCTION__, ret);
 782                 return;
 783         }
 784         online = val.intval;
 785
 786         ret = wm831x_bat_check_status(power->wm831x, &status);
 787         if (ret < 0) {
 788                 printk("%s: check bat status failer...  err = %d\n", __FUNCTION__, ret);
 789                 return;
 790         }
 791
 792         ret = wm831x_bat_check_health(power->wm831x, &health);
 793         if (ret < 0) {
 794                 printk("%s: check bat health failer...  err = %d\n", __FUNCTION__, ret);
 795                 return;
 796         }
 797
 798         ret = wm831x_power_read_voltage(power->wm831x, WM831X_AUX_BATT, &val);
 799         if (ret < 0) {
 800                 printk("%s: read bat voltage failer...err = %d\n", __FUNCTION__, ret);
 801                 return;
 802         }
 803         power->priv.voltage = val.intval;
 804
 805         wm831x_batt_vol_level(power, val.intval, &level);
 806         mod_timer(&power->timer, jiffies + msecs_to_jiffies(power->interval));
 807
 808         if (online != power->priv.online || status != power->priv.status
 809                         || health != power->priv.health || level != power->priv.old_level)
 810         {
 811                 power->priv.online    = online;
 812                 power->priv.status    = status;
 813                 power->priv.health    = health;
 814                 power->priv.old_level = level;
 815
 816                 power_supply_changed(&power->battery);
 817         }
 818 }
 819
 820 static __devinit int wm831x_power_probe(struct platform_device *pdev)
 821 {
 822         struct wm831x *wm831x = dev_get_drvdata(pdev->dev.parent);
 823         struct wm831x_power *power;
 824         struct power_supply *usb;
 825         struct power_supply *battery;
 826         struct power_supply *wall;
 827         int ret, irq, i;
 828
 829         power = kzalloc(sizeof(struct wm831x_power), GFP_KERNEL);
 830         if (power == NULL)
 831                 return -ENOMEM;
 832
 833         power->wm831x = wm831x;
 834         platform_set_drvdata(pdev, power);
 835
 836         usb = &power->usb;
 837         battery = &power->battery;
 838         wall = &power->wall;
 839
 840         /* We ignore configuration failures since we can still read back
 841          * the status without enabling the charger.
 842          */
 843         wm831x_config_battery(wm831x);
 844
 845         wall->name = "wm831x-wall";
 846         wall->type = POWER_SUPPLY_TYPE_MAINS;
 847         wall->properties = wm831x_wall_props;
 848         wall->num_properties = ARRAY_SIZE(wm831x_wall_props);
 849         wall->get_property = wm831x_wall_get_prop;
 850         ret = power_supply_register(&pdev->dev, wall);
 851         if (ret)
 852                 goto err_kmalloc;
 853
 854         battery->name = "wm831x-battery";
 855         battery->properties = wm831x_bat_props;
 856         battery->num_properties = ARRAY_SIZE(wm831x_bat_props);
 857         battery->get_property = wm831x_bat_get_prop;
 858         battery->use_for_apm = 1;
 859         ret = power_supply_register(&pdev->dev, battery);
 860         if (ret)
 861                 goto err_wall;
 862
 863         usb->name = "wm831x-usb",
 864         usb->type = POWER_SUPPLY_TYPE_USB;
 865         usb->properties = wm831x_usb_props;
 866         usb->num_properties = ARRAY_SIZE(wm831x_usb_props);
 867         usb->get_property = wm831x_usb_get_prop;
 868         ret = power_supply_register(&pdev->dev, usb);
 869         if (ret)
 870                 goto err_battery;
 871
 872         irq = platform_get_irq_byname(pdev, "SYSLO");
 873         ret = request_threaded_irq(irq, NULL, wm831x_syslo_irq,
 874                                    IRQF_TRIGGER_RISING, "System power low",
 875                                    power);
 876         if (ret != 0) {
 877                 dev_err(&pdev->dev, "Failed to request SYSLO IRQ %d: %d\n",
 878                         irq, ret);
 879                 goto err_usb;
 880         }
 881
 882         irq = platform_get_irq_byname(pdev, "PWR SRC");
 883         ret = request_threaded_irq(irq, NULL, wm831x_pwr_src_irq,
 884                                    IRQF_TRIGGER_RISING, "Power source",
 885                                    power);
 886         if (ret != 0) {
 887                 dev_err(&pdev->dev, "Failed to request PWR SRC IRQ %d: %d\n",
 888                         irq, ret);
 889                 goto err_syslo;
 890         }
 891 #if 0       //Ê¹ÓÃ²éÑ¯µÄ·½Ê½
 892         for (i = 0; i < ARRAY_SIZE(wm831x_bat_irqs); i++) {
 893                 irq = platform_get_irq_byname(pdev, wm831x_bat_irqs[i]);
 894                 ret = request_threaded_irq(irq, NULL, wm831x_bat_irq,
 895                                            IRQF_TRIGGER_RISING,
 896                                            wm831x_bat_irqs[i],
 897                                            power);
 898                 WM_BATT_DBG("%s: %s irq no %d\n", __FUNCTION__, wm831x_bat_irqs[i], irq);
 899                 if (ret != 0) {
 900                         dev_err(&pdev->dev,
 901                                 "Failed to request %s IRQ %d: %d\n",
 902                                 wm831x_bat_irqs[i], irq, ret);
 903                         goto err_bat_irq;
 904                 }
 905         }
 906 #endif
 907         power->interval = TIMER_MS_COUNTS;
 908         power->priv.old_level = 100;
 909         INIT_WORK(&power->batt_work, wm831x_batt_work);
 910         setup_timer(&power->timer, wm831x_batt_timer_handler, (unsigned long)power);
 911         power->timer.expires = jiffies + msecs_to_jiffies(1000);
 912         add_timer(&power->timer);
 913
 914         g_wm831x_power = power;
 915         printk("%s:wm831x_power initialized\n",__FUNCTION__);
 916         return ret;
 917
 918 err_bat_irq:
 919         for (; i >= 0; i--) {
 920                 irq = platform_get_irq_byname(pdev, wm831x_bat_irqs[i]);
 921                 free_irq(irq, power);
 922         }
 923         irq = platform_get_irq_byname(pdev, "PWR SRC");
 924         free_irq(irq, power);
 925 err_syslo:
 926         irq = platform_get_irq_byname(pdev, "SYSLO");
 927         free_irq(irq, power);
 928 err_usb:
 929         power_supply_unregister(usb);
 930 err_battery:
 931         power_supply_unregister(battery);
 932 err_wall:
 933         power_supply_unregister(wall);
 934 err_kmalloc:
 935         kfree(power);
 936         return ret;
 937 }
 938
 939 static __devexit int wm831x_power_remove(struct platform_device *pdev)
 940 {
 941         struct wm831x_power *wm831x_power = platform_get_drvdata(pdev);
 942         int irq, i;
 943
 944         for (i = 0; i < ARRAY_SIZE(wm831x_bat_irqs); i++) {
 945                 irq = platform_get_irq_byname(pdev, wm831x_bat_irqs[i]);
 946                 free_irq(irq, wm831x_power);
 947         }
 948
 949         irq = platform_get_irq_byname(pdev, "PWR SRC");
 950         free_irq(irq, wm831x_power);
 951
 952         irq = platform_get_irq_byname(pdev, "SYSLO");
 953         free_irq(irq, wm831x_power);
 954
 955         power_supply_unregister(&wm831x_power->battery);
 956         power_supply_unregister(&wm831x_power->wall);
 957         power_supply_unregister(&wm831x_power->usb);
 958         kfree(wm831x_power);
 959         return 0;
 960 }
 961
 962 #ifdef CONFIG_PM
 963 static int wm831x_battery_suspend(struct platform_device *dev, pm_message_t state)
 964 {
 965         struct wm831x_power *power = (struct wm831x_power *)platform_get_drvdata(dev);
 966         flush_scheduled_work();
 967         del_timer(&power->timer);
 968         printk("%s\n",__FUNCTION__);
 969         return 0;
 970 }
 971
 972 static int wm831x_battery_resume(struct platform_device *dev)
 973 {
 974         struct wm831x_power *power = (struct wm831x_power *)platform_get_drvdata(dev);
 975         power->timer.expires = jiffies + msecs_to_jiffies(power->interval);
 976         add_timer(&power->timer);
 977         printk("%s\n",__FUNCTION__);
 978         return 0;
 979 }
 980 #else
 981 #define wm831x_battery_suspend NULL
 982 #define wm831x_battery_resume  NULL
 983 #endif
 984
 985 static struct platform_driver wm831x_power_driver = {
 986         .probe = wm831x_power_probe,
 987         .remove = __devexit_p(wm831x_power_remove),
 988         .suspend = wm831x_battery_suspend,
 989         .resume = wm831x_battery_resume,
 990         .driver = {
 991                 .name = "wm831x-power",
 992         },
 993 };
 994
 995 static int __init wm831x_power_init(void)
 996 {
 997         return platform_driver_register(&wm831x_power_driver);
 998 }
 999 module_init(wm831x_power_init);
1000
1001 static void __exit wm831x_power_exit(void)
1002 {
1003         platform_driver_unregister(&wm831x_power_driver);
1004 }
1005 module_exit(wm831x_power_exit);
1006
1007 MODULE_DESCRIPTION("Power supply driver for WM831x PMICs");
1008 MODULE_AUTHOR("Mark Brown <broonie@opensource.wolfsonmicro.com>");
1009 MODULE_LICENSE("GPL");
1010 MODULE_ALIAS("platform:wm831x-power");