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
  16 #include <linux/mfd/wm831x/core.h>
  17 #include <linux/mfd/wm831x/auxadc.h>
  18 #include <linux/mfd/wm831x/pmu.h>
  19 #include <linux/mfd/wm831x/pdata.h>
  20
  21 struct wm831x_power {
  22         struct wm831x *wm831x;
  23         struct power_supply wall;
  24         struct power_supply backup;
  25         struct power_supply usb;
  26         struct power_supply battery;
  27 };
  28
  29 static int wm831x_power_check_online(struct wm831x *wm831x, int supply,
  30                                      union power_supply_propval *val)
  31 {
  32         int ret;
  33
  34         ret = wm831x_reg_read(wm831x, WM831X_SYSTEM_STATUS);
  35         if (ret < 0)
  36                 return ret;
  37
  38         if (ret & supply)
  39                 val->intval = 1;
  40         else
  41                 val->intval = 0;
  42
  43         return 0;
  44 }
  45
  46 static int wm831x_power_read_voltage(struct wm831x *wm831x,
  47                                      enum wm831x_auxadc src,
  48                                      union power_supply_propval *val)
  49 {
  50         int ret;
  51
  52         ret = wm831x_auxadc_read_uv(wm831x, src);
  53         if (ret >= 0)
  54                 val->intval = ret;
  55
  56         return ret;
  57 }
  58
  59 /*********************************************************************
  60  *              WALL Power
  61  *********************************************************************/
  62 static int wm831x_wall_get_prop(struct power_supply *psy,
  63                                 enum power_supply_property psp,
  64                                 union power_supply_propval *val)
  65 {
  66         struct wm831x_power *wm831x_power = dev_get_drvdata(psy->dev->parent);
  67         struct wm831x *wm831x = wm831x_power->wm831x;
  68         int ret = 0;
  69
  70         switch (psp) {
  71         case POWER_SUPPLY_PROP_ONLINE:
  72                 ret = wm831x_power_check_online(wm831x, WM831X_PWR_WALL, val);
  73                 break;
  74         case POWER_SUPPLY_PROP_VOLTAGE_NOW:
  75                 ret = wm831x_power_read_voltage(wm831x, WM831X_AUX_WALL, val);
  76                 break;
  77         default:
  78                 ret = -EINVAL;
  79                 break;
  80         }
  81
  82         return ret;
  83 }
  84
  85 static enum power_supply_property wm831x_wall_props[] = {
  86         POWER_SUPPLY_PROP_ONLINE,
  87         POWER_SUPPLY_PROP_VOLTAGE_NOW,
  88 };
  89
  90 /*********************************************************************
  91  *              USB Power
  92  *********************************************************************/
  93 static int wm831x_usb_get_prop(struct power_supply *psy,
  94                                enum power_supply_property psp,
  95                                union power_supply_propval *val)
  96 {
  97         struct wm831x_power *wm831x_power = dev_get_drvdata(psy->dev->parent);
  98         struct wm831x *wm831x = wm831x_power->wm831x;
  99         int ret = 0;
 100
 101         switch (psp) {
 102         case POWER_SUPPLY_PROP_ONLINE:
 103                 ret = wm831x_power_check_online(wm831x, WM831X_PWR_USB, val);
 104                 break;
 105         case POWER_SUPPLY_PROP_VOLTAGE_NOW:
 106                 ret = wm831x_power_read_voltage(wm831x, WM831X_AUX_USB, val);
 107                 break;
 108         default:
 109                 ret = -EINVAL;
 110                 break;
 111         }
 112
 113         return ret;
 114 }
 115
 116 static enum power_supply_property wm831x_usb_props[] = {
 117         POWER_SUPPLY_PROP_ONLINE,
 118         POWER_SUPPLY_PROP_VOLTAGE_NOW,
 119 };
 120
 121 /*********************************************************************
 122  *              Battery properties
 123  *********************************************************************/
 124
 125 struct chg_map {
 126         int val;
 127         int reg_val;
 128 };
 129
 130 static struct chg_map trickle_ilims[] = {
 131         {  50, 0 << WM831X_CHG_TRKL_ILIM_SHIFT },
 132         { 100, 1 << WM831X_CHG_TRKL_ILIM_SHIFT },
 133         { 150, 2 << WM831X_CHG_TRKL_ILIM_SHIFT },
 134         { 200, 3 << WM831X_CHG_TRKL_ILIM_SHIFT },
 135 };
 136
 137 static struct chg_map vsels[] = {
 138         { 4050, 0 << WM831X_CHG_VSEL_SHIFT },
 139         { 4100, 1 << WM831X_CHG_VSEL_SHIFT },
 140         { 4150, 2 << WM831X_CHG_VSEL_SHIFT },
 141         { 4200, 3 << WM831X_CHG_VSEL_SHIFT },
 142 };
 143
 144 static struct chg_map fast_ilims[] = {
 145         {    0,  0 << WM831X_CHG_FAST_ILIM_SHIFT },
 146         {   50,  1 << WM831X_CHG_FAST_ILIM_SHIFT },
 147         {  100,  2 << WM831X_CHG_FAST_ILIM_SHIFT },
 148         {  150,  3 << WM831X_CHG_FAST_ILIM_SHIFT },
 149         {  200,  4 << WM831X_CHG_FAST_ILIM_SHIFT },
 150         {  250,  5 << WM831X_CHG_FAST_ILIM_SHIFT },
 151         {  300,  6 << WM831X_CHG_FAST_ILIM_SHIFT },
 152         {  350,  7 << WM831X_CHG_FAST_ILIM_SHIFT },
 153         {  400,  8 << WM831X_CHG_FAST_ILIM_SHIFT },
 154         {  450,  9 << WM831X_CHG_FAST_ILIM_SHIFT },
 155         {  500, 10 << WM831X_CHG_FAST_ILIM_SHIFT },
 156         {  600, 11 << WM831X_CHG_FAST_ILIM_SHIFT },
 157         {  700, 12 << WM831X_CHG_FAST_ILIM_SHIFT },
 158         {  800, 13 << WM831X_CHG_FAST_ILIM_SHIFT },
 159         {  900, 14 << WM831X_CHG_FAST_ILIM_SHIFT },
 160         { 1000, 15 << WM831X_CHG_FAST_ILIM_SHIFT },
 161 };
 162
 163 static struct chg_map eoc_iterms[] = {
 164         { 20, 0 << WM831X_CHG_ITERM_SHIFT },
 165         { 30, 1 << WM831X_CHG_ITERM_SHIFT },
 166         { 40, 2 << WM831X_CHG_ITERM_SHIFT },
 167         { 50, 3 << WM831X_CHG_ITERM_SHIFT },
 168         { 60, 4 << WM831X_CHG_ITERM_SHIFT },
 169         { 70, 5 << WM831X_CHG_ITERM_SHIFT },
 170         { 80, 6 << WM831X_CHG_ITERM_SHIFT },
 171         { 90, 7 << WM831X_CHG_ITERM_SHIFT },
 172 };
 173
 174 static struct chg_map chg_times[] = {
 175         {  60,  0 << WM831X_CHG_TIME_SHIFT },
 176         {  90,  1 << WM831X_CHG_TIME_SHIFT },
 177         { 120,  2 << WM831X_CHG_TIME_SHIFT },
 178         { 150,  3 << WM831X_CHG_TIME_SHIFT },
 179         { 180,  4 << WM831X_CHG_TIME_SHIFT },
 180         { 210,  5 << WM831X_CHG_TIME_SHIFT },
 181         { 240,  6 << WM831X_CHG_TIME_SHIFT },
 182         { 270,  7 << WM831X_CHG_TIME_SHIFT },
 183         { 300,  8 << WM831X_CHG_TIME_SHIFT },
 184         { 330,  9 << WM831X_CHG_TIME_SHIFT },
 185         { 360, 10 << WM831X_CHG_TIME_SHIFT },
 186         { 390, 11 << WM831X_CHG_TIME_SHIFT },
 187         { 420, 12 << WM831X_CHG_TIME_SHIFT },
 188         { 450, 13 << WM831X_CHG_TIME_SHIFT },
 189         { 480, 14 << WM831X_CHG_TIME_SHIFT },
 190         { 510, 15 << WM831X_CHG_TIME_SHIFT },
 191 };
 192
 193 static void wm831x_battey_apply_config(struct wm831x *wm831x,
 194                                        struct chg_map *map, int count, int val,
 195                                        int *reg, const char *name,
 196                                        const char *units)
 197 {
 198         int i;
 199
 200         for (i = 0; i < count; i++)
 201                 if (val == map[i].val)
 202                         break;
 203         if (i == count) {
 204                 dev_err(wm831x->dev, "Invalid %s %d%s\n",
 205                         name, val, units);
 206         } else {
 207                 *reg |= map[i].reg_val;
 208                 dev_dbg(wm831x->dev, "Set %s of %d%s\n", name, val, units);
 209         }
 210 }
 211
 212 static void wm831x_config_battery(struct wm831x *wm831x)
 213 {
 214         struct wm831x_pdata *wm831x_pdata = wm831x->dev->platform_data;
 215         struct wm831x_battery_pdata *pdata;
 216         int ret, reg1, reg2;
 217
 218         if (!wm831x_pdata || !wm831x_pdata->battery) {
 219                 dev_warn(wm831x->dev,
 220                          "No battery charger configuration\n");
 221                 return;
 222         }
 223
 224         pdata = wm831x_pdata->battery;
 225
 226         reg1 = 0;
 227         reg2 = 0;
 228
 229         if (!pdata->enable) {
 230                 dev_info(wm831x->dev, "Battery charger disabled\n");
 231                 return;
 232         }
 233
 234         reg1 |= WM831X_CHG_ENA;
 235         if (pdata->off_mask)
 236                 reg2 |= WM831X_CHG_OFF_MSK;
 237         if (pdata->fast_enable)
 238                 reg1 |= WM831X_CHG_FAST;
 239
 240         wm831x_battey_apply_config(wm831x, trickle_ilims,
 241                                    ARRAY_SIZE(trickle_ilims),
 242                                    pdata->trickle_ilim, &reg2,
 243                                    "trickle charge current limit", "mA");
 244
 245         wm831x_battey_apply_config(wm831x, vsels, ARRAY_SIZE(vsels),
 246                                    pdata->vsel, &reg2,
 247                                    "target voltage", "mV");
 248
 249         wm831x_battey_apply_config(wm831x, fast_ilims, ARRAY_SIZE(fast_ilims),
 250                                    pdata->fast_ilim, &reg2,
 251                                    "fast charge current limit", "mA");
 252
 253         wm831x_battey_apply_config(wm831x, eoc_iterms, ARRAY_SIZE(eoc_iterms),
 254                                    pdata->eoc_iterm, &reg1,
 255                                    "end of charge current threshold", "mA");
 256
 257         wm831x_battey_apply_config(wm831x, chg_times, ARRAY_SIZE(chg_times),
 258                                    pdata->timeout, &reg2,
 259                                    "charger timeout", "min");
 260
 261         ret = wm831x_reg_unlock(wm831x);
 262         if (ret != 0) {
 263                 dev_err(wm831x->dev, "Failed to unlock registers: %d\n", ret);
 264                 return;
 265         }
 266
 267         ret = wm831x_set_bits(wm831x, WM831X_CHARGER_CONTROL_1,
 268                               WM831X_CHG_ENA_MASK |
 269                               WM831X_CHG_FAST_MASK |
 270                               WM831X_CHG_ITERM_MASK |
 271                               WM831X_CHG_ITERM_MASK,
 272                               reg1);
 273         if (ret != 0)
 274                 dev_err(wm831x->dev, "Failed to set charger control 1: %d\n",
 275                         ret);
 276
 277         ret = wm831x_set_bits(wm831x, WM831X_CHARGER_CONTROL_2,
 278                               WM831X_CHG_OFF_MSK |
 279                               WM831X_CHG_TIME_MASK |
 280                               WM831X_CHG_FAST_ILIM_MASK |
 281                               WM831X_CHG_TRKL_ILIM_MASK |
 282                               WM831X_CHG_VSEL_MASK,
 283                               reg2);
 284         if (ret != 0)
 285                 dev_err(wm831x->dev, "Failed to set charger control 2: %d\n",
 286                         ret);
 287
 288         wm831x_reg_lock(wm831x);
 289 }
 290
 291 static int wm831x_bat_check_status(struct wm831x *wm831x, int *status)
 292 {
 293         int ret;
 294
 295         ret = wm831x_reg_read(wm831x, WM831X_SYSTEM_STATUS);
 296         if (ret < 0)
 297                 return ret;
 298
 299         if (ret & WM831X_PWR_SRC_BATT) {
 300                 *status = POWER_SUPPLY_STATUS_DISCHARGING;
 301                 return 0;
 302         }
 303
 304         ret = wm831x_reg_read(wm831x, WM831X_CHARGER_STATUS);
 305         if (ret < 0)
 306                 return ret;
 307
 308         switch (ret & WM831X_CHG_STATE_MASK) {
 309         case WM831X_CHG_STATE_OFF:
 310                 *status = POWER_SUPPLY_STATUS_NOT_CHARGING;
 311                 break;
 312         case WM831X_CHG_STATE_TRICKLE:
 313         case WM831X_CHG_STATE_FAST:
 314                 *status = POWER_SUPPLY_STATUS_CHARGING;
 315                 break;
 316
 317         default:
 318                 *status = POWER_SUPPLY_STATUS_UNKNOWN;
 319                 break;
 320         }
 321
 322         return 0;
 323 }
 324
 325 static int wm831x_bat_check_type(struct wm831x *wm831x, int *type)
 326 {
 327         int ret;
 328
 329         ret = wm831x_reg_read(wm831x, WM831X_CHARGER_STATUS);
 330         if (ret < 0)
 331                 return ret;
 332
 333         switch (ret & WM831X_CHG_STATE_MASK) {
 334         case WM831X_CHG_STATE_TRICKLE:
 335         case WM831X_CHG_STATE_TRICKLE_OT:
 336                 *type = POWER_SUPPLY_CHARGE_TYPE_TRICKLE;
 337                 break;
 338         case WM831X_CHG_STATE_FAST:
 339         case WM831X_CHG_STATE_FAST_OT:
 340                 *type = POWER_SUPPLY_CHARGE_TYPE_FAST;
 341                 break;
 342         default:
 343                 *type = POWER_SUPPLY_CHARGE_TYPE_NONE;
 344                 break;
 345         }
 346
 347         return 0;
 348 }
 349
 350 static int wm831x_bat_check_health(struct wm831x *wm831x, int *health)
 351 {
 352         int ret;
 353
 354         ret = wm831x_reg_read(wm831x, WM831X_CHARGER_STATUS);
 355         if (ret < 0)
 356                 return ret;
 357
 358         if (ret & WM831X_BATT_HOT_STS) {
 359                 *health = POWER_SUPPLY_HEALTH_OVERHEAT;
 360                 return 0;
 361         }
 362
 363         if (ret & WM831X_BATT_COLD_STS) {
 364                 *health = POWER_SUPPLY_HEALTH_COLD;
 365                 return 0;
 366         }
 367
 368         if (ret & WM831X_BATT_OV_STS) {
 369                 *health = POWER_SUPPLY_HEALTH_OVERVOLTAGE;
 370                 return 0;
 371         }
 372
 373         switch (ret & WM831X_CHG_STATE_MASK) {
 374         case WM831X_CHG_STATE_TRICKLE_OT:
 375         case WM831X_CHG_STATE_FAST_OT:
 376                 *health = POWER_SUPPLY_HEALTH_OVERHEAT;
 377                 break;
 378         case WM831X_CHG_STATE_DEFECTIVE:
 379                 *health = POWER_SUPPLY_HEALTH_UNSPEC_FAILURE;
 380                 break;
 381         default:
 382                 *health = POWER_SUPPLY_HEALTH_GOOD;
 383                 break;
 384         }
 385
 386         return 0;
 387 }
 388
 389 static int wm831x_bat_get_prop(struct power_supply *psy,
 390                                enum power_supply_property psp,
 391                                union power_supply_propval *val)
 392 {
 393         struct wm831x_power *wm831x_power = dev_get_drvdata(psy->dev->parent);
 394         struct wm831x *wm831x = wm831x_power->wm831x;
 395         int ret = 0;
 396
 397         switch (psp) {
 398         case POWER_SUPPLY_PROP_STATUS:
 399                 ret = wm831x_bat_check_status(wm831x, &val->intval);
 400                 break;
 401         case POWER_SUPPLY_PROP_ONLINE:
 402                 ret = wm831x_power_check_online(wm831x, WM831X_PWR_SRC_BATT,
 403                                                 val);
 404                 break;
 405         case POWER_SUPPLY_PROP_VOLTAGE_NOW:
 406                 ret = wm831x_power_read_voltage(wm831x, WM831X_AUX_BATT, val);
 407                 break;
 408         case POWER_SUPPLY_PROP_HEALTH:
 409                 ret = wm831x_bat_check_health(wm831x, &val->intval);
 410                 break;
 411         case POWER_SUPPLY_PROP_CHARGE_TYPE:
 412                 ret = wm831x_bat_check_type(wm831x, &val->intval);
 413                 break;
 414         default:
 415                 ret = -EINVAL;
 416                 break;
 417         }
 418
 419         return ret;
 420 }
 421
 422 static enum power_supply_property wm831x_bat_props[] = {
 423         POWER_SUPPLY_PROP_STATUS,
 424         POWER_SUPPLY_PROP_ONLINE,
 425         POWER_SUPPLY_PROP_VOLTAGE_NOW,
 426         POWER_SUPPLY_PROP_HEALTH,
 427         POWER_SUPPLY_PROP_CHARGE_TYPE,
 428 };
 429
 430 static const char *wm831x_bat_irqs[] = {
 431         "BATT HOT",
 432         "BATT COLD",
 433         "BATT FAIL",
 434         "OV",
 435         "END",
 436         "TO",
 437         "MODE",
 438         "START",
 439 };
 440
 441 static irqreturn_t wm831x_bat_irq(int irq, void *data)
 442 {
 443         struct wm831x_power *wm831x_power = data;
 444         struct wm831x *wm831x = wm831x_power->wm831x;
 445
 446         dev_dbg(wm831x->dev, "Battery status changed: %d\n", irq);
 447
 448         /* The battery charger is autonomous so we don't need to do
 449          * anything except kick user space */
 450         power_supply_changed(&wm831x_power->battery);
 451
 452         return IRQ_HANDLED;
 453 }
 454
 455
 456 /*********************************************************************
 457  *              Backup supply properties
 458  *********************************************************************/
 459
 460 static void wm831x_config_backup(struct wm831x *wm831x)
 461 {
 462         struct wm831x_pdata *wm831x_pdata = wm831x->dev->platform_data;
 463         struct wm831x_backup_pdata *pdata;
 464         int ret, reg;
 465
 466         if (!wm831x_pdata || !wm831x_pdata->backup) {
 467                 dev_warn(wm831x->dev,
 468                          "No backup battery charger configuration\n");
 469                 return;
 470         }
 471
 472         pdata = wm831x_pdata->backup;
 473
 474         reg = 0;
 475
 476         if (pdata->charger_enable)
 477                 reg |= WM831X_BKUP_CHG_ENA | WM831X_BKUP_BATT_DET_ENA;
 478         if (pdata->no_constant_voltage)
 479                 reg |= WM831X_BKUP_CHG_MODE;
 480
 481         switch (pdata->vlim) {
 482         case 2500:
 483                 break;
 484         case 3100:
 485                 reg |= WM831X_BKUP_CHG_VLIM;
 486                 break;
 487         default:
 488                 dev_err(wm831x->dev, "Invalid backup voltage limit %dmV\n",
 489                         pdata->vlim);
 490         }
 491
 492         switch (pdata->ilim) {
 493         case 100:
 494                 break;
 495         case 200:
 496                 reg |= 1;
 497                 break;
 498         case 300:
 499                 reg |= 2;
 500                 break;
 501         case 400:
 502                 reg |= 3;
 503                 break;
 504         default:
 505                 dev_err(wm831x->dev, "Invalid backup current limit %duA\n",
 506                         pdata->ilim);
 507         }
 508
 509         ret = wm831x_reg_unlock(wm831x);
 510         if (ret != 0) {
 511                 dev_err(wm831x->dev, "Failed to unlock registers: %d\n", ret);
 512                 return;
 513         }
 514
 515         ret = wm831x_set_bits(wm831x, WM831X_BACKUP_CHARGER_CONTROL,
 516                               WM831X_BKUP_CHG_ENA_MASK |
 517                               WM831X_BKUP_CHG_MODE_MASK |
 518                               WM831X_BKUP_BATT_DET_ENA_MASK |
 519                               WM831X_BKUP_CHG_VLIM_MASK |
 520                               WM831X_BKUP_CHG_ILIM_MASK,
 521                               reg);
 522         if (ret != 0)
 523                 dev_err(wm831x->dev,
 524                         "Failed to set backup charger config: %d\n", ret);
 525
 526         wm831x_reg_lock(wm831x);
 527 }
 528
 529 static int wm831x_backup_get_prop(struct power_supply *psy,
 530                                   enum power_supply_property psp,
 531                                   union power_supply_propval *val)
 532 {
 533         struct wm831x_power *wm831x_power = dev_get_drvdata(psy->dev->parent);
 534         struct wm831x *wm831x = wm831x_power->wm831x;
 535         int ret = 0;
 536
 537         ret = wm831x_reg_read(wm831x, WM831X_BACKUP_CHARGER_CONTROL);
 538         if (ret < 0)
 539                 return ret;
 540
 541         switch (psp) {
 542         case POWER_SUPPLY_PROP_STATUS:
 543                 if (ret & WM831X_BKUP_CHG_STS)
 544                         val->intval = POWER_SUPPLY_STATUS_CHARGING;
 545                 else
 546                         val->intval = POWER_SUPPLY_STATUS_NOT_CHARGING;
 547                 break;
 548
 549         case POWER_SUPPLY_PROP_VOLTAGE_NOW:
 550                 ret = wm831x_power_read_voltage(wm831x, WM831X_AUX_BKUP_BATT,
 551                                                 val);
 552                 break;
 553
 554         case POWER_SUPPLY_PROP_PRESENT:
 555                 if (ret & WM831X_BKUP_CHG_STS)
 556                         val->intval = 1;
 557                 else
 558                         val->intval = 0;
 559                 break;
 560
 561         default:
 562                 ret = -EINVAL;
 563                 break;
 564         }
 565
 566         return ret;
 567 }
 568
 569 static enum power_supply_property wm831x_backup_props[] = {
 570         POWER_SUPPLY_PROP_STATUS,
 571         POWER_SUPPLY_PROP_VOLTAGE_NOW,
 572         POWER_SUPPLY_PROP_PRESENT,
 573 };
 574
 575 /*********************************************************************
 576  *              Initialisation
 577  *********************************************************************/
 578
 579 static irqreturn_t wm831x_syslo_irq(int irq, void *data)
 580 {
 581         struct wm831x_power *wm831x_power = data;
 582         struct wm831x *wm831x = wm831x_power->wm831x;
 583
 584         /* Not much we can actually *do* but tell people for
 585          * posterity, we're probably about to run out of power. */
 586         dev_crit(wm831x->dev, "SYSVDD under voltage\n");
 587
 588         return IRQ_HANDLED;
 589 }
 590
 591 static irqreturn_t wm831x_pwr_src_irq(int irq, void *data)
 592 {
 593         struct wm831x_power *wm831x_power = data;
 594         struct wm831x *wm831x = wm831x_power->wm831x;
 595
 596         dev_dbg(wm831x->dev, "Power source changed\n");
 597
 598         /* Just notify for everything - little harm in overnotifying.
 599          * The backup battery is not a power source while the system
 600          * is running so skip that.
 601          */
 602         power_supply_changed(&wm831x_power->battery);
 603         power_supply_changed(&wm831x_power->usb);
 604         power_supply_changed(&wm831x_power->wall);
 605
 606         return IRQ_HANDLED;
 607 }
 608
 609 static __devinit int wm831x_power_probe(struct platform_device *pdev)
 610 {
 611         struct wm831x *wm831x = dev_get_drvdata(pdev->dev.parent);
 612         struct wm831x_power *power;
 613         struct power_supply *usb;
 614         struct power_supply *battery;
 615         struct power_supply *wall;
 616         struct power_supply *backup;
 617         int ret, irq, i;
 618
 619         power = kzalloc(sizeof(struct wm831x_power), GFP_KERNEL);
 620         if (power == NULL)
 621                 return -ENOMEM;
 622
 623         power->wm831x = wm831x;
 624         platform_set_drvdata(pdev, power);
 625
 626         usb = &power->usb;
 627         battery = &power->battery;
 628         wall = &power->wall;
 629         backup = &power->backup;
 630
 631         /* We ignore configuration failures since we can still read back
 632          * the status without enabling either of the chargers.
 633          */
 634         wm831x_config_battery(wm831x);
 635         wm831x_config_backup(wm831x);
 636
 637         wall->name = "wm831x-wall";
 638         wall->type = POWER_SUPPLY_TYPE_MAINS;
 639         wall->properties = wm831x_wall_props;
 640         wall->num_properties = ARRAY_SIZE(wm831x_wall_props);
 641         wall->get_property = wm831x_wall_get_prop;
 642         ret = power_supply_register(&pdev->dev, wall);
 643         if (ret)
 644                 goto err_kmalloc;
 645
 646         battery->name = "wm831x-battery";
 647         battery->properties = wm831x_bat_props;
 648         battery->num_properties = ARRAY_SIZE(wm831x_bat_props);
 649         battery->get_property = wm831x_bat_get_prop;
 650         battery->use_for_apm = 1;
 651         ret = power_supply_register(&pdev->dev, battery);
 652         if (ret)
 653                 goto err_wall;
 654
 655         usb->name = "wm831x-usb",
 656         usb->type = POWER_SUPPLY_TYPE_USB;
 657         usb->properties = wm831x_usb_props;
 658         usb->num_properties = ARRAY_SIZE(wm831x_usb_props);
 659         usb->get_property = wm831x_usb_get_prop;
 660         ret = power_supply_register(&pdev->dev, usb);
 661         if (ret)
 662                 goto err_battery;
 663
 664         backup->name = "wm831x-backup";
 665         backup->type = POWER_SUPPLY_TYPE_BATTERY;
 666         backup->properties = wm831x_backup_props;
 667         backup->num_properties = ARRAY_SIZE(wm831x_backup_props);
 668         backup->get_property = wm831x_backup_get_prop;
 669         ret = power_supply_register(&pdev->dev, backup);
 670         if (ret)
 671                 goto err_usb;
 672
 673         irq = platform_get_irq_byname(pdev, "SYSLO");
 674         ret = wm831x_request_irq(wm831x, irq, wm831x_syslo_irq,
 675                                  IRQF_TRIGGER_RISING, "SYSLO",
 676                                  power);
 677         if (ret != 0) {
 678                 dev_err(&pdev->dev, "Failed to request SYSLO IRQ %d: %d\n",
 679                         irq, ret);
 680                 goto err_backup;
 681         }
 682
 683         irq = platform_get_irq_byname(pdev, "PWR SRC");
 684         ret = wm831x_request_irq(wm831x, irq, wm831x_pwr_src_irq,
 685                                  IRQF_TRIGGER_RISING, "Power source",
 686                                  power);
 687         if (ret != 0) {
 688                 dev_err(&pdev->dev, "Failed to request PWR SRC IRQ %d: %d\n",
 689                         irq, ret);
 690                 goto err_syslo;
 691         }
 692
 693         for (i = 0; i < ARRAY_SIZE(wm831x_bat_irqs); i++) {
 694                 irq = platform_get_irq_byname(pdev, wm831x_bat_irqs[i]);
 695                 ret = wm831x_request_irq(wm831x, irq, wm831x_bat_irq,
 696                                          IRQF_TRIGGER_RISING,
 697                                          wm831x_bat_irqs[i],
 698                                          power);
 699                 if (ret != 0) {
 700                         dev_err(&pdev->dev,
 701                                 "Failed to request %s IRQ %d: %d\n",
 702                                 wm831x_bat_irqs[i], irq, ret);
 703                         goto err_bat_irq;
 704                 }
 705         }
 706
 707         return ret;
 708
 709 err_bat_irq:
 710         for (; i >= 0; i--) {
 711                 irq = platform_get_irq_byname(pdev, wm831x_bat_irqs[i]);
 712                 wm831x_free_irq(wm831x, irq, power);
 713         }
 714         irq = platform_get_irq_byname(pdev, "PWR SRC");
 715         wm831x_free_irq(wm831x, irq, power);
 716 err_syslo:
 717         irq = platform_get_irq_byname(pdev, "SYSLO");
 718         wm831x_free_irq(wm831x, irq, power);
 719 err_backup:
 720         power_supply_unregister(backup);
 721 err_usb:
 722         power_supply_unregister(usb);
 723 err_battery:
 724         power_supply_unregister(battery);
 725 err_wall:
 726         power_supply_unregister(wall);
 727 err_kmalloc:
 728         kfree(power);
 729         return ret;
 730 }
 731
 732 static __devexit int wm831x_power_remove(struct platform_device *pdev)
 733 {
 734         struct wm831x_power *wm831x_power = platform_get_drvdata(pdev);
 735         struct wm831x *wm831x = wm831x_power->wm831x;
 736         int irq, i;
 737
 738         for (i = 0; i < ARRAY_SIZE(wm831x_bat_irqs); i++) {
 739                 irq = platform_get_irq_byname(pdev, wm831x_bat_irqs[i]);
 740                 wm831x_free_irq(wm831x, irq, wm831x_power);
 741         }
 742
 743         irq = platform_get_irq_byname(pdev, "PWR SRC");
 744         wm831x_free_irq(wm831x, irq, wm831x_power);
 745
 746         irq = platform_get_irq_byname(pdev, "SYSLO");
 747         wm831x_free_irq(wm831x, irq, wm831x_power);
 748
 749         power_supply_unregister(&wm831x_power->backup);
 750         power_supply_unregister(&wm831x_power->battery);
 751         power_supply_unregister(&wm831x_power->wall);
 752         power_supply_unregister(&wm831x_power->usb);
 753         return 0;
 754 }
 755
 756 static struct platform_driver wm831x_power_driver = {
 757         .probe = wm831x_power_probe,
 758         .remove = __devexit_p(wm831x_power_remove),
 759         .driver = {
 760                 .name = "wm831x-power",
 761         },
 762 };
 763
 764 static int __init wm831x_power_init(void)
 765 {
 766         return platform_driver_register(&wm831x_power_driver);
 767 }
 768 module_init(wm831x_power_init);
 769
 770 static void __exit wm831x_power_exit(void)
 771 {
 772         platform_driver_unregister(&wm831x_power_driver);
 773 }
 774 module_exit(wm831x_power_exit);
 775
 776 MODULE_DESCRIPTION("Power supply driver for WM831x PMICs");
 777 MODULE_AUTHOR("Mark Brown <broonie@opensource.wolfsonmicro.com>");
 778 MODULE_LICENSE("GPL");
 779 MODULE_ALIAS("platform:wm831x-power");