drivers/mfd/tps6586x.c

   1 /*
   2  * Core driver for TI TPS6586x PMIC family
   3  *
   4  * Copyright (c) 2010 CompuLab Ltd.
   5  * Mike Rapoport <mike@compulab.co.il>
   6  *
   7  * Based on da903x.c.
   8  * Copyright (C) 2008 Compulab, Ltd.
   9  * Mike Rapoport <mike@compulab.co.il>
  10  * Copyright (C) 2006-2008 Marvell International Ltd.
  11  * Eric Miao <eric.miao@marvell.com>
  12  *
  13  * This program is free software; you can redistribute it and/or modify
  14  * it under the terms of the GNU General Public License version 2 as
  15  * published by the Free Software Foundation.
  16  */
  17
  18 #include <linux/interrupt.h>
  19 #include <linux/irq.h>
  20 #include <linux/irqdomain.h>
  21 #include <linux/kernel.h>
  22 #include <linux/module.h>
  23 #include <linux/mutex.h>
  24 #include <linux/slab.h>
  25 #include <linux/err.h>
  26 #include <linux/i2c.h>
  27 #include <linux/platform_device.h>
  28 #include <linux/regmap.h>
  29 #include <linux/of.h>
  30
  31 #include <linux/mfd/core.h>
  32 #include <linux/mfd/tps6586x.h>
  33
  34 #define TPS6586X_SUPPLYENE      0x14
  35 #define EXITSLREQ_BIT           BIT(1)
  36 #define SLEEP_MODE_BIT          BIT(3)
  37
  38 /* interrupt control registers */
  39 #define TPS6586X_INT_ACK1       0xb5
  40 #define TPS6586X_INT_ACK2       0xb6
  41 #define TPS6586X_INT_ACK3       0xb7
  42 #define TPS6586X_INT_ACK4       0xb8
  43
  44 /* interrupt mask registers */
  45 #define TPS6586X_INT_MASK1      0xb0
  46 #define TPS6586X_INT_MASK2      0xb1
  47 #define TPS6586X_INT_MASK3      0xb2
  48 #define TPS6586X_INT_MASK4      0xb3
  49 #define TPS6586X_INT_MASK5      0xb4
  50
  51 /* device id */
  52 #define TPS6586X_VERSIONCRC     0xcd
  53
  54 /* Maximum register */
  55 #define TPS6586X_MAX_REGISTER   TPS6586X_VERSIONCRC
  56
  57 struct tps6586x_irq_data {
  58         u8      mask_reg;
  59         u8      mask_mask;
  60 };
  61
  62 #define TPS6586X_IRQ(_reg, _mask)                               \
  63         {                                                       \
  64                 .mask_reg = (_reg) - TPS6586X_INT_MASK1,        \
  65                 .mask_mask = (_mask),                           \
  66         }
  67
  68 static const struct tps6586x_irq_data tps6586x_irqs[] = {
  69         [TPS6586X_INT_PLDO_0]   = TPS6586X_IRQ(TPS6586X_INT_MASK1, 1 << 0),
  70         [TPS6586X_INT_PLDO_1]   = TPS6586X_IRQ(TPS6586X_INT_MASK1, 1 << 1),
  71         [TPS6586X_INT_PLDO_2]   = TPS6586X_IRQ(TPS6586X_INT_MASK1, 1 << 2),
  72         [TPS6586X_INT_PLDO_3]   = TPS6586X_IRQ(TPS6586X_INT_MASK1, 1 << 3),
  73         [TPS6586X_INT_PLDO_4]   = TPS6586X_IRQ(TPS6586X_INT_MASK1, 1 << 4),
  74         [TPS6586X_INT_PLDO_5]   = TPS6586X_IRQ(TPS6586X_INT_MASK1, 1 << 5),
  75         [TPS6586X_INT_PLDO_6]   = TPS6586X_IRQ(TPS6586X_INT_MASK1, 1 << 6),
  76         [TPS6586X_INT_PLDO_7]   = TPS6586X_IRQ(TPS6586X_INT_MASK1, 1 << 7),
  77         [TPS6586X_INT_COMP_DET] = TPS6586X_IRQ(TPS6586X_INT_MASK4, 1 << 0),
  78         [TPS6586X_INT_ADC]      = TPS6586X_IRQ(TPS6586X_INT_MASK2, 1 << 1),
  79         [TPS6586X_INT_PLDO_8]   = TPS6586X_IRQ(TPS6586X_INT_MASK2, 1 << 2),
  80         [TPS6586X_INT_PLDO_9]   = TPS6586X_IRQ(TPS6586X_INT_MASK2, 1 << 3),
  81         [TPS6586X_INT_PSM_0]    = TPS6586X_IRQ(TPS6586X_INT_MASK2, 1 << 4),
  82         [TPS6586X_INT_PSM_1]    = TPS6586X_IRQ(TPS6586X_INT_MASK2, 1 << 5),
  83         [TPS6586X_INT_PSM_2]    = TPS6586X_IRQ(TPS6586X_INT_MASK2, 1 << 6),
  84         [TPS6586X_INT_PSM_3]    = TPS6586X_IRQ(TPS6586X_INT_MASK2, 1 << 7),
  85         [TPS6586X_INT_RTC_ALM1] = TPS6586X_IRQ(TPS6586X_INT_MASK5, 1 << 4),
  86         [TPS6586X_INT_ACUSB_OVP] = TPS6586X_IRQ(TPS6586X_INT_MASK5, 0x03),
  87         [TPS6586X_INT_USB_DET]  = TPS6586X_IRQ(TPS6586X_INT_MASK5, 1 << 2),
  88         [TPS6586X_INT_AC_DET]   = TPS6586X_IRQ(TPS6586X_INT_MASK5, 1 << 3),
  89         [TPS6586X_INT_BAT_DET]  = TPS6586X_IRQ(TPS6586X_INT_MASK3, 1 << 0),
  90         [TPS6586X_INT_CHG_STAT] = TPS6586X_IRQ(TPS6586X_INT_MASK4, 0xfc),
  91         [TPS6586X_INT_CHG_TEMP] = TPS6586X_IRQ(TPS6586X_INT_MASK3, 0x06),
  92         [TPS6586X_INT_PP]       = TPS6586X_IRQ(TPS6586X_INT_MASK3, 0xf0),
  93         [TPS6586X_INT_RESUME]   = TPS6586X_IRQ(TPS6586X_INT_MASK5, 1 << 5),
  94         [TPS6586X_INT_LOW_SYS]  = TPS6586X_IRQ(TPS6586X_INT_MASK5, 1 << 6),
  95         [TPS6586X_INT_RTC_ALM2] = TPS6586X_IRQ(TPS6586X_INT_MASK4, 1 << 1),
  96 };
  97
  98 static struct resource tps6586x_rtc_resources[] = {
  99         {
 100                 .start  = TPS6586X_INT_RTC_ALM1,
 101                 .end    = TPS6586X_INT_RTC_ALM1,
 102                 .flags  = IORESOURCE_IRQ,
 103         },
 104 };
 105
 106 static const struct mfd_cell tps6586x_cell[] = {
 107         {
 108                 .name = "tps6586x-gpio",
 109         },
 110         {
 111                 .name = "tps6586x-regulator",
 112         },
 113         {
 114                 .name = "tps6586x-rtc",
 115                 .num_resources = ARRAY_SIZE(tps6586x_rtc_resources),
 116                 .resources = &tps6586x_rtc_resources[0],
 117         },
 118         {
 119                 .name = "tps6586x-onkey",
 120         },
 121 };
 122
 123 struct tps6586x {
 124         struct device           *dev;
 125         struct i2c_client       *client;
 126         struct regmap           *regmap;
 127         int                     version;
 128
 129         int                     irq;
 130         struct irq_chip         irq_chip;
 131         struct mutex            irq_lock;
 132         int                     irq_base;
 133         u32                     irq_en;
 134         u8                      mask_reg[5];
 135         struct irq_domain       *irq_domain;
 136 };
 137
 138 static inline struct tps6586x *dev_to_tps6586x(struct device *dev)
 139 {
 140         return i2c_get_clientdata(to_i2c_client(dev));
 141 }
 142
 143 int tps6586x_write(struct device *dev, int reg, uint8_t val)
 144 {
 145         struct tps6586x *tps6586x = dev_to_tps6586x(dev);
 146
 147         return regmap_write(tps6586x->regmap, reg, val);
 148 }
 149 EXPORT_SYMBOL_GPL(tps6586x_write);
 150
 151 int tps6586x_writes(struct device *dev, int reg, int len, uint8_t *val)
 152 {
 153         struct tps6586x *tps6586x = dev_to_tps6586x(dev);
 154
 155         return regmap_bulk_write(tps6586x->regmap, reg, val, len);
 156 }
 157 EXPORT_SYMBOL_GPL(tps6586x_writes);
 158
 159 int tps6586x_read(struct device *dev, int reg, uint8_t *val)
 160 {
 161         struct tps6586x *tps6586x = dev_to_tps6586x(dev);
 162         unsigned int rval;
 163         int ret;
 164
 165         ret = regmap_read(tps6586x->regmap, reg, &rval);
 166         if (!ret)
 167                 *val = rval;
 168         return ret;
 169 }
 170 EXPORT_SYMBOL_GPL(tps6586x_read);
 171
 172 int tps6586x_reads(struct device *dev, int reg, int len, uint8_t *val)
 173 {
 174         struct tps6586x *tps6586x = dev_to_tps6586x(dev);
 175
 176         return regmap_bulk_read(tps6586x->regmap, reg, val, len);
 177 }
 178 EXPORT_SYMBOL_GPL(tps6586x_reads);
 179
 180 int tps6586x_set_bits(struct device *dev, int reg, uint8_t bit_mask)
 181 {
 182         struct tps6586x *tps6586x = dev_to_tps6586x(dev);
 183
 184         return regmap_update_bits(tps6586x->regmap, reg, bit_mask, bit_mask);
 185 }
 186 EXPORT_SYMBOL_GPL(tps6586x_set_bits);
 187
 188 int tps6586x_clr_bits(struct device *dev, int reg, uint8_t bit_mask)
 189 {
 190         struct tps6586x *tps6586x = dev_to_tps6586x(dev);
 191
 192         return regmap_update_bits(tps6586x->regmap, reg, bit_mask, 0);
 193 }
 194 EXPORT_SYMBOL_GPL(tps6586x_clr_bits);
 195
 196 int tps6586x_update(struct device *dev, int reg, uint8_t val, uint8_t mask)
 197 {
 198         struct tps6586x *tps6586x = dev_to_tps6586x(dev);
 199
 200         return regmap_update_bits(tps6586x->regmap, reg, mask, val);
 201 }
 202 EXPORT_SYMBOL_GPL(tps6586x_update);
 203
 204 int tps6586x_irq_get_virq(struct device *dev, int irq)
 205 {
 206         struct tps6586x *tps6586x = dev_to_tps6586x(dev);
 207
 208         return irq_create_mapping(tps6586x->irq_domain, irq);
 209 }
 210 EXPORT_SYMBOL_GPL(tps6586x_irq_get_virq);
 211
 212 int tps6586x_get_version(struct device *dev)
 213 {
 214         struct tps6586x *tps6586x = dev_get_drvdata(dev);
 215
 216         return tps6586x->version;
 217 }
 218 EXPORT_SYMBOL_GPL(tps6586x_get_version);
 219
 220 static int __remove_subdev(struct device *dev, void *unused)
 221 {
 222         platform_device_unregister(to_platform_device(dev));
 223         return 0;
 224 }
 225
 226 static int tps6586x_remove_subdevs(struct tps6586x *tps6586x)
 227 {
 228         return device_for_each_child(tps6586x->dev, NULL, __remove_subdev);
 229 }
 230
 231 static void tps6586x_irq_lock(struct irq_data *data)
 232 {
 233         struct tps6586x *tps6586x = irq_data_get_irq_chip_data(data);
 234
 235         mutex_lock(&tps6586x->irq_lock);
 236 }
 237
 238 static void tps6586x_irq_enable(struct irq_data *irq_data)
 239 {
 240         struct tps6586x *tps6586x = irq_data_get_irq_chip_data(irq_data);
 241         unsigned int __irq = irq_data->hwirq;
 242         const struct tps6586x_irq_data *data = &tps6586x_irqs[__irq];
 243
 244         tps6586x->mask_reg[data->mask_reg] &= ~data->mask_mask;
 245         tps6586x->irq_en |= (1 << __irq);
 246 }
 247
 248 static void tps6586x_irq_disable(struct irq_data *irq_data)
 249 {
 250         struct tps6586x *tps6586x = irq_data_get_irq_chip_data(irq_data);
 251
 252         unsigned int __irq = irq_data->hwirq;
 253         const struct tps6586x_irq_data *data = &tps6586x_irqs[__irq];
 254
 255         tps6586x->mask_reg[data->mask_reg] |= data->mask_mask;
 256         tps6586x->irq_en &= ~(1 << __irq);
 257 }
 258
 259 static void tps6586x_irq_sync_unlock(struct irq_data *data)
 260 {
 261         struct tps6586x *tps6586x = irq_data_get_irq_chip_data(data);
 262         int i;
 263
 264         for (i = 0; i < ARRAY_SIZE(tps6586x->mask_reg); i++) {
 265                 int ret;
 266                 ret = tps6586x_write(tps6586x->dev,
 267                                             TPS6586X_INT_MASK1 + i,
 268                                             tps6586x->mask_reg[i]);
 269                 WARN_ON(ret);
 270         }
 271
 272         mutex_unlock(&tps6586x->irq_lock);
 273 }
 274
 275 #ifdef CONFIG_PM_SLEEP
 276 static int tps6586x_irq_set_wake(struct irq_data *irq_data, unsigned int on)
 277 {
 278         struct tps6586x *tps6586x = irq_data_get_irq_chip_data(irq_data);
 279         return irq_set_irq_wake(tps6586x->irq, on);
 280 }
 281 #else
 282 #define tps6586x_irq_set_wake NULL
 283 #endif
 284
 285 static struct irq_chip tps6586x_irq_chip = {
 286         .name = "tps6586x",
 287         .irq_bus_lock = tps6586x_irq_lock,
 288         .irq_bus_sync_unlock = tps6586x_irq_sync_unlock,
 289         .irq_disable = tps6586x_irq_disable,
 290         .irq_enable = tps6586x_irq_enable,
 291         .irq_set_wake = tps6586x_irq_set_wake,
 292 };
 293
 294 static int tps6586x_irq_map(struct irq_domain *h, unsigned int virq,
 295                                 irq_hw_number_t hw)
 296 {
 297         struct tps6586x *tps6586x = h->host_data;
 298
 299         irq_set_chip_data(virq, tps6586x);
 300         irq_set_chip_and_handler(virq, &tps6586x_irq_chip, handle_simple_irq);
 301         irq_set_nested_thread(virq, 1);
 302         irq_set_noprobe(virq);
 303
 304         return 0;
 305 }
 306
 307 static const struct irq_domain_ops tps6586x_domain_ops = {
 308         .map    = tps6586x_irq_map,
 309         .xlate  = irq_domain_xlate_twocell,
 310 };
 311
 312 static irqreturn_t tps6586x_irq(int irq, void *data)
 313 {
 314         struct tps6586x *tps6586x = data;
 315         u32 acks;
 316         int ret = 0;
 317
 318         ret = tps6586x_reads(tps6586x->dev, TPS6586X_INT_ACK1,
 319                              sizeof(acks), (uint8_t *)&acks);
 320
 321         if (ret < 0) {
 322                 dev_err(tps6586x->dev, "failed to read interrupt status\n");
 323                 return IRQ_NONE;
 324         }
 325
 326         acks = le32_to_cpu(acks);
 327
 328         while (acks) {
 329                 int i = __ffs(acks);
 330
 331                 if (tps6586x->irq_en & (1 << i))
 332                         handle_nested_irq(
 333                                 irq_find_mapping(tps6586x->irq_domain, i));
 334
 335                 acks &= ~(1 << i);
 336         }
 337
 338         return IRQ_HANDLED;
 339 }
 340
 341 static int tps6586x_irq_init(struct tps6586x *tps6586x, int irq,
 342                                        int irq_base)
 343 {
 344         int i, ret;
 345         u8 tmp[4];
 346         int new_irq_base;
 347         int irq_num = ARRAY_SIZE(tps6586x_irqs);
 348
 349         tps6586x->irq = irq;
 350
 351         mutex_init(&tps6586x->irq_lock);
 352         for (i = 0; i < 5; i++) {
 353                 tps6586x->mask_reg[i] = 0xff;
 354                 tps6586x_write(tps6586x->dev, TPS6586X_INT_MASK1 + i, 0xff);
 355         }
 356
 357         tps6586x_reads(tps6586x->dev, TPS6586X_INT_ACK1, sizeof(tmp), tmp);
 358
 359         if  (irq_base > 0) {
 360                 new_irq_base = irq_alloc_descs(irq_base, 0, irq_num, -1);
 361                 if (new_irq_base < 0) {
 362                         dev_err(tps6586x->dev,
 363                                 "Failed to alloc IRQs: %d\n", new_irq_base);
 364                         return new_irq_base;
 365                 }
 366         } else {
 367                 new_irq_base = 0;
 368         }
 369
 370         tps6586x->irq_domain = irq_domain_add_simple(tps6586x->dev->of_node,
 371                                 irq_num, new_irq_base, &tps6586x_domain_ops,
 372                                 tps6586x);
 373         if (!tps6586x->irq_domain) {
 374                 dev_err(tps6586x->dev, "Failed to create IRQ domain\n");
 375                 return -ENOMEM;
 376         }
 377         ret = request_threaded_irq(irq, NULL, tps6586x_irq, IRQF_ONESHOT,
 378                                    "tps6586x", tps6586x);
 379
 380         if (!ret)
 381                 device_init_wakeup(tps6586x->dev, 1);
 382
 383         return ret;
 384 }
 385
 386 static int tps6586x_add_subdevs(struct tps6586x *tps6586x,
 387                                           struct tps6586x_platform_data *pdata)
 388 {
 389         struct tps6586x_subdev_info *subdev;
 390         struct platform_device *pdev;
 391         int i, ret = 0;
 392
 393         for (i = 0; i < pdata->num_subdevs; i++) {
 394                 subdev = &pdata->subdevs[i];
 395
 396                 pdev = platform_device_alloc(subdev->name, subdev->id);
 397                 if (!pdev) {
 398                         ret = -ENOMEM;
 399                         goto failed;
 400                 }
 401
 402                 pdev->dev.parent = tps6586x->dev;
 403                 pdev->dev.platform_data = subdev->platform_data;
 404                 pdev->dev.of_node = subdev->of_node;
 405
 406                 ret = platform_device_add(pdev);
 407                 if (ret) {
 408                         platform_device_put(pdev);
 409                         goto failed;
 410                 }
 411         }
 412         return 0;
 413
 414 failed:
 415         tps6586x_remove_subdevs(tps6586x);
 416         return ret;
 417 }
 418
 419 #ifdef CONFIG_OF
 420 static struct tps6586x_platform_data *tps6586x_parse_dt(struct i2c_client *client)
 421 {
 422         struct device_node *np = client->dev.of_node;
 423         struct tps6586x_platform_data *pdata;
 424
 425         pdata = devm_kzalloc(&client->dev, sizeof(*pdata), GFP_KERNEL);
 426         if (!pdata) {
 427                 dev_err(&client->dev, "Memory allocation failed\n");
 428                 return NULL;
 429         }
 430
 431         pdata->num_subdevs = 0;
 432         pdata->subdevs = NULL;
 433         pdata->gpio_base = -1;
 434         pdata->irq_base = -1;
 435         pdata->pm_off = of_property_read_bool(np, "ti,system-power-controller");
 436
 437         return pdata;
 438 }
 439
 440 static const struct of_device_id tps6586x_of_match[] = {
 441         { .compatible = "ti,tps6586x", },
 442         { },
 443 };
 444 #else
 445 static struct tps6586x_platform_data *tps6586x_parse_dt(struct i2c_client *client)
 446 {
 447         return NULL;
 448 }
 449 #endif
 450
 451 static bool is_volatile_reg(struct device *dev, unsigned int reg)
 452 {
 453         /* Cache all interrupt mask register */
 454         if ((reg >= TPS6586X_INT_MASK1) && (reg <= TPS6586X_INT_MASK5))
 455                 return false;
 456
 457         return true;
 458 }
 459
 460 static const struct regmap_config tps6586x_regmap_config = {
 461         .reg_bits = 8,
 462         .val_bits = 8,
 463         .max_register = TPS6586X_MAX_REGISTER,
 464         .volatile_reg = is_volatile_reg,
 465         .cache_type = REGCACHE_RBTREE,
 466 };
 467
 468 static struct device *tps6586x_dev;
 469 static void tps6586x_power_off(void)
 470 {
 471         if (tps6586x_clr_bits(tps6586x_dev, TPS6586X_SUPPLYENE, EXITSLREQ_BIT))
 472                 return;
 473
 474         tps6586x_set_bits(tps6586x_dev, TPS6586X_SUPPLYENE, SLEEP_MODE_BIT);
 475 }
 476
 477 static void tps6586x_print_version(struct i2c_client *client, int version)
 478 {
 479         const char *name;
 480
 481         switch (version) {
 482         case TPS658621A:
 483                 name = "TPS658621A";
 484                 break;
 485         case TPS658621CD:
 486                 name = "TPS658621C/D";
 487                 break;
 488         case TPS658623:
 489                 name = "TPS658623";
 490                 break;
 491         case TPS658640:
 492         case TPS658640v2:
 493                 name = "TPS658640";
 494                 break;
 495         case TPS658643:
 496                 name = "TPS658643";
 497                 break;
 498         default:
 499                 name = "TPS6586X";
 500                 break;
 501         }
 502
 503         dev_info(&client->dev, "Found %s, VERSIONCRC is %02x\n", name, version);
 504 }
 505
 506 static int tps6586x_i2c_probe(struct i2c_client *client,
 507                                         const struct i2c_device_id *id)
 508 {
 509         struct tps6586x_platform_data *pdata = dev_get_platdata(&client->dev);
 510         struct tps6586x *tps6586x;
 511         int ret;
 512         int version;
 513
 514         if (!pdata && client->dev.of_node)
 515                 pdata = tps6586x_parse_dt(client);
 516
 517         if (!pdata) {
 518                 dev_err(&client->dev, "tps6586x requires platform data\n");
 519                 return -ENOTSUPP;
 520         }
 521
 522         version = i2c_smbus_read_byte_data(client, TPS6586X_VERSIONCRC);
 523         if (version < 0) {
 524                 dev_err(&client->dev, "Chip ID read failed: %d\n", version);
 525                 return -EIO;
 526         }
 527
 528         tps6586x = devm_kzalloc(&client->dev, sizeof(*tps6586x), GFP_KERNEL);
 529         if (!tps6586x)
 530                 return -ENOMEM;
 531
 532         tps6586x->version = version;
 533         tps6586x_print_version(client, tps6586x->version);
 534
 535         tps6586x->client = client;
 536         tps6586x->dev = &client->dev;
 537         i2c_set_clientdata(client, tps6586x);
 538
 539         tps6586x->regmap = devm_regmap_init_i2c(client,
 540                                         &tps6586x_regmap_config);
 541         if (IS_ERR(tps6586x->regmap)) {
 542                 ret = PTR_ERR(tps6586x->regmap);
 543                 dev_err(&client->dev, "regmap init failed: %d\n", ret);
 544                 return ret;
 545         }
 546
 547
 548         if (client->irq) {
 549                 ret = tps6586x_irq_init(tps6586x, client->irq,
 550                                         pdata->irq_base);
 551                 if (ret) {
 552                         dev_err(&client->dev, "IRQ init failed: %d\n", ret);
 553                         return ret;
 554                 }
 555         }
 556
 557         ret = mfd_add_devices(tps6586x->dev, -1,
 558                               tps6586x_cell, ARRAY_SIZE(tps6586x_cell),
 559                               NULL, 0, tps6586x->irq_domain);
 560         if (ret < 0) {
 561                 dev_err(&client->dev, "mfd_add_devices failed: %d\n", ret);
 562                 goto err_mfd_add;
 563         }
 564
 565         ret = tps6586x_add_subdevs(tps6586x, pdata);
 566         if (ret) {
 567                 dev_err(&client->dev, "add devices failed: %d\n", ret);
 568                 goto err_add_devs;
 569         }
 570
 571         if (pdata->pm_off && !pm_power_off) {
 572                 tps6586x_dev = &client->dev;
 573                 pm_power_off = tps6586x_power_off;
 574         }
 575
 576         return 0;
 577
 578 err_add_devs:
 579         mfd_remove_devices(tps6586x->dev);
 580 err_mfd_add:
 581         if (client->irq)
 582                 free_irq(client->irq, tps6586x);
 583         return ret;
 584 }
 585
 586 static int tps6586x_i2c_remove(struct i2c_client *client)
 587 {
 588         struct tps6586x *tps6586x = i2c_get_clientdata(client);
 589
 590         tps6586x_remove_subdevs(tps6586x);
 591         mfd_remove_devices(tps6586x->dev);
 592         if (client->irq)
 593                 free_irq(client->irq, tps6586x);
 594         return 0;
 595 }
 596
 597 static int __maybe_unused tps6586x_i2c_suspend(struct device *dev)
 598 {
 599         struct tps6586x *tps6586x = dev_get_drvdata(dev);
 600
 601         if (tps6586x->client->irq)
 602                 disable_irq(tps6586x->client->irq);
 603
 604         return 0;
 605 }
 606
 607 static int __maybe_unused tps6586x_i2c_resume(struct device *dev)
 608 {
 609         struct tps6586x *tps6586x = dev_get_drvdata(dev);
 610
 611         if (tps6586x->client->irq)
 612                 enable_irq(tps6586x->client->irq);
 613
 614         return 0;
 615 }
 616
 617 static SIMPLE_DEV_PM_OPS(tps6586x_pm_ops, tps6586x_i2c_suspend,
 618                          tps6586x_i2c_resume);
 619
 620 static const struct i2c_device_id tps6586x_id_table[] = {
 621         { "tps6586x", 0 },
 622         { },
 623 };
 624 MODULE_DEVICE_TABLE(i2c, tps6586x_id_table);
 625
 626 static struct i2c_driver tps6586x_driver = {
 627         .driver = {
 628                 .name   = "tps6586x",
 629                 .of_match_table = of_match_ptr(tps6586x_of_match),
 630                 .pm     = &tps6586x_pm_ops,
 631         },
 632         .probe          = tps6586x_i2c_probe,
 633         .remove         = tps6586x_i2c_remove,
 634         .id_table       = tps6586x_id_table,
 635 };
 636
 637 static int __init tps6586x_init(void)
 638 {
 639         return i2c_add_driver(&tps6586x_driver);
 640 }
 641 subsys_initcall(tps6586x_init);
 642
 643 static void __exit tps6586x_exit(void)
 644 {
 645         i2c_del_driver(&tps6586x_driver);
 646 }
 647 module_exit(tps6586x_exit);
 648
 649 MODULE_DESCRIPTION("TPS6586X core driver");
 650 MODULE_AUTHOR("Mike Rapoport <mike@compulab.co.il>");
 651 MODULE_LICENSE("GPL");