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,3838,
  48         3950,3964,3982,4002,4026,
  49         4050,4074,4098,4123,4149,4178
  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         3530,3565,3600,3635,3655,3680,//+160
  67         3700,3717,3734,3745,3755,//+150
  68         3770,3778,3786,3795,3803,//+140
  69         3810,3814,3818,3822,3825,//+130
  70         3830,3832,3834,3836,3837,//+120
  71         3840,3842,3844,3846,3847,//+110
  72         3850,3857,3864,3871,3876,//+100
  73         3890,3897,3904,3911,3918,//+90
  74         4030,4047,4064,4080,4096,//+80
  75         4120,4132,4144,4156,4170,4180//+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
 108 int wm831x_read_on_pin_status(void)
 109 {
 110         int ret;
 111
 112         if(!g_wm831x_power)
 113         {
 114                 printk("err:%s:g_wm831x_power address is 0\n",__FUNCTION__);
 115                 return -1;
 116         }
 117
 118         ret = wm831x_reg_read(g_wm831x_power->wm831x, WM831X_ON_PIN_CONTROL);
 119         if (ret < 0)
 120                 return ret;
 121
 122         return !(ret & WM831X_ON_PIN_STS) ? 1 : 0;
 123 }
 124
 125 static int wm831x_power_check_online(struct wm831x *wm831x, int supply,
 126                                      union power_supply_propval *val)
 127 {
 128         int ret;
 129
 130         ret = wm831x_reg_read(wm831x, WM831X_SYSTEM_STATUS);
 131         if (ret < 0)
 132                 return ret;
 133
 134         if (ret & supply)
 135                 val->intval = 1;
 136         else
 137                 val->intval = 0;
 138
 139         return 0;
 140 }
 141
 142 int wm831x_read_chg_status(void)
 143 {
 144         int ret, usb_chg = 0, wall_chg = 0;
 145
 146         if(!g_wm831x_power)
 147         {
 148                 printk("err:%s:g_wm831x_power address is 0\n",__FUNCTION__);
 149                 return -1;
 150         }
 151
 152         ret = wm831x_reg_read(g_wm831x_power->wm831x, WM831X_SYSTEM_STATUS);
 153         if (ret < 0)
 154                 return ret;
 155
 156         if (ret & WM831X_PWR_USB)
 157                 usb_chg = 1;
 158         if (ret & WM831X_PWR_WALL)
 159                 wall_chg = 1;
 160
 161         return ((usb_chg | wall_chg) ? 1 : 0);
 162 }
 163
 164 static int wm831x_power_read_voltage(struct wm831x *wm831x,
 165                                      enum wm831x_auxadc src,
 166                                      union power_supply_propval *val)
 167 {
 168         int ret;
 169         ret = wm831x_auxadc_read_uv(wm831x, src);
 170         if (ret >= 0)
 171                 val->intval = ret;
 172
 173         return ret ;
 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;
 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_0
 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  ret = 0;
 610
 611         switch (psp) {
 612         case POWER_SUPPLY_PROP_STATUS:
 613                 ret = wm831x_bat_check_status(wm831x, &val->intval);
 614                 //val->intval = wm831x_power->batt_info.status;
 615                 break;
 616         case POWER_SUPPLY_PROP_PRESENT:
 617         case POWER_SUPPLY_PROP_ONLINE:
 618                 //ret = wm831x_power_check_online(wm831x, WM831X_PWR_SRC_BATT, val);
 619                 val->intval = wm831x_power->batt_info.online;
 620                 break;
 621         case POWER_SUPPLY_PROP_VOLTAGE_NOW:
 622                 //ret = wm831x_power_read_voltage(wm831x, WM831X_AUX_BATT, val);
 623                 val->intval = wm831x_power->batt_info.voltage;//uV
 624                 break;
 625         case POWER_SUPPLY_PROP_HEALTH:
 626                 //ret = wm831x_bat_check_health(wm831x, &val->intval);
 627                 val->intval = wm831x_power->batt_info.health;
 628                 break;
 629         case POWER_SUPPLY_PROP_CHARGE_TYPE:
 630                 ret = wm831x_bat_check_type(wm831x, &val->intval);
 631                 break;
 632         case POWER_SUPPLY_PROP_CAPACITY:
 633                 //ret = wm831x_power_read_voltage(wm831x, WM831X_AUX_BATT, val);
 634                 //wm831x_batt_vol_level(wm831x_power, val->intval, &level);
 635                 //val->intval = level;
 636                 val->intval = wm831x_power->batt_info.level;
 637                 break;
 638         case POWER_SUPPLY_PROP_TEMP:
 639                 val->intval = 0;
 640                 break;
 641         case POWER_SUPPLY_PROP_TECHNOLOGY:
 642                 val->intval = POWER_SUPPLY_TECHNOLOGY_LION;
 643                 break;
 644         default:
 645                 ret = -EINVAL;
 646                 break;
 647         }
 648
 649         return ret;
 650 }
 651
 652 static enum power_supply_property wm831x_bat_props[] = {
 653         POWER_SUPPLY_PROP_STATUS,
 654         POWER_SUPPLY_PROP_HEALTH,
 655         POWER_SUPPLY_PROP_PRESENT,
 656         POWER_SUPPLY_PROP_VOLTAGE_NOW,
 657         POWER_SUPPLY_PROP_CAPACITY, /* in percents! */
 658         POWER_SUPPLY_PROP_TECHNOLOGY,
 659         POWER_SUPPLY_PROP_TEMP,
 660         POWER_SUPPLY_PROP_CHARGE_TYPE,
 661 };
 662
 663 #ifdef CONFIG_WM831X_WITH_BATTERY
 664 static const char *wm831x_bat_irqs[] = {
 665         "BATT HOT",
 666         "BATT COLD",
 667         "BATT FAIL",
 668         "OV",
 669         "END",
 670         "TO",
 671         "MODE",
 672         "START",
 673 };
 674
 675 static irqreturn_t wm831x_bat_irq(int irq, void *data)
 676 {
 677         struct wm831x_power *wm831x_power = data;
 678         struct wm831x *wm831x = wm831x_power->wm831x;
 679         int irq0;
 680
 681         irq0 = wm831x->irq_base + WM831X_IRQ_CHG_BATT_HOT + 1;
 682         dev_crit(wm831x->dev, "battery changed: i=%d\n", irq-irq0);
 683
 684         /* The battery charger is autonomous so we don't need to do
 685          * anything except kick user space */
 686         power_supply_changed(&wm831x_power->battery);
 687
 688         return IRQ_HANDLED;
 689 }
 690 #endif
 691
 692 /*********************************************************************
 693  *              Initialisation
 694  *********************************************************************/
 695
 696 static irqreturn_t wm831x_syslo_irq(int irq, void *data)
 697 {
 698         struct wm831x_power *wm831x_power = data;
 699         struct wm831x *wm831x = wm831x_power->wm831x;
 700
 701         /* Not much we can actually *do* but tell people for
 702          * posterity, we're probably about to run out of power. */
 703         dev_crit(wm831x->dev, "SYSVDD under voltage and wake lock 60s\n");
 704         wake_lock_timeout(&wm831x_power->syslo_wake,60*HZ);//wait for android closing system
 705         return IRQ_HANDLED;
 706 }
 707
 708 static irqreturn_t wm831x_pwr_src_irq(int irq, void *data)
 709 {
 710         struct wm831x_power *wm831x_power = data;
 711         struct wm831x *wm831x = wm831x_power->wm831x;
 712
 713         dev_dbg(wm831x->dev, "Power source changed\n");
 714         WM_BATT_DBG("%s:Power source changed\n", __FUNCTION__);
 715         /* Just notify for everything - little harm in overnotifying. */
 716         power_supply_changed(&wm831x_power->battery);
 717         power_supply_changed(&wm831x_power->usb);
 718         power_supply_changed(&wm831x_power->wall);
 719
 720
 721         return IRQ_HANDLED;
 722 }
 723
 724 static void wm831x_batt_timer_handler(unsigned long data)
 725 {
 726         struct wm831x_power *wm831x_power = (struct wm831x_power*)data;
 727         schedule_work(&wm831x_power->batt_work);
 728         mod_timer(&wm831x_power->timer, jiffies + msecs_to_jiffies(wm831x_power->interval));
 729 }
 730
 731 void wm831x_batt_vol_level(struct wm831x_power *wm831x_power, int batt_vol, int *level)
 732 {
 733         int i, ret, status;
 734         static int chg_plus = 1000;
 735         static int chg_minus = 1000;
 736         static int chg_curr = 0;
 737         static int chg_num = 60;
 738         static int disp_plus = 1000;
 739         static int disp_minus = 1000;
 740         static int disp_curr = 0;
 741         static int disp_num = 50;
 742
 743
 744         *level = wm831x_power->batt_info.level;
 745         ret = wm831x_bat_check_status(wm831x_power->wm831x, &status);
 746         if (ret < 0) {
 747                 printk("%s: check bat status failer...err = %d\n", __FUNCTION__, ret);
 748                 return;
 749         }
 750
 751         if (status == POWER_SUPPLY_STATUS_NOT_CHARGING
 752                         && batt_vol >= batt_step_table[batt_num-1]) {
 753                 *level = 100;
 754                 return;
 755         }
 756
 757         if (status == POWER_SUPPLY_STATUS_CHARGING)
 758         {
 759                 disp_plus = 0;
 760                 disp_minus = 0;
 761                 disp_curr = 0;
 762
 763                 for(i = 0; i < batt_num; i++){
 764                         if((batt_chg_step_table[i] <= batt_vol) &&
 765                                          (batt_chg_step_table[i+1] > batt_vol))
 766                                 break;
 767                 }
 768                 *level = batt_disp_table[i];
 769
 770                 if (batt_vol <= batt_chg_step_table[0])
 771                         *level = 0;
 772                 if (batt_vol >= batt_chg_step_table[batt_num - 1])
 773                         *level = 100;
 774
 775                 // ³õÊ¼×´Ì¬
 776                 if ((chg_plus == 1000) && (chg_minus == 1000))
 777                 {
 778                         *level = *level;
 779                         chg_plus = 0;
 780                         chg_minus = 0;
 781                         chg_curr = 0;
 782                 }
 783                 else
 784                 {
 785
 786                         if (*level >= (wm831x_power->batt_info.level+1))
 787                         {
 788                                 chg_minus = 0;
 789                                 chg_curr = 0;
 790
 791                                 if (++chg_plus > chg_num)
 792                                 {
 793                                         *level = wm831x_power->batt_info.level + 1;
 794                                         chg_plus = 0;
 795
 796                                         if(*level < 85)
 797                                         chg_num = 60;
 798                                         else
 799                                         chg_num = 20;
 800
 801                                 }
 802                                 else
 803                                 {
 804                                         *level = wm831x_power->batt_info.level;
 805                                 }
 806                         }
 807
 808                         else if (*level >= wm831x_power->batt_info.level)
 809                         {
 810                                 chg_plus = 0;
 811                                 chg_minus = 0;
 812
 813                                 if (++chg_curr > chg_num)
 814                                 {
 815                                         *level = *level;
 816                                         chg_curr = 0;
 817                                 }
 818                                 else
 819                                 {
 820                                         *level = wm831x_power->batt_info.level;
 821                                 }
 822                         }
 823                         else if (*level < (wm831x_power->batt_info.level-1))
 824                         {
 825                                 chg_plus = 0;
 826                                 chg_curr = 0;
 827
 828                                 if (++chg_minus > (chg_num<<1))
 829                                 {
 830                                         *level = wm831x_power->batt_info.level - 1;
 831                                         chg_minus = 0;
 832
 833                                         if(*level < 85)
 834                                         chg_num = 60;
 835                                         else
 836                                         chg_num = 20;
 837
 838                                 }
 839                                 else
 840                                 {
 841                                         *level = wm831x_power->batt_info.level;
 842                                 }
 843                         }
 844                         else
 845                         {
 846                                 chg_plus = 0;
 847                                 chg_minus = 0;
 848                                 chg_curr = 0;
 849                                 *level = wm831x_power->batt_info.level;
 850                         }
 851                 }
 852
 853
 854                 if (*level >= 100)
 855                         *level = 100;
 856                 if (*level < 0)
 857                         *level = 0;
 858         }
 859         else
 860         {
 861                 chg_plus = 0;
 862                 chg_minus = 0;
 863                 chg_curr = 0;
 864
 865                 for(i = 0; i < batt_num; i++){
 866                         if(batt_vol >= batt_step_table[i] &&
 867                                          batt_vol < batt_step_table[i+1])
 868                                 break;
 869                 }
 870                 *level = batt_disp_table[i];
 871
 872                 if (batt_vol <= batt_step_table[0])
 873                         *level = 0;
 874                 if (batt_vol >= batt_step_table[batt_num - 1])
 875                         *level = 100;
 876
 877                 // ³õÊ¼×´Ì¬
 878                 if ((disp_plus == 1000) && (disp_minus == 1000))
 879                 {
 880                         *level = *level;
 881                         disp_plus = 0;
 882                         disp_minus = 0;
 883                         disp_curr = 0;
 884                 }
 885                 else
 886                 {
 887
 888                         if (*level <= (wm831x_power->batt_info.level-1))
 889                         {
 890                                 disp_plus = 0;
 891                                 disp_curr = 0;
 892
 893                                 if (++disp_minus > disp_num)
 894                                 {
 895                                         *level = wm831x_power->batt_info.level - 1;
 896                                         disp_minus = 0;
 897
 898                                         if((*level < 17) || (*level > 85))
 899                                         disp_num = 10;
 900                                         else
 901                                         disp_num = 50;
 902
 903                                 }
 904                                 else
 905                                 {
 906                                         *level = wm831x_power->batt_info.level;
 907                                 }
 908                         }
 909                         else if (*level <= wm831x_power->batt_info.level)
 910                         {
 911                                 disp_plus = 0;
 912                                 disp_minus = 0;
 913
 914                                 if (++disp_curr > disp_num)
 915                                 {
 916                                         *level = *level;
 917                                         disp_curr = 0;
 918                                 }
 919                                 else
 920                                 {
 921                                         *level = wm831x_power->batt_info.level;
 922                                 }
 923                         }
 924                         else if (*level >= (wm831x_power->batt_info.level+1))
 925                         {
 926                                 disp_minus = 0;
 927                                 disp_curr = 0;
 928
 929                                 if (++disp_plus > (disp_num<<1))
 930                                 {
 931                                         *level = wm831x_power->batt_info.level + 1;
 932                                         disp_plus = 0;
 933                                         if((*level < 17) || (*level > 85))
 934                                         disp_num = 10;
 935                                         else
 936                                         disp_num = 50;
 937                                 }
 938                                 else
 939                                 {
 940                                         *level = wm831x_power->batt_info.level;
 941                                 }
 942                         }
 943                         else
 944                         {
 945                                 disp_plus = 0;
 946                                 disp_minus = 0;
 947                                 disp_curr = 0;
 948                                 *level = wm831x_power->batt_info.level;
 949                         }
 950                 }
 951
 952                 if (*level >= 100)
 953                         *level = 100;
 954                 if (*level < 0)
 955                         *level = 0;
 956         }
 957 }
 958
 959 static void wm831x_batt_work(struct work_struct *work)
 960 {
 961         int online, status,health,level, ret;
 962     union power_supply_propval val;
 963         struct wm831x_power *power = container_of(work, struct wm831x_power, batt_work);
 964
 965         ret = wm831x_power_check_online(power->wm831x, WM831X_PWR_SRC_BATT, &val);
 966         if (ret < 0) {
 967                 printk("%s: check bat online failer...  err = %d\n", __FUNCTION__, ret);
 968                 return;
 969         }
 970         online = val.intval;
 971
 972         ret = wm831x_bat_check_status(power->wm831x, &status);
 973         if (ret < 0) {
 974                 printk("%s: check bat status failer...  err = %d\n", __FUNCTION__, ret);
 975                 return;
 976         }
 977
 978         ret = wm831x_bat_check_health(power->wm831x, &health);
 979         if (ret < 0) {
 980                 printk("%s: check bat health failer...  err = %d\n", __FUNCTION__, ret);
 981                 return;
 982         }
 983
 984         ret = wm831x_power_read_voltage(power->wm831x, WM831X_AUX_BATT, &val);
 985         if (ret < 0) {
 986                 printk("%s: read bat voltage failer...err = %d\n", __FUNCTION__, ret);
 987                 return;
 988         }
 989         power->batt_info.voltage = val.intval;
 990
 991         wm831x_batt_vol_level(power, val.intval / 1000, &level);
 992         //mod_timer(&power->timer, jiffies + msecs_to_jiffies(power->interval));
 993
 994         if (online != power->batt_info.online || status != power->batt_info.status
 995                         || health != power->batt_info.health || level != power->batt_info.level)
 996         {
 997                 power->batt_info.online = online;
 998                 power->batt_info.status = status;
 999                 power->batt_info.health = health;
1000                 power->batt_info.level  = level;
1001
1002                 power_supply_changed(&power->battery);
1003         }
1004
1005 }
1006
1007 static __devinit int wm831x_power_probe(struct platform_device *pdev)
1008 {
1009         struct wm831x *wm831x = dev_get_drvdata(pdev->dev.parent);
1010         struct wm831x_power *power;
1011         struct power_supply *usb;
1012         struct power_supply *battery;
1013         struct power_supply *wall;
1014         int ret, irq, i;
1015
1016         power = kzalloc(sizeof(struct wm831x_power), GFP_KERNEL);
1017         if (power == NULL)
1018                 return -ENOMEM;
1019
1020         power->wm831x = wm831x;
1021         platform_set_drvdata(pdev, power);
1022
1023         usb = &power->usb;
1024         battery = &power->battery;
1025         wall = &power->wall;
1026
1027         /* We ignore configuration failures since we can still read back
1028          * the status without enabling the charger.
1029          */
1030         wm831x_config_battery(wm831x);
1031
1032         wall->name = "wm831x-wall";
1033         wall->type = POWER_SUPPLY_TYPE_MAINS;
1034         wall->properties = wm831x_wall_props;
1035         wall->num_properties = ARRAY_SIZE(wm831x_wall_props);
1036         wall->get_property = wm831x_wall_get_prop;
1037         ret = power_supply_register(&pdev->dev, wall);
1038         if (ret)
1039                 goto err_kmalloc;
1040
1041         battery->name = "wm831x-battery";
1042         battery->properties = wm831x_bat_props;
1043         battery->num_properties = ARRAY_SIZE(wm831x_bat_props);
1044         battery->get_property = wm831x_bat_get_prop;
1045         battery->use_for_apm = 1;
1046         ret = power_supply_register(&pdev->dev, battery);
1047         if (ret)
1048                 goto err_wall;
1049
1050         usb->name = "wm831x-usb",
1051         usb->type = POWER_SUPPLY_TYPE_USB;
1052         usb->properties = wm831x_usb_props;
1053         usb->num_properties = ARRAY_SIZE(wm831x_usb_props);
1054         usb->get_property = wm831x_usb_get_prop;
1055         ret = power_supply_register(&pdev->dev, usb);
1056         if (ret)
1057                 goto err_battery;
1058
1059         irq = platform_get_irq_byname(pdev, "SYSLO");
1060         ret = request_threaded_irq(irq, NULL, wm831x_syslo_irq,
1061                                    IRQF_TRIGGER_RISING, "System power low",
1062                                    power);
1063         if (ret != 0) {
1064                 dev_err(&pdev->dev, "Failed to request SYSLO IRQ %d: %d\n",
1065                         irq, ret);
1066                 goto err_usb;
1067         }
1068
1069         irq = platform_get_irq_byname(pdev, "PWR SRC");
1070         ret = request_threaded_irq(irq, NULL, wm831x_pwr_src_irq,
1071                                    IRQF_TRIGGER_RISING, "Power source",
1072                                    power);
1073         if (ret != 0) {
1074                 dev_err(&pdev->dev, "Failed to request PWR SRC IRQ %d: %d\n",
1075                         irq, ret);
1076                 goto err_syslo;
1077         }
1078
1079 #ifdef CONFIG_WM831X_WITH_BATTERY
1080         for (i = 0; i < ARRAY_SIZE(wm831x_bat_irqs); i++) {
1081                 irq = platform_get_irq_byname(pdev, wm831x_bat_irqs[i]);
1082                 ret = request_threaded_irq(irq, NULL, wm831x_bat_irq,
1083                                            IRQF_TRIGGER_RISING,
1084                                            wm831x_bat_irqs[i],
1085                                            power);
1086                 WM_BATT_DBG("%s: %s irq no %d\n", __FUNCTION__, wm831x_bat_irqs[i], irq);
1087                 if (ret != 0) {
1088                         dev_err(&pdev->dev,
1089                                 "Failed to request %s IRQ %d: %d\n",
1090                                 wm831x_bat_irqs[i], irq, ret);
1091                         goto err_bat_irq;
1092                 }
1093         }
1094 #endif
1095
1096         power->interval = TIMER_MS_COUNTS;
1097         power->batt_info.level = 100;
1098         power->batt_info.voltage   = 4200000;
1099         power->batt_info.online    = 1;
1100         power->batt_info.status    = POWER_SUPPLY_STATUS_DISCHARGING;
1101         power->batt_info.health    = POWER_SUPPLY_HEALTH_GOOD;
1102
1103         wake_lock_init(&power->syslo_wake, WAKE_LOCK_SUSPEND, "wm831x_syslo_wake");
1104         INIT_WORK(&power->batt_work, wm831x_batt_work);
1105         setup_timer(&power->timer, wm831x_batt_timer_handler, (unsigned long)power);
1106         power->timer.expires = jiffies + msecs_to_jiffies(1000);
1107         add_timer(&power->timer);
1108
1109         g_wm831x_power = power;
1110         printk("%s:wm831x_power initialized\n",__FUNCTION__);
1111         power_test_sysfs_init();
1112         return ret;
1113
1114 #ifdef CONFIG_WM831X_WITH_BATTERY
1115 err_bat_irq:
1116         for (; i >= 0; i--) {
1117                 irq = platform_get_irq_byname(pdev, wm831x_bat_irqs[i]);
1118                 free_irq(irq, power);
1119         }
1120         irq = platform_get_irq_byname(pdev, "PWR SRC");
1121         free_irq(irq, power);
1122 #endif
1123
1124 err_syslo:
1125         irq = platform_get_irq_byname(pdev, "SYSLO");
1126         free_irq(irq, power);
1127 err_usb:
1128         power_supply_unregister(usb);
1129 err_battery:
1130         power_supply_unregister(battery);
1131 err_wall:
1132         power_supply_unregister(wall);
1133 err_kmalloc:
1134         kfree(power);
1135         return ret;
1136 }
1137
1138 static __devexit int wm831x_power_remove(struct platform_device *pdev)
1139 {
1140         struct wm831x_power *wm831x_power = platform_get_drvdata(pdev);
1141         int irq, i;
1142 #ifdef CONFIG_WM831X_WITH_BATTERY
1143         for (i = 0; i < ARRAY_SIZE(wm831x_bat_irqs); i++) {
1144                 irq = platform_get_irq_byname(pdev, wm831x_bat_irqs[i]);
1145                 free_irq(irq, wm831x_power);
1146         }
1147 #endif
1148         irq = platform_get_irq_byname(pdev, "PWR SRC");
1149         free_irq(irq, wm831x_power);
1150
1151         irq = platform_get_irq_byname(pdev, "SYSLO");
1152         free_irq(irq, wm831x_power);
1153
1154         power_supply_unregister(&wm831x_power->battery);
1155         power_supply_unregister(&wm831x_power->wall);
1156         power_supply_unregister(&wm831x_power->usb);
1157         kfree(wm831x_power);
1158         return 0;
1159 }
1160
1161 #ifdef CONFIG_PM
1162 static int wm831x_battery_suspend(struct platform_device *dev, pm_message_t state)
1163 {
1164         struct wm831x_power *power = (struct wm831x_power *)platform_get_drvdata(dev);
1165         flush_scheduled_work();
1166         del_timer(&power->timer);
1167         return 0;
1168 }
1169
1170 static int wm831x_battery_resume(struct platform_device *dev)
1171 {
1172         struct wm831x_power *power = (struct wm831x_power *)platform_get_drvdata(dev);
1173         power->timer.expires = jiffies + msecs_to_jiffies(power->interval);
1174         add_timer(&power->timer);
1175         return 0;
1176 }
1177 #else
1178 #define wm831x_battery_suspend NULL
1179 #define wm831x_battery_resume  NULL
1180 #endif
1181
1182 static struct platform_driver wm831x_power_driver = {
1183         .probe = wm831x_power_probe,
1184         .remove = __devexit_p(wm831x_power_remove),
1185         .suspend = wm831x_battery_suspend,
1186         .resume = wm831x_battery_resume,
1187         .driver = {
1188                 .name = "wm831x-power",
1189         },
1190 };
1191 static int __init wm831x_power_init(void)
1192 {
1193         return platform_driver_register(&wm831x_power_driver);
1194 }
1195 module_init(wm831x_power_init);
1196
1197 static void __exit wm831x_power_exit(void)
1198 {
1199         platform_driver_unregister(&wm831x_power_driver);
1200 }
1201 module_exit(wm831x_power_exit);
1202
1203
1204 static ssize_t power_prop_show(struct device *dev,
1205                 struct device_attribute *attr, char *buf)
1206 {
1207         ssize_t ret = 0;
1208         int level, power_status, system_status, chg_ctl1, chg_ctl2, chg_status;
1209     union power_supply_propval val;
1210
1211         if (!g_wm831x_power)
1212                 return -1;
1213         power_status = wm831x_reg_read(g_wm831x_power->wm831x, WM831X_POWER_STATE);
1214         if (power_status < 0)
1215                 return power_status;
1216         //printk("wm831x power status %#x\n", ret);
1217
1218         system_status = wm831x_reg_read(g_wm831x_power->wm831x, WM831X_SYSTEM_STATUS);
1219         if (system_status < 0)
1220                 return system_status;
1221         //printk("wm831x system status %#x\n", ret);
1222
1223         chg_ctl1 = wm831x_reg_read(g_wm831x_power->wm831x, WM831X_CHARGER_CONTROL_1);
1224         if (chg_ctl1 < 0)
1225                 return chg_ctl1;
1226         //printk("wm831x charger control1 %#x\n", ret);
1227
1228         chg_ctl2 = wm831x_reg_read(g_wm831x_power->wm831x, WM831X_CHARGER_CONTROL_2);
1229         if (chg_ctl2 < 0)
1230                 return chg_ctl2;
1231         //printk("wm831x charger control2 %#x\n", ret);
1232
1233         chg_status = wm831x_reg_read(g_wm831x_power->wm831x, WM831X_CHARGER_STATUS);
1234         if (chg_status < 0)
1235                 return chg_status;
1236         //printk("wm831x charger status %#x\n", ret);
1237
1238         ret = wm831x_power_read_voltage(g_wm831x_power->wm831x, WM831X_AUX_BATT, &val);
1239         if (ret < 0)
1240                 return ret;
1241         wm831x_batt_vol_level(g_wm831x_power, val.intval / 1000, &level);
1242         //printk("batt_vol = %d batt_level = %d\n", val.intval, level);
1243         //
1244         sprintf(buf, "power_status=%#x\n"
1245                              "system_status=%#x\n"
1246                                  "chg_ctl1=%#x\n"
1247                                  "chg_ctl2=%#x\n"
1248                                  "chg_status=%#x\n"
1249                                  "batt_vol=%d\n"
1250                                  "batt_level=%d%%\n",
1251                                  power_status,
1252                                  system_status,
1253                                  chg_ctl1,
1254                                  chg_ctl2,
1255                                  chg_status,
1256                                  val.intval,
1257                                  level);
1258         ret = strlen(buf) + 1;
1259         return ret;
1260 }
1261
1262 static DEVICE_ATTR(prop, 0444, power_prop_show, NULL);
1263
1264 static struct kobject *power_test_kobj;
1265
1266 static int power_test_sysfs_init(void)
1267 {
1268         int ret ;
1269         power_test_kobj = kobject_create_and_add("power_test_prop", NULL);
1270         if (power_test_kobj == NULL) {
1271                 printk(KERN_ERR
1272                        "power_test_sysfs_init:"\
1273                        "subsystem_register failed\n");
1274                 ret = -ENOMEM;
1275                 goto err;
1276         }
1277         ret = sysfs_create_file(power_test_kobj, &dev_attr_prop.attr);
1278         if (ret) {
1279                 printk(KERN_ERR
1280                        "power_test_sysfs_init:"\
1281                        "sysfs_create_group failed\n");
1282                 goto err1;
1283         }
1284
1285         return 0 ;
1286 err1:
1287         kobject_del(power_test_kobj);
1288 err:
1289         return ret ;
1290 }
1291
1292
1293 MODULE_DESCRIPTION("Power supply driver for WM831x PMICs");
1294 MODULE_AUTHOR("Mark Brown <broonie@opensource.wolfsonmicro.com>");
1295 MODULE_LICENSE("GPL");
1296 MODULE_ALIAS("platform:wm831x-power");