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