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 #include <linux/mfd/wm831x/irq.h>
  22
  23 #define WM831X_DEBUG
  24 #undef  WM831X_DEBUG
  25
  26 #ifdef WM831X_DEBUG
  27 #define WM_BATT_DBG(x...) printk(KERN_INFO x)
  28 #else
  29 #define WM_BATT_DBG(x...)  do {} while (0)
  30 #endif
  31
  32 #define WM831X_CHG_SYSLO_SHIFT   4
  33 #define WM831X_CHG_SYSOK_SHIFT   0
  34 #define WM831X_CHG_SYSLO_MASK  ~(0x7 << 4)
  35 #define WM831X_CHG_SYSOK_MASK  ~(0x7 << 0)
  36
  37 #define batt_num   52
  38
  39 static int batt_step_table[batt_num] = {
  40         3400,3420,3440,3475,3505,3525,
  41         3540,3557,3570,3580,3610,
  42         3630,3640,3652,3662,3672,
  43         3680,3687,3693,3699,3705,
  44         3710,3714,3718,3722,3726,
  45         3730,3734,3738,3742,3746,
  46         3750,3756,3764,3774,3786,
  47         3800,3808,3817,3827,3845,
  48         3950,3964,3982,4002,4026,
  49         4030,4034,4055,4070,4085,4120
  50 };
  51
  52 static int batt_disp_table[batt_num] = {
  53         0,1,2,3,5,7,
  54         9,11,13,15,17,
  55         19,21,23,25,27,
  56         29,31,33,35,37,
  57         39,41,43,45,47,
  58         49,51,53,55,57,
  59         59,61,63,65,67,
  60         69,71,73,75,77,
  61         79,81,83,85,87,
  62         89,91,93,95,97,100
  63 };
  64
  65 static int batt_chg_step_table[batt_num] = {
  66         3520,3525,3575,3600,3620,3644,//+160
  67         3662,3670,3684,3700,3715,//+150
  68         3720,3748,3756,3775,3790,//+140
  69         3810,3814,3818,3822,3825,//+130
  70         3830,3832,3834,3836,3837,//+120
  71         3839,3841,3842,3844,3844,//+110
  72         3855,3860,3864,3871,3890,//+100
  73         3910,3930,3952,3977,3997,//+90
  74         4030,4047,4064,4080,4096,//+80
  75         4132,4144,4150,4170,4195,4200//+70
  76 };
  77
  78
  79
  80 #define TIMER_MS_COUNTS 1000
  81 struct wm_batt_priv_data {
  82         int online;
  83         int status;
  84         int health;
  85         int level;
  86         int temp;
  87         int voltage;
  88 };
  89
  90 struct wm831x_power {
  91         struct wm831x *wm831x;
  92         struct power_supply wall;
  93         struct power_supply usb;
  94         struct power_supply battery;
  95         struct work_struct batt_work;
  96         struct timer_list timer;
  97         struct wm_batt_priv_data batt_info;
  98         struct wake_lock        syslo_wake;
  99         int interval;
 100 };
 101
 102 struct wm831x_power *g_wm831x_power;
 103
 104 static int power_test_sysfs_init(void);
 105 extern void wm831x_batt_vol_level(struct wm831x_power *power, int batt_vol, int *level);
 106 static DEFINE_MUTEX(charging_mutex);
 107 static struct wake_lock batt_wake_lock;
 108
 109 int wm831x_read_on_pin_status(void)
 110 {
 111         int ret;
 112
 113         if(!g_wm831x_power)
 114         {
 115                 printk("err:%s:g_wm831x_power address is 0\n",__FUNCTION__);
 116                 return -1;
 117         }
 118
 119         ret = wm831x_reg_read(g_wm831x_power->wm831x, WM831X_ON_PIN_CONTROL);
 120         if (ret < 0)
 121                 return ret;
 122
 123         return !(ret & WM831X_ON_PIN_STS) ? 1 : 0;
 124 }
 125
 126 static int wm831x_power_check_online(struct wm831x *wm831x, int supply,
 127                                      union power_supply_propval *val)
 128 {
 129         int ret;
 130
 131         ret = wm831x_reg_read(wm831x, WM831X_SYSTEM_STATUS);
 132         if (ret < 0)
 133                 return ret;
 134
 135         if (ret & supply)
 136                 val->intval = 1;
 137         else
 138                 val->intval = 0;
 139
 140         return 0;
 141 }
 142
 143 int wm831x_read_chg_status(void)
 144 {
 145         int ret, usb_chg = 0, wall_chg = 0;
 146
 147         if(!g_wm831x_power)
 148         {
 149                 printk("err:%s:g_wm831x_power address is 0\n",__FUNCTION__);
 150                 return -1;
 151         }
 152
 153         ret = wm831x_reg_read(g_wm831x_power->wm831x, WM831X_SYSTEM_STATUS);
 154         if (ret < 0)
 155                 return ret;
 156
 157         if (ret & WM831X_PWR_USB)
 158                 usb_chg = 1;
 159         if (ret & WM831X_PWR_WALL)
 160                 wall_chg = 1;
 161
 162         return ((usb_chg | wall_chg) ? 1 : 0);
 163 }
 164
 165 static int wm831x_power_read_voltage(struct wm831x *wm831x,
 166                                      enum wm831x_auxadc src,
 167                                      union power_supply_propval *val)
 168 {
 169         int ret;
 170         ret = wm831x_auxadc_read_uv(wm831x, src);
 171         if (ret >= 0)
 172                 val->intval = ret;
 173
 174         return ret ;
 175 }
 176
 177 int wm831x_read_batt_voltage(void)
 178 {
 179         int ret = 0;
 180
 181         if(!g_wm831x_power)
 182         {
 183                 printk("err:%s:g_wm831x_power address is 0\n",__FUNCTION__);
 184                 return -1;
 185         }
 186
 187         ret = wm831x_auxadc_read_uv(g_wm831x_power->wm831x, WM831X_AUX_BATT);
 188         return ret;
 189 }
 190 //EXPORT_SYMBOL_GPL(wm831x_get_batt_voltage);
 191
 192 /*********************************************************************
 193  *              WALL Power
 194  *********************************************************************/
 195 static int wm831x_wall_get_prop(struct power_supply *psy,
 196                                 enum power_supply_property psp,
 197                                 union power_supply_propval *val)
 198 {
 199         struct wm831x_power *wm831x_power = dev_get_drvdata(psy->dev->parent);
 200         struct wm831x *wm831x = wm831x_power->wm831x;
 201         int ret = 0;
 202
 203         switch (psp) {
 204         case POWER_SUPPLY_PROP_ONLINE:
 205                 ret = wm831x_power_check_online(wm831x, WM831X_PWR_WALL, val);
 206                 break;
 207         case POWER_SUPPLY_PROP_VOLTAGE_NOW:
 208                 ret = wm831x_power_read_voltage(wm831x, WM831X_AUX_WALL, val);
 209                 break;
 210         default:
 211                 ret = -EINVAL;
 212                 break;
 213         }
 214
 215         return ret;
 216 }
 217
 218 static enum power_supply_property wm831x_wall_props[] = {
 219         POWER_SUPPLY_PROP_ONLINE,
 220         POWER_SUPPLY_PROP_VOLTAGE_NOW,
 221 };
 222
 223 /*********************************************************************
 224  *              USB Power
 225  *********************************************************************/
 226 static int wm831x_usb_get_prop(struct power_supply *psy,
 227                                enum power_supply_property psp,
 228                                union power_supply_propval *val)
 229 {
 230         struct wm831x_power *wm831x_power = dev_get_drvdata(psy->dev->parent);
 231         struct wm831x *wm831x = wm831x_power->wm831x;
 232         int ret = 0;
 233
 234         switch (psp) {
 235         case POWER_SUPPLY_PROP_ONLINE:
 236                 ret = wm831x_power_check_online(wm831x, WM831X_PWR_USB, val);
 237                 break;
 238         case POWER_SUPPLY_PROP_VOLTAGE_NOW:
 239                 ret = wm831x_power_read_voltage(wm831x, WM831X_AUX_USB, val);
 240                 break;
 241         default:
 242                 ret = -EINVAL;
 243                 break;
 244         }
 245
 246         return ret;
 247 }
 248
 249 static enum power_supply_property wm831x_usb_props[] = {
 250         POWER_SUPPLY_PROP_ONLINE,
 251         POWER_SUPPLY_PROP_VOLTAGE_NOW,
 252 };
 253
 254 /*********************************************************************
 255  *              Battery properties
 256  *********************************************************************/
 257
 258 struct chg_map {
 259         int val;
 260         int reg_val;
 261 };
 262
 263 static struct chg_map trickle_ilims[] = {
 264         {  50, 0 << WM831X_CHG_TRKL_ILIM_SHIFT },
 265         { 100, 1 << WM831X_CHG_TRKL_ILIM_SHIFT },
 266         { 150, 2 << WM831X_CHG_TRKL_ILIM_SHIFT },
 267         { 200, 3 << WM831X_CHG_TRKL_ILIM_SHIFT },
 268 };
 269
 270 static struct chg_map vsels[] = {
 271         { 4050, 0 << WM831X_CHG_VSEL_SHIFT },
 272         { 4100, 1 << WM831X_CHG_VSEL_SHIFT },
 273         { 4150, 2 << WM831X_CHG_VSEL_SHIFT },
 274         { 4200, 3 << WM831X_CHG_VSEL_SHIFT },
 275 };
 276
 277 static struct chg_map fast_ilims[] = {
 278         {    0,  0 << WM831X_CHG_FAST_ILIM_SHIFT },
 279         {   50,  1 << WM831X_CHG_FAST_ILIM_SHIFT },
 280         {  100,  2 << WM831X_CHG_FAST_ILIM_SHIFT },
 281         {  150,  3 << WM831X_CHG_FAST_ILIM_SHIFT },
 282         {  200,  4 << WM831X_CHG_FAST_ILIM_SHIFT },
 283         {  250,  5 << WM831X_CHG_FAST_ILIM_SHIFT },
 284         {  300,  6 << WM831X_CHG_FAST_ILIM_SHIFT },
 285         {  350,  7 << WM831X_CHG_FAST_ILIM_SHIFT },
 286         {  400,  8 << WM831X_CHG_FAST_ILIM_SHIFT },
 287         {  450,  9 << WM831X_CHG_FAST_ILIM_SHIFT },
 288         {  500, 10 << WM831X_CHG_FAST_ILIM_SHIFT },
 289         {  600, 11 << WM831X_CHG_FAST_ILIM_SHIFT },
 290         {  700, 12 << WM831X_CHG_FAST_ILIM_SHIFT },
 291         {  800, 13 << WM831X_CHG_FAST_ILIM_SHIFT },
 292         {  900, 14 << WM831X_CHG_FAST_ILIM_SHIFT },
 293         { 1000, 15 << WM831X_CHG_FAST_ILIM_SHIFT },
 294 };
 295
 296 static struct chg_map eoc_iterms[] = {
 297         { 20, 0 << WM831X_CHG_ITERM_SHIFT },
 298         { 30, 1 << WM831X_CHG_ITERM_SHIFT },
 299         { 40, 2 << WM831X_CHG_ITERM_SHIFT },
 300         { 50, 3 << WM831X_CHG_ITERM_SHIFT },
 301         { 60, 4 << WM831X_CHG_ITERM_SHIFT },
 302         { 70, 5 << WM831X_CHG_ITERM_SHIFT },
 303         { 80, 6 << WM831X_CHG_ITERM_SHIFT },
 304         { 90, 7 << WM831X_CHG_ITERM_SHIFT },
 305 };
 306
 307 static struct chg_map chg_times[] = {
 308         {  60,  0 << WM831X_CHG_TIME_SHIFT },
 309         {  90,  1 << WM831X_CHG_TIME_SHIFT },
 310         { 120,  2 << WM831X_CHG_TIME_SHIFT },
 311         { 150,  3 << WM831X_CHG_TIME_SHIFT },
 312         { 180,  4 << WM831X_CHG_TIME_SHIFT },
 313         { 210,  5 << WM831X_CHG_TIME_SHIFT },
 314         { 240,  6 << WM831X_CHG_TIME_SHIFT },
 315         { 270,  7 << WM831X_CHG_TIME_SHIFT },
 316         { 300,  8 << WM831X_CHG_TIME_SHIFT },
 317         { 330,  9 << WM831X_CHG_TIME_SHIFT },
 318         { 360, 10 << WM831X_CHG_TIME_SHIFT },
 319         { 390, 11 << WM831X_CHG_TIME_SHIFT },
 320         { 420, 12 << WM831X_CHG_TIME_SHIFT },
 321         { 450, 13 << WM831X_CHG_TIME_SHIFT },
 322         { 480, 14 << WM831X_CHG_TIME_SHIFT },
 323         { 510, 15 << WM831X_CHG_TIME_SHIFT },
 324 };
 325
 326 static struct chg_map chg_syslos[] = {
 327         { 2800, 0 << WM831X_CHG_SYSLO_SHIFT},
 328         { 2900, 1 << WM831X_CHG_SYSLO_SHIFT},
 329         { 3000, 2 << WM831X_CHG_SYSLO_SHIFT},
 330         { 3100, 3 << WM831X_CHG_SYSLO_SHIFT},
 331         { 3200, 4 << WM831X_CHG_SYSLO_SHIFT},
 332         { 3300, 5 << WM831X_CHG_SYSLO_SHIFT},
 333         { 3400, 6 << WM831X_CHG_SYSLO_SHIFT},
 334         { 3500, 7 << WM831X_CHG_SYSLO_SHIFT},
 335 };
 336
 337 static struct chg_map chg_sysoks[] = {
 338         { 2800, 0 << WM831X_CHG_SYSOK_SHIFT},
 339         { 2900, 1 << WM831X_CHG_SYSOK_SHIFT},
 340         { 3000, 2 << WM831X_CHG_SYSOK_SHIFT},
 341         { 3100, 3 << WM831X_CHG_SYSOK_SHIFT},
 342         { 3200, 4 << WM831X_CHG_SYSOK_SHIFT},
 343         { 3300, 5 << WM831X_CHG_SYSOK_SHIFT},
 344         { 3400, 6 << WM831X_CHG_SYSOK_SHIFT},
 345         { 3500, 7 << WM831X_CHG_SYSOK_SHIFT},
 346 };
 347
 348 static void wm831x_battey_apply_config(struct wm831x *wm831x,
 349                                        struct chg_map *map, int count, int val,
 350                                        int *reg, const char *name,
 351                                        const char *units)
 352 {
 353         int i;
 354         for (i = 0; i < count; i++)
 355                 if (val == map[i].val)
 356                         break;
 357         if (i == count) {
 358                 dev_err(wm831x->dev, "Invalid %s %d%s\n",
 359                         name, val, units);
 360         } else {
 361                 *reg |= map[i].reg_val;
 362                 dev_dbg(wm831x->dev, "Set %s of %d%s\n", name, val, units);
 363         }
 364 }
 365
 366 static void wm831x_config_battery(struct wm831x *wm831x)
 367 {
 368         struct wm831x_pdata *wm831x_pdata = wm831x->dev->platform_data;
 369         struct wm831x_battery_pdata *pdata;
 370         int ret, reg1, reg2, reg3;
 371
 372         if (!wm831x_pdata || !wm831x_pdata->battery) {
 373                 dev_warn(wm831x->dev,
 374                          "No battery charger configuration\n");
 375                 return;
 376         }
 377
 378         pdata = wm831x_pdata->battery;
 379
 380         reg1 = 0;
 381         reg2 = 0;
 382         reg3 = 0;
 383
 384         if (!pdata->enable) {
 385                 dev_info(wm831x->dev, "Battery charger disabled\n");
 386                 return;
 387         }
 388
 389         reg1 |= WM831X_CHG_ENA;
 390         if (pdata->off_mask)
 391                 reg2 |= WM831X_CHG_OFF_MSK;
 392         if (pdata->fast_enable)
 393                 reg1 |= WM831X_CHG_FAST;
 394
 395         wm831x_battey_apply_config(wm831x, trickle_ilims,
 396                                    ARRAY_SIZE(trickle_ilims),
 397                                    pdata->trickle_ilim, &reg2,
 398                                    "trickle charge current limit", "mA");
 399
 400         wm831x_battey_apply_config(wm831x, vsels, ARRAY_SIZE(vsels),
 401                                    pdata->vsel, &reg2,
 402                                    "target voltage", "mV");
 403
 404         wm831x_battey_apply_config(wm831x, fast_ilims, ARRAY_SIZE(fast_ilims),
 405                                    pdata->fast_ilim, &reg2,
 406                                    "fast charge current limit", "mA");
 407
 408         wm831x_battey_apply_config(wm831x, eoc_iterms, ARRAY_SIZE(eoc_iterms),
 409                                    pdata->eoc_iterm, &reg1,
 410                                    "end of charge current threshold", "mA");
 411
 412         wm831x_battey_apply_config(wm831x, chg_times, ARRAY_SIZE(chg_times),
 413                                    pdata->timeout, &reg2,
 414                                    "charger timeout", "min");
 415
 416         wm831x_battey_apply_config(wm831x, chg_syslos, ARRAY_SIZE(chg_syslos),
 417                                    pdata->syslo, &reg3,
 418                                    "syslo voltage", "mV");
 419
 420         wm831x_battey_apply_config(wm831x, chg_sysoks, ARRAY_SIZE(chg_sysoks),
 421                                    pdata->sysok, &reg3,
 422                                    "sysok voltage", "mV");
 423
 424         ret = wm831x_reg_unlock(wm831x);
 425         if (ret != 0) {
 426                 dev_err(wm831x->dev, "Failed to unlock registers: %d\n", ret);
 427                 return;
 428         }
 429
 430         ret = wm831x_set_bits(wm831x, WM831X_CHARGER_CONTROL_1,
 431                               WM831X_CHG_ENA_MASK |
 432                               WM831X_CHG_FAST_MASK |
 433                               WM831X_CHG_ITERM_MASK,
 434                               reg1);
 435         if (ret != 0) {
 436                 dev_err(wm831x->dev, "Failed to set charger control 1: %d\n",
 437                         ret);
 438         }
 439         ret = wm831x_set_bits(wm831x, WM831X_CHARGER_CONTROL_2,
 440                               WM831X_CHG_OFF_MSK |
 441                               WM831X_CHG_TIME_MASK |
 442                               WM831X_CHG_FAST_ILIM_MASK |
 443                               WM831X_CHG_TRKL_ILIM_MASK |
 444                               WM831X_CHG_VSEL_MASK,
 445                               reg2);
 446         if (ret != 0) {
 447                 dev_err(wm831x->dev, "Failed to set charger control 2: %d\n",
 448                         ret);
 449         }
 450
 451         ret = wm831x_set_bits(wm831x, WM831X_SYSVDD_CONTROL,
 452                                           WM831X_CHG_SYSLO_MASK |
 453                                                   WM831X_CHG_SYSOK_MASK,
 454                                                   reg3);
 455         if (ret < 0) {
 456                 dev_err(wm831x->dev, "Failed to set sysvdd control reg: %d\n",ret);
 457         }
 458
 459         wm831x_reg_lock(wm831x);
 460 }
 461
 462 static int wm831x_bat_check_status(struct wm831x *wm831x, int *status)
 463 {
 464         int ret;
 465
 466         ret = wm831x_reg_read(wm831x, WM831X_SYSTEM_STATUS);
 467         if (ret < 0)
 468                 return ret;
 469
 470         if (ret & WM831X_PWR_SRC_BATT) {
 471                 *status = POWER_SUPPLY_STATUS_DISCHARGING;
 472                 return 0;
 473         }
 474
 475         ret = wm831x_reg_read(wm831x, WM831X_CHARGER_STATUS);
 476         if (ret < 0)
 477                 return ret;
 478
 479
 480         switch (ret & WM831X_CHG_STATE_MASK) {
 481         case WM831X_CHG_STATE_OFF:
 482                 *status = POWER_SUPPLY_STATUS_NOT_CHARGING;
 483                 break;
 484         case WM831X_CHG_STATE_TRICKLE:
 485         case WM831X_CHG_STATE_FAST:
 486                 *status = POWER_SUPPLY_STATUS_CHARGING;
 487                 break;
 488
 489         default:
 490                 *status = POWER_SUPPLY_STATUS_UNKNOWN;
 491                 break;
 492         }
 493
 494         return 0;
 495 }
 496 int wm831x_read_bat_charging_status(void)
 497 {
 498         int ret, status;
 499
 500         if(!g_wm831x_power)
 501         {
 502                 printk("err:%s:g_wm831x_power address is 0\n",__FUNCTION__);
 503                 return -1;
 504         }
 505
 506         ret = wm831x_bat_check_status(g_wm831x_power->wm831x, &status);
 507         if (ret < 0)
 508                 return ret;
 509         if (status == POWER_SUPPLY_STATUS_CHARGING)
 510                 return 1;
 511         return 0;
 512 }
 513
 514 static int wm831x_bat_check_type(struct wm831x *wm831x, int *type)
 515 {
 516         int ret;
 517 #ifdef WM831X_DEBUG_0
 518         ret = wm831x_reg_read(wm831x, WM831X_POWER_STATE);
 519         if (ret < 0)
 520                 return ret;
 521         WM_BATT_DBG("%s: wm831x power status %#x\n", __FUNCTION__, ret);
 522
 523         ret = wm831x_reg_read(wm831x, WM831X_SYSTEM_STATUS);
 524         if (ret < 0)
 525                 return ret;
 526         WM_BATT_DBG("%s: wm831x system status %#x\n", __FUNCTION__, ret);
 527
 528         ret = wm831x_reg_read(wm831x, WM831X_CHARGER_CONTROL_1);
 529         if (ret < 0)
 530                 return ret;
 531         WM_BATT_DBG("%s: wm831x charger control1 %#x\n", __FUNCTION__, ret);
 532
 533         ret = wm831x_reg_read(wm831x, WM831X_CHARGER_CONTROL_2);
 534         if (ret < 0)
 535                 return ret;
 536         WM_BATT_DBG("%s: wm831x charger control2 %#x\n", __FUNCTION__, ret);
 537
 538         ret = wm831x_reg_read(wm831x, WM831X_CHARGER_STATUS);
 539         if (ret < 0)
 540                 return ret;
 541         WM_BATT_DBG("%s: wm831x charger status %#x\n\n", __FUNCTION__, ret);
 542 #endif
 543
 544         ret = wm831x_reg_read(wm831x, WM831X_CHARGER_STATUS);
 545         if (ret < 0)
 546                 return ret;
 547
 548         switch (ret & WM831X_CHG_STATE_MASK) {
 549         case WM831X_CHG_STATE_TRICKLE:
 550         case WM831X_CHG_STATE_TRICKLE_OT:
 551                 *type = POWER_SUPPLY_CHARGE_TYPE_TRICKLE;
 552                 break;
 553         case WM831X_CHG_STATE_FAST:
 554         case WM831X_CHG_STATE_FAST_OT:
 555                 *type = POWER_SUPPLY_CHARGE_TYPE_FAST;
 556                 break;
 557         default:
 558                 *type = POWER_SUPPLY_CHARGE_TYPE_NONE;
 559                 break;
 560         }
 561
 562         return 0;
 563 }
 564
 565 static int wm831x_bat_check_health(struct wm831x *wm831x, int *health)
 566 {
 567         int ret;
 568
 569         ret = wm831x_reg_read(wm831x, WM831X_CHARGER_STATUS);
 570         if (ret < 0)
 571                 return ret;
 572
 573         if (ret & WM831X_BATT_HOT_STS) {
 574                 *health = POWER_SUPPLY_HEALTH_OVERHEAT;
 575                 return 0;
 576         }
 577
 578         if (ret & WM831X_BATT_COLD_STS) {
 579                 *health = POWER_SUPPLY_HEALTH_COLD;
 580                 return 0;
 581         }
 582
 583         if (ret & WM831X_BATT_OV_STS) {
 584                 *health = POWER_SUPPLY_HEALTH_OVERVOLTAGE;
 585                 return 0;
 586         }
 587
 588         switch (ret & WM831X_CHG_STATE_MASK) {
 589         case WM831X_CHG_STATE_TRICKLE_OT:
 590         case WM831X_CHG_STATE_FAST_OT:
 591                 *health = POWER_SUPPLY_HEALTH_OVERHEAT;
 592                 break;
 593         case WM831X_CHG_STATE_DEFECTIVE:
 594                 *health = POWER_SUPPLY_HEALTH_UNSPEC_FAILURE;
 595                 break;
 596         default:
 597                 *health = POWER_SUPPLY_HEALTH_GOOD;
 598                 break;
 599         }
 600
 601         return 0;
 602 }
 603
 604 static int wm831x_bat_get_prop(struct power_supply *psy,
 605                                enum power_supply_property psp,
 606                                union power_supply_propval *val)
 607 {
 608         struct wm831x_power *wm831x_power = dev_get_drvdata(psy->dev->parent);
 609         struct wm831x *wm831x = wm831x_power->wm831x;
 610         int  ret = 0;
 611
 612         switch (psp) {
 613         case POWER_SUPPLY_PROP_STATUS:
 614                 ret = wm831x_bat_check_status(wm831x, &val->intval);
 615                 //val->intval = wm831x_power->batt_info.status;
 616                 break;
 617         case POWER_SUPPLY_PROP_PRESENT:
 618         //case POWER_SUPPLY_PROP_ONLINE:
 619                 //ret = wm831x_power_check_online(wm831x, WM831X_PWR_SRC_BATT, val);
 620                 val->intval = wm831x_power->batt_info.online;
 621                 break;
 622         case POWER_SUPPLY_PROP_VOLTAGE_NOW:
 623                 //ret = wm831x_power_read_voltage(wm831x, WM831X_AUX_BATT, val);
 624                 val->intval = wm831x_power->batt_info.voltage;//uV
 625                 break;
 626         case POWER_SUPPLY_PROP_HEALTH:
 627                 //ret = wm831x_bat_check_health(wm831x, &val->intval);
 628                 val->intval = wm831x_power->batt_info.health;
 629                 break;
 630         case POWER_SUPPLY_PROP_CHARGE_TYPE:
 631                 ret = wm831x_bat_check_type(wm831x, &val->intval);
 632                 break;
 633         case POWER_SUPPLY_PROP_CAPACITY:
 634                 //ret = wm831x_power_read_voltage(wm831x, WM831X_AUX_BATT, val);
 635                 //wm831x_batt_vol_level(wm831x_power, val->intval, &level);
 636                 //val->intval = level;
 637                 val->intval = wm831x_power->batt_info.level;
 638                 break;
 639         case POWER_SUPPLY_PROP_TEMP:
 640                 val->intval = 0;
 641                 break;
 642         case POWER_SUPPLY_PROP_TECHNOLOGY:
 643                 val->intval = POWER_SUPPLY_TECHNOLOGY_LION;
 644                 break;
 645         default:
 646                 ret = -EINVAL;
 647                 break;
 648         }
 649
 650         return ret;
 651 }
 652
 653 static enum power_supply_property wm831x_bat_props[] = {
 654         POWER_SUPPLY_PROP_STATUS,
 655         POWER_SUPPLY_PROP_HEALTH,
 656         POWER_SUPPLY_PROP_PRESENT,
 657         POWER_SUPPLY_PROP_VOLTAGE_NOW,
 658         POWER_SUPPLY_PROP_CAPACITY, /* in percents! */
 659         POWER_SUPPLY_PROP_TECHNOLOGY,
 660         POWER_SUPPLY_PROP_TEMP,
 661         POWER_SUPPLY_PROP_CHARGE_TYPE,
 662 };
 663
 664 #ifdef CONFIG_WM831X_WITH_BATTERY
 665 static const char *wm831x_bat_irqs[] = {
 666         "BATT HOT",
 667         "BATT COLD",
 668         "BATT FAIL",
 669         "OV",
 670         "END",
 671         "TO",
 672         "MODE",
 673         "START",
 674 };
 675
 676 static irqreturn_t wm831x_bat_irq(int irq, void *data)
 677 {
 678         struct wm831x_power *wm831x_power = data;
 679         struct wm831x *wm831x = wm831x_power->wm831x;
 680         int irq0;
 681
 682         irq0 = wm831x->irq_base + WM831X_IRQ_CHG_BATT_HOT + 1;
 683         dev_crit(wm831x->dev, "battery changed: i=%d\n", irq-irq0);
 684
 685         /* The battery charger is autonomous so we don't need to do
 686          * anything except kick user space */
 687         power_supply_changed(&wm831x_power->battery);
 688
 689         return IRQ_HANDLED;
 690 }
 691 #endif
 692
 693 /*********************************************************************
 694  *              Initialisation
 695  *********************************************************************/
 696
 697 static irqreturn_t wm831x_syslo_irq(int irq, void *data)
 698 {
 699         struct wm831x_power *wm831x_power = data;
 700         struct wm831x *wm831x = wm831x_power->wm831x;
 701
 702         /* Not much we can actually *do* but tell people for
 703          * posterity, we're probably about to run out of power. */
 704         dev_crit(wm831x->dev, "SYSVDD under voltage and wake lock 60s\n");
 705         wake_lock_timeout(&wm831x_power->syslo_wake,60*HZ);//wait for android closing system
 706         return IRQ_HANDLED;
 707 }
 708
 709 static irqreturn_t wm831x_pwr_src_irq(int irq, void *data)
 710 {
 711         struct wm831x_power *wm831x_power = data;
 712         struct wm831x *wm831x = wm831x_power->wm831x;
 713
 714         wake_lock_timeout(&batt_wake_lock, 30 * HZ);
 715         dev_dbg(wm831x->dev, "Power source changed\n");
 716         WM_BATT_DBG("%s:Power source changed\n", __FUNCTION__);
 717         /* Just notify for everything - little harm in overnotifying. */
 718         power_supply_changed(&wm831x_power->battery);
 719         power_supply_changed(&wm831x_power->usb);
 720         power_supply_changed(&wm831x_power->wall);
 721
 722
 723         return IRQ_HANDLED;
 724 }
 725
 726 static void wm831x_batt_timer_handler(unsigned long data)
 727 {
 728         struct wm831x_power *wm831x_power = (struct wm831x_power*)data;
 729         schedule_work(&wm831x_power->batt_work);
 730         mod_timer(&wm831x_power->timer, jiffies + msecs_to_jiffies(wm831x_power->interval));
 731 }
 732
 733 void wm831x_batt_vol_level(struct wm831x_power *wm831x_power, int batt_vol, int *level)
 734 {
 735         int i, ret, status;
 736         static int chg_plus = 1000;
 737         static int chg_minus = 1000;
 738         static int chg_curr = 0;
 739         static int chg_num = 60;
 740         static int disp_plus = 1000;
 741         static int disp_minus = 1000;
 742         static int disp_minus2 = 1000;
 743         static int disp_curr = 0;
 744         static int disp_num = 50;
 745         static int batt_level_all = 0;
 746         static int batt_level[20];
 747         static int avr_num = 0;
 748         static int avr_int = 0;
 749
 750
 751         *level = wm831x_power->batt_info.level;
 752         ret = wm831x_bat_check_status(wm831x_power->wm831x, &status);
 753         if (ret < 0) {
 754                 printk("%s: check bat status failer...err = %d\n", __FUNCTION__, ret);
 755                 return;
 756         }
 757
 758         if (status == POWER_SUPPLY_STATUS_NOT_CHARGING
 759                         && batt_vol >= batt_step_table[batt_num-1]) {
 760                 *level = 100;
 761                 return;
 762         }
 763
 764         if (status == POWER_SUPPLY_STATUS_CHARGING)
 765         {
 766                 disp_plus = 0;
 767                 disp_minus = 0;
 768                 disp_minus2 = 0;
 769                 disp_curr = 0;
 770                 for(i = 0; i < batt_num; i++){
 771                         if(batt_vol >= batt_chg_step_table[i] &&
 772                                          batt_vol < batt_chg_step_table[i+1])
 773                                 break;
 774                 }
 775                 if(batt_vol <= batt_chg_step_table[0])
 776                         i = 0;
 777                 if(batt_vol >= batt_chg_step_table[batt_num-1])
 778                         i = batt_num-1;
 779                 if(avr_int==0){
 780                         batt_level[avr_num] = batt_disp_table[i];
 781                         batt_level_all += batt_level[avr_num];
 782                         avr_num++;
 783                         if(avr_num >= 20)
 784                         {
 785                                 avr_num = 0;
 786                                 avr_int = 1;
 787                         }
 788                         else
 789                         {
 790                                 *level = batt_disp_table[i];
 791                                 return 0;
 792                         }
 793                 }
 794                 else {
 795                         batt_level_all -= batt_level[avr_num];
 796                         batt_level[avr_num]=batt_disp_table[i];
 797                         batt_level_all += batt_level[avr_num];
 798                         avr_num++;
 799                 }
 800                 if(avr_num >= 20)
 801                         avr_num = 0;
 802                 *level = batt_level_all/20;
 803                 if ((chg_plus == 1000) && (chg_minus == 1000))
 804                 {
 805                         *level = *level;
 806                         chg_plus = 0;
 807                         chg_minus = 0;
 808                         chg_curr = 0;
 809
 810                 }
 811                 else
 812                 {
 813
 814                         if (*level >= (wm831x_power->batt_info.level+1))
 815                         {
 816                                 chg_minus = 0;
 817                                 chg_curr = 0;
 818                                 if(*level < 85)
 819                                         chg_num =10;
 820                                 else
 821                                         chg_num = 5;
 822                                 if (++chg_plus > chg_num)
 823                                 {
 824                                         *level = wm831x_power->batt_info.level + 1;
 825                                         chg_plus = 0;
 826
 827                                 }
 828                                 else
 829                                 {
 830                                         *level = wm831x_power->batt_info.level;
 831                                 }
 832                         }
 833                         else
 834                         {
 835                                 chg_plus = 0;
 836                                 chg_minus = 0;
 837                                 chg_curr = 0;
 838                                 *level = wm831x_power->batt_info.level;
 839                         }
 840                 }
 841
 842
 843                 if (*level >= 100)
 844                         *level = 100;
 845                 if (*level < 0)
 846                         *level = 0;
 847         }
 848         else
 849         {
 850                 chg_plus = 0;
 851                 chg_minus = 0;
 852                 chg_curr = 0;
 853                 for(i = 0; i < batt_num; i++){
 854                         if(batt_vol >= batt_step_table[i] &&
 855                                          batt_vol < batt_step_table[i+1])
 856                                 break;
 857                 }
 858                 if(batt_vol <= batt_step_table[0])
 859                         i = 0;
 860                 if(batt_vol >= batt_step_table[batt_num-1])
 861                         i = batt_num-1;
 862                 if(avr_int==0){
 863                         batt_level[avr_num] = batt_disp_table[i];
 864                         batt_level_all += batt_level[avr_num];
 865                         avr_num++;
 866                         if(avr_num >= 20)
 867                         {
 868                                 avr_num = 0;
 869                                 avr_int = 1;
 870                         }
 871                         else
 872                         {
 873                                 *level = batt_disp_table[i];
 874                                 return 0;
 875                         }
 876                 }
 877                 else {
 878                         batt_level_all -= batt_level[avr_num];
 879                         batt_level[avr_num]=batt_disp_table[i];
 880                         batt_level_all += batt_level[avr_num];
 881                         avr_num++;
 882                 }
 883                 if(avr_num >= 20)
 884                         avr_num = 0;
 885                 *level = batt_level_all/20;
 886                 if ((disp_plus == 1000) && (disp_minus == 1000))
 887                 {
 888                         *level = *level;
 889                         disp_plus = 0;
 890                         disp_minus = 0;
 891                         disp_minus2 =0;
 892                         disp_curr = 0;
 893                 }
 894                 else
 895                 {
 896                         if(*level <= (wm831x_power ->batt_info.level -20))
 897                         {
 898                                 disp_plus = 0;
 899                                 disp_curr = 0;
 900                                 disp_minus2 = 0;
 901                                 disp_num = 1;
 902                                  if (++disp_minus > disp_num)
 903                                 {
 904                                         *level = wm831x_power->batt_info.level - 20;
 905                                         disp_minus = 0;
 906                                 }
 907                                 else
 908                                 {
 909                                         *level = wm831x_power->batt_info.level;
 910                                 }
 911                         }
 912                         else if (*level <= (wm831x_power->batt_info.level-1))
 913                         {
 914                                 disp_plus = 0;
 915                                 disp_curr = 0;
 916                                 disp_minus = 0;
 917                                 if((*level < 17) || (*level > 85))
 918                                         disp_num = 30;
 919                                 else
 920                                         disp_num = 80;
 921
 922                                  if (++disp_minus2 > disp_num)
 923                                 {
 924                                         *level = wm831x_power->batt_info.level - 1;
 925                                         disp_minus2 = 0;
 926                                 }
 927                                 else
 928                                 {
 929
 930                                         *level = wm831x_power->batt_info.level;
 931                                 }
 932                         }
 933                         else
 934                         {
 935                                 disp_plus = 0;
 936                                 disp_minus = 0;
 937                                 disp_minus2 = 0;
 938                                 disp_curr = 0;
 939                                 *level = wm831x_power->batt_info.level;
 940                         }
 941                 }
 942
 943                 if (*level >= 100)
 944                         *level = 100;
 945                 if (*level < 0)
 946                         *level = 0;
 947         }
 948 }
 949
 950 static void wm831x_batt_work(struct work_struct *work)
 951 {
 952         int online, status,health,level, ret;
 953     union power_supply_propval val;
 954         struct wm831x_power *power = container_of(work, struct wm831x_power, batt_work);
 955
 956         ret = wm831x_power_check_online(power->wm831x, WM831X_PWR_SRC_BATT, &val);
 957         if (ret < 0) {
 958                 printk("%s: check bat online failer...  err = %d\n", __FUNCTION__, ret);
 959                 return;
 960         }
 961         online = val.intval;
 962
 963         ret = wm831x_bat_check_status(power->wm831x, &status);
 964         if (ret < 0) {
 965                 printk("%s: check bat status failer...  err = %d\n", __FUNCTION__, ret);
 966                 return;
 967         }
 968
 969         ret = wm831x_bat_check_health(power->wm831x, &health);
 970         if (ret < 0) {
 971                 printk("%s: check bat health failer...  err = %d\n", __FUNCTION__, ret);
 972                 return;
 973         }
 974
 975         ret = wm831x_power_read_voltage(power->wm831x, WM831X_AUX_BATT, &val);
 976         if (ret < 0) {
 977                 printk("%s: read bat voltage failer...err = %d\n", __FUNCTION__, ret);
 978                 return;
 979         }
 980         power->batt_info.voltage = val.intval;
 981
 982         wm831x_batt_vol_level(power, val.intval / 1000, &level);
 983         //mod_timer(&power->timer, jiffies + msecs_to_jiffies(power->interval));
 984
 985         if (online != power->batt_info.online || status != power->batt_info.status
 986                         || health != power->batt_info.health || level != power->batt_info.level)
 987         {
 988                 power->batt_info.online = online;
 989                 power->batt_info.status = status;
 990                 power->batt_info.health = health;
 991                 power->batt_info.level  = level;
 992
 993                 power_supply_changed(&power->battery);
 994         }
 995
 996 }
 997
 998 #ifdef CONFIG_POWER_ON_CHARGER_DISPLAY
 999 static void wm831x_batt_check(struct wm831x_power *power)
