drivers/mfd/tps80031.c

   1 /*
   2  * tps80031.c -- TI TPS80031/TPS80032 mfd core driver.
   3  *
   4  * MFD core driver for TI TPS80031/TPS80032 Fully Integrated
   5  * Power Management with Power Path and Battery Charger
   6  *
   7  * Copyright (c) 2012, NVIDIA Corporation.
   8  *
   9  * Author: Laxman Dewangan <ldewangan@nvidia.com>
  10  *
  11  * This program is free software; you can redistribute it and/or
  12  * modify it under the terms of the GNU General Public License as
  13  * published by the Free Software Foundation version 2.
  14  *
  15  * This program is distributed "as is" WITHOUT ANY WARRANTY of any kind,
  16  * whether express or implied; without even the implied warranty of
  17  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
  18  * General Public License for more details.
  19  *
  20  * You should have received a copy of the GNU General Public License
  21  * along with this program; if not, write to the Free Software
  22  * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA
  23  * 02111-1307, USA
  24  */
  25
  26 #include <linux/err.h>
  27 #include <linux/i2c.h>
  28 #include <linux/init.h>
  29 #include <linux/interrupt.h>
  30 #include <linux/irq.h>
  31 #include <linux/mfd/core.h>
  32 #include <linux/mfd/tps80031.h>
  33 #include <linux/module.h>
  34 #include <linux/pm.h>
  35 #include <linux/regmap.h>
  36 #include <linux/slab.h>
  37
  38 static struct resource tps80031_rtc_resources[] = {
  39         {
  40                 .start = TPS80031_INT_RTC_ALARM,
  41                 .end = TPS80031_INT_RTC_ALARM,
  42                 .flags = IORESOURCE_IRQ,
  43         },
  44 };
  45
  46 /* TPS80031 sub mfd devices */
  47 static struct mfd_cell tps80031_cell[] = {
  48         {
  49                 .name = "tps80031-pmic",
  50         },
  51         {
  52                 .name = "tps80031-clock",
  53         },
  54         {
  55                 .name = "tps80031-rtc",
  56                 .num_resources = ARRAY_SIZE(tps80031_rtc_resources),
  57                 .resources = tps80031_rtc_resources,
  58         },
  59         {
  60                 .name = "tps80031-gpadc",
  61         },
  62         {
  63                 .name = "tps80031-fuel-gauge",
  64         },
  65         {
  66                 .name = "tps80031-charger",
  67         },
  68 };
  69
  70 static int tps80031_slave_address[TPS80031_NUM_SLAVES] = {
  71         TPS80031_I2C_ID0_ADDR,
  72         TPS80031_I2C_ID1_ADDR,
  73         TPS80031_I2C_ID2_ADDR,
  74         TPS80031_I2C_ID3_ADDR,
  75 };
  76
  77 struct tps80031_pupd_data {
  78         u8      reg;
  79         u8      pullup_bit;
  80         u8      pulldown_bit;
  81 };
  82
  83 #define TPS80031_IRQ(_reg, _mask)                       \
  84         {                                                       \
  85                 .reg_offset = (TPS80031_INT_MSK_LINE_##_reg) -  \
  86                                 TPS80031_INT_MSK_LINE_A,        \
  87                 .mask = BIT(_mask),                             \
  88         }
  89
  90 static const struct regmap_irq tps80031_main_irqs[] = {
  91         [TPS80031_INT_PWRON]            = TPS80031_IRQ(A, 0),
  92         [TPS80031_INT_RPWRON]           = TPS80031_IRQ(A, 1),
  93         [TPS80031_INT_SYS_VLOW]         = TPS80031_IRQ(A, 2),
  94         [TPS80031_INT_RTC_ALARM]        = TPS80031_IRQ(A, 3),
  95         [TPS80031_INT_RTC_PERIOD]       = TPS80031_IRQ(A, 4),
  96         [TPS80031_INT_HOT_DIE]          = TPS80031_IRQ(A, 5),
  97         [TPS80031_INT_VXX_SHORT]        = TPS80031_IRQ(A, 6),
  98         [TPS80031_INT_SPDURATION]       = TPS80031_IRQ(A, 7),
  99         [TPS80031_INT_WATCHDOG]         = TPS80031_IRQ(B, 0),
 100         [TPS80031_INT_BAT]              = TPS80031_IRQ(B, 1),
 101         [TPS80031_INT_SIM]              = TPS80031_IRQ(B, 2),
 102         [TPS80031_INT_MMC]              = TPS80031_IRQ(B, 3),
 103         [TPS80031_INT_RES]              = TPS80031_IRQ(B, 4),
 104         [TPS80031_INT_GPADC_RT]         = TPS80031_IRQ(B, 5),
 105         [TPS80031_INT_GPADC_SW2_EOC]    = TPS80031_IRQ(B, 6),
 106         [TPS80031_INT_CC_AUTOCAL]       = TPS80031_IRQ(B, 7),
 107         [TPS80031_INT_ID_WKUP]          = TPS80031_IRQ(C, 0),
 108         [TPS80031_INT_VBUSS_WKUP]       = TPS80031_IRQ(C, 1),
 109         [TPS80031_INT_ID]               = TPS80031_IRQ(C, 2),
 110         [TPS80031_INT_VBUS]             = TPS80031_IRQ(C, 3),
 111         [TPS80031_INT_CHRG_CTRL]        = TPS80031_IRQ(C, 4),
 112         [TPS80031_INT_EXT_CHRG]         = TPS80031_IRQ(C, 5),
 113         [TPS80031_INT_INT_CHRG]         = TPS80031_IRQ(C, 6),
 114         [TPS80031_INT_RES2]             = TPS80031_IRQ(C, 7),
 115 };
 116
 117 static struct regmap_irq_chip tps80031_irq_chip = {
 118         .name = "tps80031",
 119         .irqs = tps80031_main_irqs,
 120         .num_irqs = ARRAY_SIZE(tps80031_main_irqs),
 121         .num_regs = 3,
 122         .status_base = TPS80031_INT_STS_A,
 123         .mask_base = TPS80031_INT_MSK_LINE_A,
 124 };
 125
 126 #define PUPD_DATA(_reg, _pulldown_bit, _pullup_bit)     \
 127         {                                               \
 128                 .reg = TPS80031_CFG_INPUT_PUPD##_reg,   \
 129                 .pulldown_bit = _pulldown_bit,          \
 130                 .pullup_bit = _pullup_bit,              \
 131         }
 132
 133 static const struct tps80031_pupd_data tps80031_pupds[] = {
 134         [TPS80031_PREQ1]                = PUPD_DATA(1, BIT(0),  BIT(1)),
 135         [TPS80031_PREQ2A]               = PUPD_DATA(1, BIT(2),  BIT(3)),
 136         [TPS80031_PREQ2B]               = PUPD_DATA(1, BIT(4),  BIT(5)),
 137         [TPS80031_PREQ2C]               = PUPD_DATA(1, BIT(6),  BIT(7)),
 138         [TPS80031_PREQ3]                = PUPD_DATA(2, BIT(0),  BIT(1)),
 139         [TPS80031_NRES_WARM]            = PUPD_DATA(2, 0,       BIT(2)),
 140         [TPS80031_PWM_FORCE]            = PUPD_DATA(2, BIT(5),  0),
 141         [TPS80031_CHRG_EXT_CHRG_STATZ]  = PUPD_DATA(2, 0,       BIT(6)),
 142         [TPS80031_SIM]                  = PUPD_DATA(3, BIT(0),  BIT(1)),
 143         [TPS80031_MMC]                  = PUPD_DATA(3, BIT(2),  BIT(3)),
 144         [TPS80031_GPADC_START]          = PUPD_DATA(3, BIT(4),  0),
 145         [TPS80031_DVSI2C_SCL]           = PUPD_DATA(4, 0,       BIT(0)),
 146         [TPS80031_DVSI2C_SDA]           = PUPD_DATA(4, 0,       BIT(1)),
 147         [TPS80031_CTLI2C_SCL]           = PUPD_DATA(4, 0,       BIT(2)),
 148         [TPS80031_CTLI2C_SDA]           = PUPD_DATA(4, 0,       BIT(3)),
 149 };
 150 static struct tps80031 *tps80031_power_off_dev;
 151
 152 int tps80031_ext_power_req_config(struct device *dev,
 153                 unsigned long ext_ctrl_flag, int preq_bit,
 154                 int state_reg_add, int trans_reg_add)
 155 {
 156         u8 res_ass_reg = 0;
 157         int preq_mask_bit = 0;
 158         int ret;
 159
 160         if (!(ext_ctrl_flag & TPS80031_EXT_PWR_REQ))
 161                 return 0;
 162
 163         if (ext_ctrl_flag & TPS80031_PWR_REQ_INPUT_PREQ1) {
 164                 res_ass_reg = TPS80031_PREQ1_RES_ASS_A + (preq_bit >> 3);
 165                 preq_mask_bit = 5;
 166         } else if (ext_ctrl_flag & TPS80031_PWR_REQ_INPUT_PREQ2) {
 167                 res_ass_reg = TPS80031_PREQ2_RES_ASS_A + (preq_bit >> 3);
 168                 preq_mask_bit = 6;
 169         } else if (ext_ctrl_flag & TPS80031_PWR_REQ_INPUT_PREQ3) {
 170                 res_ass_reg = TPS80031_PREQ3_RES_ASS_A + (preq_bit >> 3);
 171                 preq_mask_bit = 7;
 172         }
 173
 174         /* Configure REQ_ASS registers */
 175         ret = tps80031_set_bits(dev, TPS80031_SLAVE_ID1, res_ass_reg,
 176                                         BIT(preq_bit & 0x7));
 177         if (ret < 0) {
 178                 dev_err(dev, "reg 0x%02x setbit failed, err = %d\n",
 179                                 res_ass_reg, ret);
 180                 return ret;
 181         }
 182
 183         /* Unmask the PREQ */
 184         ret = tps80031_clr_bits(dev, TPS80031_SLAVE_ID1,
 185                         TPS80031_PHOENIX_MSK_TRANSITION, BIT(preq_mask_bit));
 186         if (ret < 0) {
 187                 dev_err(dev, "reg 0x%02x clrbit failed, err = %d\n",
 188                         TPS80031_PHOENIX_MSK_TRANSITION, ret);
 189                 return ret;
 190         }
 191
 192         /* Switch regulator control to resource now */
 193         if (ext_ctrl_flag & (TPS80031_PWR_REQ_INPUT_PREQ2 |
 194                                         TPS80031_PWR_REQ_INPUT_PREQ3)) {
 195                 ret = tps80031_update(dev, TPS80031_SLAVE_ID1, state_reg_add,
 196                                                 0x0, TPS80031_STATE_MASK);
 197                 if (ret < 0)
 198                         dev_err(dev, "reg 0x%02x update failed, err = %d\n",
 199                                 state_reg_add, ret);
 200         } else {
 201                 ret = tps80031_update(dev, TPS80031_SLAVE_ID1, trans_reg_add,
 202                                 TPS80031_TRANS_SLEEP_OFF,
 203                                 TPS80031_TRANS_SLEEP_MASK);
 204                 if (ret < 0)
 205                         dev_err(dev, "reg 0x%02x update failed, err = %d\n",
 206                                 trans_reg_add, ret);
 207         }
 208         return ret;
 209 }
 210 EXPORT_SYMBOL_GPL(tps80031_ext_power_req_config);
 211
 212 static void tps80031_power_off(void)
 213 {
 214         dev_info(tps80031_power_off_dev->dev, "switching off PMU\n");
 215         tps80031_write(tps80031_power_off_dev->dev, TPS80031_SLAVE_ID1,
 216                                 TPS80031_PHOENIX_DEV_ON, TPS80031_DEVOFF);
 217 }
 218
 219 static void tps80031_pupd_init(struct tps80031 *tps80031,
 220                                struct tps80031_platform_data *pdata)
 221 {
 222         struct tps80031_pupd_init_data *pupd_init_data = pdata->pupd_init_data;
 223         int data_size = pdata->pupd_init_data_size;
 224         int i;
 225
 226         for (i = 0; i < data_size; ++i) {
 227                 struct tps80031_pupd_init_data *pupd_init = &pupd_init_data[i];
 228                 const struct tps80031_pupd_data *pupd =
 229                         &tps80031_pupds[pupd_init->input_pin];
 230                 u8 update_value = 0;
 231                 u8 update_mask = pupd->pulldown_bit | pupd->pullup_bit;
 232
 233                 if (pupd_init->setting == TPS80031_PUPD_PULLDOWN)
 234                         update_value = pupd->pulldown_bit;
 235                 else if (pupd_init->setting == TPS80031_PUPD_PULLUP)
 236                         update_value = pupd->pullup_bit;
 237
 238                 tps80031_update(tps80031->dev, TPS80031_SLAVE_ID1, pupd->reg,
 239                                 update_value, update_mask);
 240         }
 241 }
 242
 243 static int tps80031_init_ext_control(struct tps80031 *tps80031,
 244                         struct tps80031_platform_data *pdata)
 245 {
 246         struct device *dev = tps80031->dev;
 247         int ret;
 248         int i;
 249
 250         /* Clear all external control for this rail */
 251         for (i = 0; i < 9; ++i) {
 252                 ret = tps80031_write(dev, TPS80031_SLAVE_ID1,
 253                                 TPS80031_PREQ1_RES_ASS_A + i, 0);
 254                 if (ret < 0) {
 255                         dev_err(dev, "reg 0x%02x write failed, err = %d\n",
 256                                 TPS80031_PREQ1_RES_ASS_A + i, ret);
 257                         return ret;
 258                 }
 259         }
 260
 261         /* Mask the PREQ */
 262         ret = tps80031_set_bits(dev, TPS80031_SLAVE_ID1,
 263                         TPS80031_PHOENIX_MSK_TRANSITION, 0x7 << 5);
 264         if (ret < 0) {
 265                 dev_err(dev, "reg 0x%02x set_bits failed, err = %d\n",
 266                         TPS80031_PHOENIX_MSK_TRANSITION, ret);
 267                 return ret;
 268         }
 269         return ret;
 270 }
 271
 272 static int tps80031_irq_init(struct tps80031 *tps80031, int irq, int irq_base)
 273 {
 274         struct device *dev = tps80031->dev;
 275         int i, ret;
 276
 277         /*
 278          * The MASK register used for updating status register when
 279          * interrupt occurs and LINE register used to pass the status
 280          * to actual interrupt line.  As per datasheet:
 281          * When INT_MSK_LINE [i] is set to 1, the associated interrupt
 282          * number i is INT line masked, which means that no interrupt is
 283          * generated on the INT line.
 284          * When INT_MSK_LINE [i] is set to 0, the associated interrupt
 285          * number i is  line enabled: An interrupt is generated on the
 286          * INT line.
 287          * In any case, the INT_STS [i] status bit may or may not be updated,
 288          * only linked to the INT_MSK_STS [i] configuration register bit.
 289          *
 290          * When INT_MSK_STS [i] is set to 1, the associated interrupt number
 291          * i is status masked, which means that no interrupt is stored in
 292          * the INT_STS[i] status bit. Note that no interrupt number i is
 293          * generated on the INT line, even if the INT_MSK_LINE [i] register
 294          * bit is set to 0.
 295          * When INT_MSK_STS [i] is set to 0, the associated interrupt number i
 296          * is status enabled: An interrupt status is updated in the INT_STS [i]
 297          * register. The interrupt may or may not be generated on the INT line,
 298          * depending on the INT_MSK_LINE [i] configuration register bit.
 299          */
 300         for (i = 0; i < 3; i++)
 301                 tps80031_write(dev, TPS80031_SLAVE_ID2,
 302                                 TPS80031_INT_MSK_STS_A + i, 0x00);
 303
 304         ret = regmap_add_irq_chip(tps80031->regmap[TPS80031_SLAVE_ID2], irq,
 305                         IRQF_ONESHOT, irq_base,
 306                         &tps80031_irq_chip, &tps80031->irq_data);
 307         if (ret < 0) {
 308                 dev_err(dev, "add irq failed, err = %d\n", ret);
 309                 return ret;
 310         }
 311         return ret;
 312 }
 313
 314 static bool rd_wr_reg_id0(struct device *dev, unsigned int reg)
 315 {
 316         switch (reg) {
 317         case TPS80031_SMPS1_CFG_FORCE ... TPS80031_SMPS2_CFG_VOLTAGE:
 318                 return true;
 319         default:
 320                 return false;
 321         }
 322 }
 323
 324 static bool rd_wr_reg_id1(struct device *dev, unsigned int reg)
 325 {
 326         switch (reg) {
 327         case TPS80031_SECONDS_REG ... TPS80031_RTC_RESET_STATUS_REG:
 328         case TPS80031_VALIDITY0 ... TPS80031_VALIDITY7:
 329         case TPS80031_PHOENIX_START_CONDITION ... TPS80031_KEY_PRESS_DUR_CFG:
 330         case TPS80031_SMPS4_CFG_TRANS ... TPS80031_SMPS3_CFG_VOLTAGE:
 331         case TPS80031_BROADCAST_ADDR_ALL ... TPS80031_BROADCAST_ADDR_CLK_RST:
 332         case TPS80031_VANA_CFG_TRANS ... TPS80031_LDO7_CFG_VOLTAGE:
 333         case TPS80031_REGEN1_CFG_TRANS ... TPS80031_TMP_CFG_STATE:
 334         case TPS80031_PREQ1_RES_ASS_A ... TPS80031_PREQ3_RES_ASS_C:
 335         case TPS80031_SMPS_OFFSET ... TPS80031_BATDEBOUNCING:
 336         case TPS80031_CFG_INPUT_PUPD1 ... TPS80031_CFG_SMPS_PD:
 337         case TPS80031_BACKUP_REG:
 338                 return true;
 339         default:
 340                 return false;
 341         }
 342 }
 343
 344 static bool is_volatile_reg_id1(struct device *dev, unsigned int reg)
 345 {
 346         switch (reg) {
 347         case TPS80031_SMPS4_CFG_TRANS ... TPS80031_SMPS3_CFG_VOLTAGE:
 348         case TPS80031_VANA_CFG_TRANS ... TPS80031_LDO7_CFG_VOLTAGE:
 349         case TPS80031_REGEN1_CFG_TRANS ... TPS80031_TMP_CFG_STATE:
 350         case TPS80031_PREQ1_RES_ASS_A ... TPS80031_PREQ3_RES_ASS_C:
 351         case TPS80031_SMPS_OFFSET ... TPS80031_BATDEBOUNCING:
 352         case TPS80031_CFG_INPUT_PUPD1 ... TPS80031_CFG_SMPS_PD:
 353                 return true;
 354         default:
 355                 return false;
 356         }
 357 }
 358
 359 static bool rd_wr_reg_id2(struct device *dev, unsigned int reg)
 360 {
 361         switch (reg) {
 362         case TPS80031_USB_VENDOR_ID_LSB ... TPS80031_USB_OTG_REVISION:
 363         case TPS80031_GPADC_CTRL ... TPS80031_CTRL_P1:
 364         case TPS80031_RTCH0_LSB ... TPS80031_GPCH0_MSB:
 365         case TPS80031_TOGGLE1 ... TPS80031_VIBMODE:
 366         case TPS80031_PWM1ON ... TPS80031_PWM2OFF:
 367         case TPS80031_FG_REG_00 ... TPS80031_FG_REG_11:
 368         case TPS80031_INT_STS_A ... TPS80031_INT_MSK_STS_C:
 369         case TPS80031_CONTROLLER_CTRL2 ... TPS80031_LED_PWM_CTRL2:
 370                 return true;
 371         default:
 372                 return false;
 373         }
 374 }
 375
 376 static bool rd_wr_reg_id3(struct device *dev, unsigned int reg)
 377 {
 378         switch (reg) {
 379         case TPS80031_GPADC_TRIM0 ... TPS80031_GPADC_TRIM18:
 380                 return true;
 381         default:
 382                 return false;
 383         }
 384 }
 385
 386 static const struct regmap_config tps80031_regmap_configs[] = {
 387         {
 388                 .reg_bits = 8,
 389                 .val_bits = 8,
 390                 .writeable_reg = rd_wr_reg_id0,
 391                 .readable_reg = rd_wr_reg_id0,
 392                 .max_register = TPS80031_MAX_REGISTER,
 393         },
 394         {
 395                 .reg_bits = 8,
 396                 .val_bits = 8,
 397                 .writeable_reg = rd_wr_reg_id1,
 398                 .readable_reg = rd_wr_reg_id1,
 399                 .volatile_reg = is_volatile_reg_id1,
 400                 .max_register = TPS80031_MAX_REGISTER,
 401         },
 402         {
 403                 .reg_bits = 8,
 404                 .val_bits = 8,
 405                 .writeable_reg = rd_wr_reg_id2,
 406                 .readable_reg = rd_wr_reg_id2,
 407                 .max_register = TPS80031_MAX_REGISTER,
 408         },
 409         {
 410                 .reg_bits = 8,
 411                 .val_bits = 8,
 412                 .writeable_reg = rd_wr_reg_id3,
 413                 .readable_reg = rd_wr_reg_id3,
 414                 .max_register = TPS80031_MAX_REGISTER,
 415         },
 416 };
 417
 418 static int tps80031_probe(struct i2c_client *client,
 419                           const struct i2c_device_id *id)
 420 {
 421         struct tps80031_platform_data *pdata = client->dev.platform_data;
 422         struct tps80031 *tps80031;
 423         int ret;
 424         uint8_t es_version;
 425         uint8_t ep_ver;
 426         int i;
 427
 428         if (!pdata) {
 429                 dev_err(&client->dev, "tps80031 requires platform data\n");
 430                 return -EINVAL;
 431         }
 432
 433         tps80031 = devm_kzalloc(&client->dev, sizeof(*tps80031), GFP_KERNEL);
 434         if (!tps80031) {
 435                 dev_err(&client->dev, "Malloc failed for tps80031\n");
 436                 return -ENOMEM;
 437         }
 438
 439         for (i = 0; i < TPS80031_NUM_SLAVES; i++) {
 440                 if (tps80031_slave_address[i] == client->addr)
 441                         tps80031->clients[i] = client;
 442                 else
 443                         tps80031->clients[i] = i2c_new_dummy(client->adapter,
 444                                                 tps80031_slave_address[i]);
 445                 if (!tps80031->clients[i]) {
 446                         dev_err(&client->dev, "can't attach client %d\n", i);
 447                         ret = -ENOMEM;
 448                         goto fail_client_reg;
 449                 }
 450
 451                 i2c_set_clientdata(tps80031->clients[i], tps80031);
 452                 tps80031->regmap[i] = devm_regmap_init_i2c(tps80031->clients[i],
 453                                         &tps80031_regmap_configs[i]);
 454                 if (IS_ERR(tps80031->regmap[i])) {
 455                         ret = PTR_ERR(tps80031->regmap[i]);
 456                         dev_err(&client->dev,
 457                                 "regmap %d init failed, err %d\n", i, ret);
 458                         goto fail_client_reg;
 459                 }
 460         }
 461
 462         ret = tps80031_read(&client->dev, TPS80031_SLAVE_ID3,
 463                         TPS80031_JTAGVERNUM, &es_version);
 464         if (ret < 0) {
 465                 dev_err(&client->dev,
 466                         "Silicon version number read failed: %d\n", ret);
 467                 goto fail_client_reg;
 468         }
 469
 470         ret = tps80031_read(&client->dev, TPS80031_SLAVE_ID3,
 471                         TPS80031_EPROM_REV, &ep_ver);
 472         if (ret < 0) {
 473                 dev_err(&client->dev,
 474                         "Silicon eeprom version read failed: %d\n", ret);
 475                 goto fail_client_reg;
 476         }
 477
 478         dev_info(&client->dev, "ES version 0x%02x and EPROM version 0x%02x\n",
 479                                         es_version, ep_ver);
 480         tps80031->es_version = es_version;
 481         tps80031->dev = &client->dev;
 482         i2c_set_clientdata(client, tps80031);
 483         tps80031->chip_info = id->driver_data;
 484
 485         ret = tps80031_irq_init(tps80031, client->irq, pdata->irq_base);
 486         if (ret) {
 487                 dev_err(&client->dev, "IRQ init failed: %d\n", ret);
 488                 goto fail_client_reg;
 489         }
 490
 491         tps80031_pupd_init(tps80031, pdata);
 492
 493         tps80031_init_ext_control(tps80031, pdata);
 494
 495         ret = mfd_add_devices(tps80031->dev, -1,
 496                         tps80031_cell, ARRAY_SIZE(tps80031_cell),
 497                         NULL, 0,
 498                         regmap_irq_get_domain(tps80031->irq_data));
 499         if (ret < 0) {
 500                 dev_err(&client->dev, "mfd_add_devices failed: %d\n", ret);
 501                 goto fail_mfd_add;
 502         }
 503
 504         if (pdata->use_power_off && !pm_power_off) {
 505                 tps80031_power_off_dev = tps80031;
 506                 pm_power_off = tps80031_power_off;
 507         }
 508         return 0;
 509
 510 fail_mfd_add:
 511         regmap_del_irq_chip(client->irq, tps80031->irq_data);
 512
 513 fail_client_reg:
 514         for (i = 0; i < TPS80031_NUM_SLAVES; i++) {
 515                 if (tps80031->clients[i]  && (tps80031->clients[i] != client))
 516                         i2c_unregister_device(tps80031->clients[i]);
 517         }
 518         return ret;
 519 }
 520
 521 static int tps80031_remove(struct i2c_client *client)
 522 {
 523         struct tps80031 *tps80031 = i2c_get_clientdata(client);
 524         int i;
 525
 526         if (tps80031_power_off_dev == tps80031) {
 527                 tps80031_power_off_dev = NULL;
 528                 pm_power_off = NULL;
 529         }
 530
 531         mfd_remove_devices(tps80031->dev);
 532
 533         regmap_del_irq_chip(client->irq, tps80031->irq_data);
 534
 535         for (i = 0; i < TPS80031_NUM_SLAVES; i++) {
 536                 if (tps80031->clients[i] != client)
 537                         i2c_unregister_device(tps80031->clients[i]);
 538         }
 539         return 0;
 540 }
 541
 542 static const struct i2c_device_id tps80031_id_table[] = {
 543         { "tps80031", TPS80031 },
 544         { "tps80032", TPS80032 },
 545         { }
 546 };
 547 MODULE_DEVICE_TABLE(i2c, tps80031_id_table);
 548
 549 static struct i2c_driver tps80031_driver = {
 550         .driver = {
 551                 .name   = "tps80031",
 552                 .owner  = THIS_MODULE,
 553         },
 554         .probe          = tps80031_probe,
 555         .remove         = tps80031_remove,
 556         .id_table       = tps80031_id_table,
 557 };
 558
 559 static int __init tps80031_init(void)
 560 {
 561         return i2c_add_driver(&tps80031_driver);
 562 }
 563 subsys_initcall(tps80031_init);
 564
 565 static void __exit tps80031_exit(void)
 566 {
 567         i2c_del_driver(&tps80031_driver);
 568 }
 569 module_exit(tps80031_exit);
 570
 571 MODULE_AUTHOR("Laxman Dewangan <ldewangan@nvidia.com>");
 572 MODULE_DESCRIPTION("TPS80031 core driver");
 573 MODULE_LICENSE("GPL v2");