1000 {
1001         int online, status,health,level, ret;
1002         union power_supply_propval val;
1003 //      struct wm831x_power *power = container_of(work, struct wm831x_power, batt_work);
1004
1005         ret = wm831x_power_check_online(power->wm831x, WM831X_PWR_SRC_BATT, &val);
1006         if (ret < 0) {
1007                 printk("%s: check bat online failer...  err = %d\n", __FUNCTION__, ret);
1008                 return;
1009         }
1010         online = val.intval;
1011
1012         ret = wm831x_bat_check_status(power->wm831x, &status);
1013         if (ret < 0) {
1014                 printk("%s: check bat status failer...  err = %d\n", __FUNCTION__, ret);
1015                 return;
1016         }
1017
1018         ret = wm831x_bat_check_health(power->wm831x, &health);
1019         if (ret < 0) {
1020                 printk("%s: check bat health failer...  err = %d\n", __FUNCTION__, ret);
1021                 return;
1022         }
1023
1024         ret = wm831x_power_read_voltage(power->wm831x, WM831X_AUX_BATT, &val);
1025         if (ret < 0) {
1026                 printk("%s: read bat voltage failer...err = %d\n", __FUNCTION__, ret);
1027                 return;
1028         }
1029         power->batt_info.voltage = val.intval;
1030
1031         wm831x_batt_vol_level(power, val.intval / 1000, &level);
1032         //mod_timer(&power->timer, jiffies + msecs_to_jiffies(power->interval));
1033
1034         if (online != power->batt_info.online || status != power->batt_info.status
1035                         || health != power->batt_info.health || level != power->batt_info.level)
1036         {
1037                 power->batt_info.online = online;
1038                 power->batt_info.status = status;
1039                 power->batt_info.health = health;
1040                 power->batt_info.level  = level;
1041
1042                 power_supply_changed(&power->battery);
1043         }
1044 }
1045 #endif
1046
1047
1048 static __devinit int wm831x_power_probe(struct platform_device *pdev)
1049 {
1050         struct wm831x *wm831x = dev_get_drvdata(pdev->dev.parent);
1051         struct wm831x_power *power;
1052         struct power_supply *usb;
1053         struct power_supply *battery;
1054         struct power_supply *wall;
1055         int ret, irq;
1056
1057         power = kzalloc(sizeof(struct wm831x_power), GFP_KERNEL);
1058         if (power == NULL)
1059                 return -ENOMEM;
1060
1061         power->wm831x = wm831x;
1062         platform_set_drvdata(pdev, power);
1063
1064         usb = &power->usb;
1065         battery = &power->battery;
1066         wall = &power->wall;
1067
1068         /* We ignore configuration failures since we can still read back
1069          * the status without enabling the charger.
1070          */
1071         wm831x_config_battery(wm831x);
1072         wake_lock_init(&batt_wake_lock, WAKE_LOCK_SUSPEND, "batt_lock");
1073
1074         wall->name = "wm831x-wall";
1075         wall->type = POWER_SUPPLY_TYPE_MAINS;
1076         wall->properties = wm831x_wall_props;
1077         wall->num_properties = ARRAY_SIZE(wm831x_wall_props);
1078         wall->get_property = wm831x_wall_get_prop;
1079         ret = power_supply_register(&pdev->dev, wall);
1080         if (ret)
1081                 goto err_kmalloc;
1082
1083         battery->name = "wm831x-battery";
1084         battery->properties = wm831x_bat_props;
1085         battery->num_properties = ARRAY_SIZE(wm831x_bat_props);
1086         battery->get_property = wm831x_bat_get_prop;
1087         battery->use_for_apm = 1;
1088         ret = power_supply_register(&pdev->dev, battery);
1089         if (ret)
1090                 goto err_wall;
1091
1092         usb->name = "wm831x-usb",
1093         usb->type = POWER_SUPPLY_TYPE_USB;
1094         usb->properties = wm831x_usb_props;
1095         usb->num_properties = ARRAY_SIZE(wm831x_usb_props);
1096         usb->get_property = wm831x_usb_get_prop;
1097         ret = power_supply_register(&pdev->dev, usb);
1098         if (ret)
1099                 goto err_battery;
1100
1101         irq = platform_get_irq_byname(pdev, "SYSLO");
1102         ret = request_threaded_irq(irq, NULL, wm831x_syslo_irq,
1103                                    IRQF_TRIGGER_RISING, "System power low",
1104                                    power);
1105         if (ret != 0) {
1106                 dev_err(&pdev->dev, "Failed to request SYSLO IRQ %d: %d\n",
1107                         irq, ret);
1108                 goto err_usb;
1109         }
1110
1111         irq = platform_get_irq_byname(pdev, "PWR SRC");
1112         ret = request_threaded_irq(irq, NULL, wm831x_pwr_src_irq,
1113                                    IRQF_TRIGGER_RISING, "Power source",
1114                                    power);
1115         if (ret != 0) {
1116                 dev_err(&pdev->dev, "Failed to request PWR SRC IRQ %d: %d\n",
1117                         irq, ret);
1118                 goto err_syslo;
1119         }
1120
1121 #ifdef CONFIG_WM831X_WITH_BATTERY
1122         int i;
1123         for (i = 0; i < ARRAY_SIZE(wm831x_bat_irqs); i++) {
1124                 irq = platform_get_irq_byname(pdev, wm831x_bat_irqs[i]);
1125                 ret = request_threaded_irq(irq, NULL, wm831x_bat_irq,
1126                                            IRQF_TRIGGER_RISING,
1127                                            wm831x_bat_irqs[i],
1128                                            power);
1129                 WM_BATT_DBG("%s: %s irq no %d\n", __FUNCTION__, wm831x_bat_irqs[i], irq);
1130                 if (ret != 0) {
1131                         dev_err(&pdev->dev,
1132                                 "Failed to request %s IRQ %d: %d\n",
1133                                 wm831x_bat_irqs[i], irq, ret);
1134                         goto err_bat_irq;
1135                 }
1136         }
1137 #endif
1138
1139         power->interval = TIMER_MS_COUNTS;
1140         power->batt_info.level = 100;
1141         power->batt_info.voltage   = 4200000;
1142         power->batt_info.online    = 1;
1143         power->batt_info.status    = POWER_SUPPLY_STATUS_DISCHARGING;
1144         power->batt_info.health    = POWER_SUPPLY_HEALTH_GOOD;
1145
1146         wake_lock_init(&power->syslo_wake, WAKE_LOCK_SUSPEND, "wm831x_syslo_wake");
1147         INIT_WORK(&power->batt_work, wm831x_batt_work);
1148         setup_timer(&power->timer, wm831x_batt_timer_handler, (unsigned long)power);
1149         power->timer.expires = jiffies + msecs_to_jiffies(1000);
1150         add_timer(&power->timer);
1151
1152         g_wm831x_power = power;
1153 #ifdef CONFIG_POWER_ON_CHARGER_DISPLAY
1154         wm831x_batt_check(power);//xsf
1155 #endif
1156
1157         printk("%s:wm831x_power initialized\n",__FUNCTION__);
1158         power_test_sysfs_init();
1159         return ret;
1160
1161 #ifdef CONFIG_WM831X_WITH_BATTERY
1162 err_bat_irq:
1163         for (; i >= 0; i--) {
1164                 irq = platform_get_irq_byname(pdev, wm831x_bat_irqs[i]);
1165                 free_irq(irq, power);
1166         }
1167         irq = platform_get_irq_byname(pdev, "PWR SRC");
1168         free_irq(irq, power);
1169 #endif
1170
1171 err_syslo:
1172         irq = platform_get_irq_byname(pdev, "SYSLO");
1173         free_irq(irq, power);
1174 err_usb:
1175         power_supply_unregister(usb);
1176 err_battery:
1177         power_supply_unregister(battery);
1178 err_wall:
1179         power_supply_unregister(wall);
1180 err_kmalloc:
1181         kfree(power);
1182         return ret;
1183 }
1184
1185 static __devexit int wm831x_power_remove(struct platform_device *pdev)
1186 {
1187         struct wm831x_power *wm831x_power = platform_get_drvdata(pdev);
1188         int irq;
1189 #ifdef CONFIG_WM831X_WITH_BATTERY
1190         int i;
1191         for (i = 0; i < ARRAY_SIZE(wm831x_bat_irqs); i++) {
1192                 irq = platform_get_irq_byname(pdev, wm831x_bat_irqs[i]);
1193                 free_irq(irq, wm831x_power);
1194         }
1195 #endif
1196         irq = platform_get_irq_byname(pdev, "PWR SRC");
1197         free_irq(irq, wm831x_power);
1198
1199         irq = platform_get_irq_byname(pdev, "SYSLO");
1200         free_irq(irq, wm831x_power);
1201
1202         power_supply_unregister(&wm831x_power->battery);
1203         power_supply_unregister(&wm831x_power->wall);
1204         power_supply_unregister(&wm831x_power->usb);
1205         kfree(wm831x_power);
1206         return 0;
1207 }
1208
1209 #ifdef CONFIG_PM
1210 static int wm831x_battery_suspend(struct platform_device *dev, pm_message_t state)
1211 {
1212         struct wm831x_power *power = (struct wm831x_power *)platform_get_drvdata(dev);
1213         flush_scheduled_work();
1214         del_timer(&power->timer);
1215         return 0;
1216 }
1217
1218 static int wm831x_battery_resume(struct platform_device *dev)
1219 {
1220         struct wm831x_power *power = (struct wm831x_power *)platform_get_drvdata(dev);
1221         power->timer.expires = jiffies + msecs_to_jiffies(power->interval);
1222         add_timer(&power->timer);
1223         return 0;
1224 }
1225 #else
1226 #define wm831x_battery_suspend NULL
1227 #define wm831x_battery_resume  NULL
1228 #endif
1229
1230 static struct platform_driver wm831x_power_driver = {
1231         .probe = wm831x_power_probe,
1232         .remove = __devexit_p(wm831x_power_remove),
1233         .suspend = wm831x_battery_suspend,
1234         .resume = wm831x_battery_resume,
1235         .driver = {
1236                 .name = "wm831x-power",
1237         },
1238 };
1239 static int __init wm831x_power_init(void)
1240 {
1241         return platform_driver_register(&wm831x_power_driver);
1242 }
1243 #ifndef CONFIG_POWER_ON_CHARGER_DISPLAY
1244 module_init(wm831x_power_init);
1245 #else
1246 subsys_initcall(wm831x_power_init);
1247 #endif
1248
1249 static void __exit wm831x_power_exit(void)
1250 {
1251         platform_driver_unregister(&wm831x_power_driver);
1252 }
1253 module_exit(wm831x_power_exit);
1254
1255
1256 static ssize_t power_prop_show(struct device *dev,
1257                 struct device_attribute *attr, char *buf)
1258 {
1259         ssize_t ret = 0;
1260         int level, power_status, system_status, chg_ctl1, chg_ctl2, chg_status;
1261     union power_supply_propval val;
1262
1263         if (!g_wm831x_power)
1264                 return -1;
1265         power_status = wm831x_reg_read(g_wm831x_power->wm831x, WM831X_POWER_STATE);
1266         if (power_status < 0)
1267                 return power_status;
1268         //printk("wm831x power status %#x\n", ret);
1269
1270         system_status = wm831x_reg_read(g_wm831x_power->wm831x, WM831X_SYSTEM_STATUS);
1271         if (system_status < 0)
1272                 return system_status;
1273         //printk("wm831x system status %#x\n", ret);
1274
1275         chg_ctl1 = wm831x_reg_read(g_wm831x_power->wm831x, WM831X_CHARGER_CONTROL_1);
1276         if (chg_ctl1 < 0)
1277                 return chg_ctl1;
1278         //printk("wm831x charger control1 %#x\n", ret);
1279
1280         chg_ctl2 = wm831x_reg_read(g_wm831x_power->wm831x, WM831X_CHARGER_CONTROL_2);
1281         if (chg_ctl2 < 0)
1282                 return chg_ctl2;
1283         //printk("wm831x charger control2 %#x\n", ret);
1284
1285         chg_status = wm831x_reg_read(g_wm831x_power->wm831x, WM831X_CHARGER_STATUS);
1286         if (chg_status < 0)
1287                 return chg_status;
1288         //printk("wm831x charger status %#x\n", ret);
1289
1290         ret = wm831x_power_read_voltage(g_wm831x_power->wm831x, WM831X_AUX_BATT, &val);
1291         if (ret < 0)
1292                 return ret;
1293         wm831x_batt_vol_level(g_wm831x_power, val.intval / 1000, &level);
1294         //printk("batt_vol = %d batt_level = %d\n", val.intval, level);
1295         //
1296         sprintf(buf, "power_status=%#x\n"
1297                              "system_status=%#x\n"
1298                                  "chg_ctl1=%#x\n"
1299                                  "chg_ctl2=%#x\n"
1300                                  "chg_status=%#x\n"
1301                                  "batt_vol=%d\n"
1302                                  "batt_level=%d%%\n",
1303                                  power_status,
1304                                  system_status,
1305                                  chg_ctl1,
1306                                  chg_ctl2,
1307                                  chg_status,
1308                                  val.intval,
1309                                  level);
1310         ret = strlen(buf) + 1;
1311         return ret;
1312 }
1313
1314 static DEVICE_ATTR(prop, 0444, power_prop_show, NULL);
1315
1316 static struct kobject *power_test_kobj;
1317
1318 static int power_test_sysfs_init(void)
1319 {
1320         int ret ;
1321         power_test_kobj = kobject_create_and_add("power_test_prop", NULL);
1322         if (power_test_kobj == NULL) {
1323                 printk(KERN_ERR
1324                        "power_test_sysfs_init:"\
1325                        "subsystem_register failed\n");
1326                 ret = -ENOMEM;
1327                 goto err;
1328         }
1329         ret = sysfs_create_file(power_test_kobj, &dev_attr_prop.attr);
1330         if (ret) {
1331                 printk(KERN_ERR
1332                        "power_test_sysfs_init:"\
1333                        "sysfs_create_group failed\n");
1334                 goto err1;
1335         }
1336
1337         return 0 ;
1338 err1:
1339         kobject_del(power_test_kobj);
1340 err:
1341         return ret ;
1342 }
1343
1344
1345 MODULE_DESCRIPTION("Power supply driver for WM831x PMICs");
1346 MODULE_AUTHOR("Mark Brown <broonie@opensource.wolfsonmicro.com>");
1347 MODULE_LICENSE("GPL");
1348 MODULE_ALIAS("platform:wm831x-power");