drivers/mfd/ab8500-core.c

   1 /*
   2  * Copyright (C) ST-Ericsson SA 2010
   3  *
   4  * License Terms: GNU General Public License v2
   5  * Author: Srinidhi Kasagar <srinidhi.kasagar@stericsson.com>
   6  * Author: Rabin Vincent <rabin.vincent@stericsson.com>
   7  * Author: Mattias Wallin <mattias.wallin@stericsson.com>
   8  */
   9
  10 #include <linux/kernel.h>
  11 #include <linux/slab.h>
  12 #include <linux/init.h>
  13 #include <linux/irq.h>
  14 #include <linux/irqdomain.h>
  15 #include <linux/delay.h>
  16 #include <linux/interrupt.h>
  17 #include <linux/module.h>
  18 #include <linux/platform_device.h>
  19 #include <linux/mfd/core.h>
  20 #include <linux/mfd/abx500.h>
  21 #include <linux/mfd/abx500/ab8500.h>
  22 #include <linux/mfd/abx500/ab8500-bm.h>
  23 #include <linux/mfd/dbx500-prcmu.h>
  24 #include <linux/regulator/ab8500.h>
  25 #include <linux/of.h>
  26 #include <linux/of_device.h>
  27
  28 /*
  29  * Interrupt register offsets
  30  * Bank : 0x0E
  31  */
  32 #define AB8500_IT_SOURCE1_REG           0x00
  33 #define AB8500_IT_SOURCE2_REG           0x01
  34 #define AB8500_IT_SOURCE3_REG           0x02
  35 #define AB8500_IT_SOURCE4_REG           0x03
  36 #define AB8500_IT_SOURCE5_REG           0x04
  37 #define AB8500_IT_SOURCE6_REG           0x05
  38 #define AB8500_IT_SOURCE7_REG           0x06
  39 #define AB8500_IT_SOURCE8_REG           0x07
  40 #define AB9540_IT_SOURCE13_REG          0x0C
  41 #define AB8500_IT_SOURCE19_REG          0x12
  42 #define AB8500_IT_SOURCE20_REG          0x13
  43 #define AB8500_IT_SOURCE21_REG          0x14
  44 #define AB8500_IT_SOURCE22_REG          0x15
  45 #define AB8500_IT_SOURCE23_REG          0x16
  46 #define AB8500_IT_SOURCE24_REG          0x17
  47
  48 /*
  49  * latch registers
  50  */
  51 #define AB8500_IT_LATCH1_REG            0x20
  52 #define AB8500_IT_LATCH2_REG            0x21
  53 #define AB8500_IT_LATCH3_REG            0x22
  54 #define AB8500_IT_LATCH4_REG            0x23
  55 #define AB8500_IT_LATCH5_REG            0x24
  56 #define AB8500_IT_LATCH6_REG            0x25
  57 #define AB8500_IT_LATCH7_REG            0x26
  58 #define AB8500_IT_LATCH8_REG            0x27
  59 #define AB8500_IT_LATCH9_REG            0x28
  60 #define AB8500_IT_LATCH10_REG           0x29
  61 #define AB8500_IT_LATCH12_REG           0x2B
  62 #define AB9540_IT_LATCH13_REG           0x2C
  63 #define AB8500_IT_LATCH19_REG           0x32
  64 #define AB8500_IT_LATCH20_REG           0x33
  65 #define AB8500_IT_LATCH21_REG           0x34
  66 #define AB8500_IT_LATCH22_REG           0x35
  67 #define AB8500_IT_LATCH23_REG           0x36
  68 #define AB8500_IT_LATCH24_REG           0x37
  69
  70 /*
  71  * mask registers
  72  */
  73
  74 #define AB8500_IT_MASK1_REG             0x40
  75 #define AB8500_IT_MASK2_REG             0x41
  76 #define AB8500_IT_MASK3_REG             0x42
  77 #define AB8500_IT_MASK4_REG             0x43
  78 #define AB8500_IT_MASK5_REG             0x44
  79 #define AB8500_IT_MASK6_REG             0x45
  80 #define AB8500_IT_MASK7_REG             0x46
  81 #define AB8500_IT_MASK8_REG             0x47
  82 #define AB8500_IT_MASK9_REG             0x48
  83 #define AB8500_IT_MASK10_REG            0x49
  84 #define AB8500_IT_MASK11_REG            0x4A
  85 #define AB8500_IT_MASK12_REG            0x4B
  86 #define AB8500_IT_MASK13_REG            0x4C
  87 #define AB8500_IT_MASK14_REG            0x4D
  88 #define AB8500_IT_MASK15_REG            0x4E
  89 #define AB8500_IT_MASK16_REG            0x4F
  90 #define AB8500_IT_MASK17_REG            0x50
  91 #define AB8500_IT_MASK18_REG            0x51
  92 #define AB8500_IT_MASK19_REG            0x52
  93 #define AB8500_IT_MASK20_REG            0x53
  94 #define AB8500_IT_MASK21_REG            0x54
  95 #define AB8500_IT_MASK22_REG            0x55
  96 #define AB8500_IT_MASK23_REG            0x56
  97 #define AB8500_IT_MASK24_REG            0x57
  98 #define AB8500_IT_MASK25_REG            0x58
  99
 100 /*
 101  * latch hierarchy registers
 102  */
 103 #define AB8500_IT_LATCHHIER1_REG        0x60
 104 #define AB8500_IT_LATCHHIER2_REG        0x61
 105 #define AB8500_IT_LATCHHIER3_REG        0x62
 106 #define AB8540_IT_LATCHHIER4_REG        0x63
 107
 108 #define AB8500_IT_LATCHHIER_NUM         3
 109 #define AB8540_IT_LATCHHIER_NUM         4
 110
 111 #define AB8500_REV_REG                  0x80
 112 #define AB8500_IC_NAME_REG              0x82
 113 #define AB8500_SWITCH_OFF_STATUS        0x00
 114
 115 #define AB8500_TURN_ON_STATUS           0x00
 116 #define AB8505_TURN_ON_STATUS_2         0x04
 117
 118 #define AB8500_CH_USBCH_STAT1_REG       0x02
 119 #define VBUS_DET_DBNC100                0x02
 120 #define VBUS_DET_DBNC1                  0x01
 121
 122 static DEFINE_SPINLOCK(on_stat_lock);
 123 static u8 turn_on_stat_mask = 0xFF;
 124 static u8 turn_on_stat_set;
 125 static bool no_bm; /* No battery management */
 126 module_param(no_bm, bool, S_IRUGO);
 127
 128 #define AB9540_MODEM_CTRL2_REG                  0x23
 129 #define AB9540_MODEM_CTRL2_SWDBBRSTN_BIT        BIT(2)
 130
 131 /*
 132  * Map interrupt numbers to the LATCH and MASK register offsets, Interrupt
 133  * numbers are indexed into this array with (num / 8). The interupts are
 134  * defined in linux/mfd/ab8500.h
 135  *
 136  * This is one off from the register names, i.e. AB8500_IT_MASK1_REG is at
 137  * offset 0.
 138  */
 139 /* AB8500 support */
 140 static const int ab8500_irq_regoffset[AB8500_NUM_IRQ_REGS] = {
 141         0, 1, 2, 3, 4, 6, 7, 8, 9, 11, 18, 19, 20, 21,
 142 };
 143
 144 /* AB9540 / AB8505 support */
 145 static const int ab9540_irq_regoffset[AB9540_NUM_IRQ_REGS] = {
 146         0, 1, 2, 3, 4, 6, 7, 8, 9, 11, 18, 19, 20, 21, 12, 13, 24, 5, 22, 23
 147 };
 148
 149 /* AB8540 support */
 150 static const int ab8540_irq_regoffset[AB8540_NUM_IRQ_REGS] = {
 151         0, 1, 2, 3, 4, -1, -1, -1, -1, 11, 18, 19, 20, 21, 12, 13, 24, 5, 22,
 152         23, 25, 26, 27, 28, 29, 30, 31,
 153 };
 154
 155 static const char ab8500_version_str[][7] = {
 156         [AB8500_VERSION_AB8500] = "AB8500",
 157         [AB8500_VERSION_AB8505] = "AB8505",
 158         [AB8500_VERSION_AB9540] = "AB9540",
 159         [AB8500_VERSION_AB8540] = "AB8540",
 160 };
 161
 162 static int ab8500_prcmu_write(struct ab8500 *ab8500, u16 addr, u8 data)
 163 {
 164         int ret;
 165
 166         ret = prcmu_abb_write((u8)(addr >> 8), (u8)(addr & 0xFF), &data, 1);
 167         if (ret < 0)
 168                 dev_err(ab8500->dev, "prcmu i2c error %d\n", ret);
 169         return ret;
 170 }
 171
 172 static int ab8500_prcmu_write_masked(struct ab8500 *ab8500, u16 addr, u8 mask,
 173         u8 data)
 174 {
 175         int ret;
 176
 177         ret = prcmu_abb_write_masked((u8)(addr >> 8), (u8)(addr & 0xFF), &data,
 178                 &mask, 1);
 179         if (ret < 0)
 180                 dev_err(ab8500->dev, "prcmu i2c error %d\n", ret);
 181         return ret;
 182 }
 183
 184 static int ab8500_prcmu_read(struct ab8500 *ab8500, u16 addr)
 185 {
 186         int ret;
 187         u8 data;
 188
 189         ret = prcmu_abb_read((u8)(addr >> 8), (u8)(addr & 0xFF), &data, 1);
 190         if (ret < 0) {
 191                 dev_err(ab8500->dev, "prcmu i2c error %d\n", ret);
 192                 return ret;
 193         }
 194         return (int)data;
 195 }
 196
 197 static int ab8500_get_chip_id(struct device *dev)
 198 {
 199         struct ab8500 *ab8500;
 200
 201         if (!dev)
 202                 return -EINVAL;
 203         ab8500 = dev_get_drvdata(dev->parent);
 204         return ab8500 ? (int)ab8500->chip_id : -EINVAL;
 205 }
 206
 207 static int set_register_interruptible(struct ab8500 *ab8500, u8 bank,
 208         u8 reg, u8 data)
 209 {
 210         int ret;
 211         /*
 212          * Put the u8 bank and u8 register together into a an u16.
 213          * The bank on higher 8 bits and register in lower 8 bits.
 214          */
 215         u16 addr = ((u16)bank) << 8 | reg;
 216
 217         dev_vdbg(ab8500->dev, "wr: addr %#x <= %#x\n", addr, data);
 218
 219         mutex_lock(&ab8500->lock);
 220
 221         ret = ab8500->write(ab8500, addr, data);
 222         if (ret < 0)
 223                 dev_err(ab8500->dev, "failed to write reg %#x: %d\n",
 224                         addr, ret);
 225         mutex_unlock(&ab8500->lock);
 226
 227         return ret;
 228 }
 229
 230 static int ab8500_set_register(struct device *dev, u8 bank,
 231         u8 reg, u8 value)
 232 {
 233         int ret;
 234         struct ab8500 *ab8500 = dev_get_drvdata(dev->parent);
 235
 236         atomic_inc(&ab8500->transfer_ongoing);
 237         ret = set_register_interruptible(ab8500, bank, reg, value);
 238         atomic_dec(&ab8500->transfer_ongoing);
 239         return ret;
 240 }
 241
 242 static int get_register_interruptible(struct ab8500 *ab8500, u8 bank,
 243         u8 reg, u8 *value)
 244 {
 245         int ret;
 246         u16 addr = ((u16)bank) << 8 | reg;
 247
 248         mutex_lock(&ab8500->lock);
 249
 250         ret = ab8500->read(ab8500, addr);
 251         if (ret < 0)
 252                 dev_err(ab8500->dev, "failed to read reg %#x: %d\n",
 253                         addr, ret);
 254         else
 255                 *value = ret;
 256
 257         mutex_unlock(&ab8500->lock);
 258         dev_vdbg(ab8500->dev, "rd: addr %#x => data %#x\n", addr, ret);
 259
 260         return ret;
 261 }
 262
 263 static int ab8500_get_register(struct device *dev, u8 bank,
 264         u8 reg, u8 *value)
 265 {
 266         int ret;
 267         struct ab8500 *ab8500 = dev_get_drvdata(dev->parent);
 268
 269         atomic_inc(&ab8500->transfer_ongoing);
 270         ret = get_register_interruptible(ab8500, bank, reg, value);
 271         atomic_dec(&ab8500->transfer_ongoing);
 272         return ret;
 273 }
 274
 275 static int mask_and_set_register_interruptible(struct ab8500 *ab8500, u8 bank,
 276         u8 reg, u8 bitmask, u8 bitvalues)
 277 {
 278         int ret;
 279         u16 addr = ((u16)bank) << 8 | reg;
 280
 281         mutex_lock(&ab8500->lock);
 282
 283         if (ab8500->write_masked == NULL) {
 284                 u8 data;
 285
 286                 ret = ab8500->read(ab8500, addr);
 287                 if (ret < 0) {
 288                         dev_err(ab8500->dev, "failed to read reg %#x: %d\n",
 289                                 addr, ret);
 290                         goto out;
 291                 }
 292
 293                 data = (u8)ret;
 294                 data = (~bitmask & data) | (bitmask & bitvalues);
 295
 296                 ret = ab8500->write(ab8500, addr, data);
 297                 if (ret < 0)
 298                         dev_err(ab8500->dev, "failed to write reg %#x: %d\n",
 299                                 addr, ret);
 300
 301                 dev_vdbg(ab8500->dev, "mask: addr %#x => data %#x\n", addr,
 302                         data);
 303                 goto out;
 304         }
 305         ret = ab8500->write_masked(ab8500, addr, bitmask, bitvalues);
 306         if (ret < 0)
 307                 dev_err(ab8500->dev, "failed to modify reg %#x: %d\n", addr,
 308                         ret);
 309 out:
 310         mutex_unlock(&ab8500->lock);
 311         return ret;
 312 }
 313
 314 static int ab8500_mask_and_set_register(struct device *dev,
 315         u8 bank, u8 reg, u8 bitmask, u8 bitvalues)
 316 {
 317         int ret;
 318         struct ab8500 *ab8500 = dev_get_drvdata(dev->parent);
 319
 320         atomic_inc(&ab8500->transfer_ongoing);
 321         ret = mask_and_set_register_interruptible(ab8500, bank, reg,
 322                                                  bitmask, bitvalues);
 323         atomic_dec(&ab8500->transfer_ongoing);
 324         return ret;
 325 }
 326
 327 static struct abx500_ops ab8500_ops = {
 328         .get_chip_id = ab8500_get_chip_id,
 329         .get_register = ab8500_get_register,
 330         .set_register = ab8500_set_register,
 331         .get_register_page = NULL,
 332         .set_register_page = NULL,
 333         .mask_and_set_register = ab8500_mask_and_set_register,
 334         .event_registers_startup_state_get = NULL,
 335         .startup_irq_enabled = NULL,
 336         .dump_all_banks = ab8500_dump_all_banks,
 337 };
 338
 339 static void ab8500_irq_lock(struct irq_data *data)
 340 {
 341         struct ab8500 *ab8500 = irq_data_get_irq_chip_data(data);
 342
 343         mutex_lock(&ab8500->irq_lock);
 344         atomic_inc(&ab8500->transfer_ongoing);
 345 }
 346
 347 static void ab8500_irq_sync_unlock(struct irq_data *data)
 348 {
 349         struct ab8500 *ab8500 = irq_data_get_irq_chip_data(data);
 350         int i;
 351
 352         for (i = 0; i < ab8500->mask_size; i++) {
 353                 u8 old = ab8500->oldmask[i];
 354                 u8 new = ab8500->mask[i];
 355                 int reg;
 356
 357                 if (new == old)
 358                         continue;
 359
 360                 /*
 361                  * Interrupt register 12 doesn't exist prior to AB8500 version
 362                  * 2.0
 363                  */
 364                 if (ab8500->irq_reg_offset[i] == 11 &&
 365                         is_ab8500_1p1_or_earlier(ab8500))
 366                         continue;
 367
 368                 if (ab8500->irq_reg_offset[i] < 0)
 369                         continue;
 370
 371                 ab8500->oldmask[i] = new;
 372
 373                 reg = AB8500_IT_MASK1_REG + ab8500->irq_reg_offset[i];
 374                 set_register_interruptible(ab8500, AB8500_INTERRUPT, reg, new);
 375         }
 376         atomic_dec(&ab8500->transfer_ongoing);
 377         mutex_unlock(&ab8500->irq_lock);
 378 }
 379
 380 static void ab8500_irq_mask(struct irq_data *data)
 381 {
 382         struct ab8500 *ab8500 = irq_data_get_irq_chip_data(data);
 383         int offset = data->hwirq;
 384         int index = offset / 8;
 385         int mask = 1 << (offset % 8);
 386
 387         ab8500->mask[index] |= mask;
 388
 389         /* The AB8500 GPIOs have two interrupts each (rising & falling). */
 390         if (offset >= AB8500_INT_GPIO6R && offset <= AB8500_INT_GPIO41R)
 391                 ab8500->mask[index + 2] |= mask;
 392         if (offset >= AB9540_INT_GPIO50R && offset <= AB9540_INT_GPIO54R)
 393                 ab8500->mask[index + 1] |= mask;
 394         if (offset == AB8540_INT_GPIO43R || offset == AB8540_INT_GPIO44R)
 395                 /* Here the falling IRQ is one bit lower */
 396                 ab8500->mask[index] |= (mask << 1);
 397 }
 398
 399 static void ab8500_irq_unmask(struct irq_data *data)
 400 {
 401         struct ab8500 *ab8500 = irq_data_get_irq_chip_data(data);
 402         unsigned int type = irqd_get_trigger_type(data);
 403         int offset = data->hwirq;
 404         int index = offset / 8;
 405         int mask = 1 << (offset % 8);
 406
 407         if (type & IRQ_TYPE_EDGE_RISING)
 408                 ab8500->mask[index] &= ~mask;
 409
 410         /* The AB8500 GPIOs have two interrupts each (rising & falling). */
 411         if (type & IRQ_TYPE_EDGE_FALLING) {
 412                 if (offset >= AB8500_INT_GPIO6R && offset <= AB8500_INT_GPIO41R)
 413                         ab8500->mask[index + 2] &= ~mask;
 414                 else if (offset >= AB9540_INT_GPIO50R &&
 415                          offset <= AB9540_INT_GPIO54R)
 416                         ab8500->mask[index + 1] &= ~mask;
 417                 else if (offset == AB8540_INT_GPIO43R ||
 418                          offset == AB8540_INT_GPIO44R)
 419                         /* Here the falling IRQ is one bit lower */
 420                         ab8500->mask[index] &= ~(mask << 1);
 421                 else
 422                         ab8500->mask[index] &= ~mask;
 423         } else {
 424                 /* Satisfies the case where type is not set. */
 425                 ab8500->mask[index] &= ~mask;
 426         }
 427 }
 428
 429 static int ab8500_irq_set_type(struct irq_data *data, unsigned int type)
 430 {
 431         return 0;
 432 }
 433
 434 static struct irq_chip ab8500_irq_chip = {
 435         .name                   = "ab8500",
 436         .irq_bus_lock           = ab8500_irq_lock,
 437         .irq_bus_sync_unlock    = ab8500_irq_sync_unlock,
 438         .irq_mask               = ab8500_irq_mask,
 439         .irq_disable            = ab8500_irq_mask,
 440         .irq_unmask             = ab8500_irq_unmask,
 441         .irq_set_type           = ab8500_irq_set_type,
 442 };
 443
 444 static void update_latch_offset(u8 *offset, int i)
 445 {
 446         /* Fix inconsistent ITFromLatch25 bit mapping... */
 447         if (unlikely(*offset == 17))
 448                 *offset = 24;
 449         /* Fix inconsistent ab8540 bit mapping... */
 450         if (unlikely(*offset == 16))
 451                 *offset = 25;
 452         if ((i == 3) && (*offset >= 24))
 453                 *offset += 2;
 454 }
 455
 456 static int ab8500_handle_hierarchical_line(struct ab8500 *ab8500,
 457                                         int latch_offset, u8 latch_val)
 458 {
 459         int int_bit, line, i;
 460
 461         for (i = 0; i < ab8500->mask_size; i++)
 462                 if (ab8500->irq_reg_offset[i] == latch_offset)
 463                         break;
 464
 465         if (i >= ab8500->mask_size) {
 466                 dev_err(ab8500->dev, "Register offset 0x%2x not declared\n",
 467                                 latch_offset);
 468                 return -ENXIO;
 469         }
 470
 471         /* ignore masked out interrupts */
 472         latch_val &= ~ab8500->mask[i];
 473
 474         while (latch_val) {
 475                 int_bit = __ffs(latch_val);
 476                 line = (i << 3) + int_bit;
 477                 latch_val &= ~(1 << int_bit);
 478
 479                 /*
 480                  * This handles the falling edge hwirqs from the GPIO
 481                  * lines. Route them back to the line registered for the
 482                  * rising IRQ, as this is merely a flag for the same IRQ
 483                  * in linux terms.
 484                  */
 485                 if (line >= AB8500_INT_GPIO6F && line <= AB8500_INT_GPIO41F)
 486                         line -= 16;
 487                 if (line >= AB9540_INT_GPIO50F && line <= AB9540_INT_GPIO54F)
 488                         line -= 8;
 489                 if (line == AB8540_INT_GPIO43F || line == AB8540_INT_GPIO44F)
 490                         line += 1;
 491
 492                 handle_nested_irq(irq_create_mapping(ab8500->domain, line));
 493         }
 494
 495         return 0;
 496 }
 497
 498 static int ab8500_handle_hierarchical_latch(struct ab8500 *ab8500,
 499                                         int hier_offset, u8 hier_val)
 500 {
 501         int latch_bit, status;
 502         u8 latch_offset, latch_val;
 503
 504         do {
 505                 latch_bit = __ffs(hier_val);
 506                 latch_offset = (hier_offset << 3) + latch_bit;
 507
 508                 update_latch_offset(&latch_offset, hier_offset);
 509
 510                 status = get_register_interruptible(ab8500,
 511                                 AB8500_INTERRUPT,
 512                                 AB8500_IT_LATCH1_REG + latch_offset,
 513                                 &latch_val);
 514                 if (status < 0 || latch_val == 0)
 515                         goto discard;
 516
 517                 status = ab8500_handle_hierarchical_line(ab8500,
 518                                 latch_offset, latch_val);
 519                 if (status < 0)
 520                         return status;
 521 discard:
 522                 hier_val &= ~(1 << latch_bit);
 523         } while (hier_val);
 524
 525         return 0;
 526 }
 527
 528 static irqreturn_t ab8500_hierarchical_irq(int irq, void *dev)
 529 {
 530         struct ab8500 *ab8500 = dev;
 531         u8 i;
 532
 533         dev_vdbg(ab8500->dev, "interrupt\n");
 534
 535         /*  Hierarchical interrupt version */
 536         for (i = 0; i < (ab8500->it_latchhier_num); i++) {
 537                 int status;
 538                 u8 hier_val;
 539
 540                 status = get_register_interruptible(ab8500, AB8500_INTERRUPT,
 541                         AB8500_IT_LATCHHIER1_REG + i, &hier_val);
 542                 if (status < 0 || hier_val == 0)
 543                         continue;
 544
 545                 status = ab8500_handle_hierarchical_latch(ab8500, i, hier_val);
 546                 if (status < 0)
 547                         break;
 548         }
 549         return IRQ_HANDLED;
 550 }
 551
 552 static int ab8500_irq_map(struct irq_domain *d, unsigned int virq,
 553                                 irq_hw_number_t hwirq)
 554 {
 555         struct ab8500 *ab8500 = d->host_data;
 556
 557         if (!ab8500)
 558                 return -EINVAL;
 559
 560         irq_set_chip_data(virq, ab8500);
 561         irq_set_chip_and_handler(virq, &ab8500_irq_chip,
 562                                 handle_simple_irq);
 563         irq_set_nested_thread(virq, 1);
 564         irq_set_noprobe(virq);
 565
 566         return 0;
 567 }
 568
 569 static const struct irq_domain_ops ab8500_irq_ops = {
 570         .map    = ab8500_irq_map,
 571         .xlate  = irq_domain_xlate_twocell,
 572 };
 573
 574 static int ab8500_irq_init(struct ab8500 *ab8500, struct device_node *np)
 575 {
 576         int num_irqs;
 577
 578         if (is_ab8540(ab8500))
 579                 num_irqs = AB8540_NR_IRQS;
 580         else if (is_ab9540(ab8500))
 581                 num_irqs = AB9540_NR_IRQS;
 582         else if (is_ab8505(ab8500))
 583                 num_irqs = AB8505_NR_IRQS;
 584         else
 585                 num_irqs = AB8500_NR_IRQS;
 586
 587         /* If ->irq_base is zero this will give a linear mapping */
 588         ab8500->domain = irq_domain_add_simple(ab8500->dev->of_node,
 589                                                num_irqs, 0,
 590                                                &ab8500_irq_ops, ab8500);
 591
 592         if (!ab8500->domain) {
 593                 dev_err(ab8500->dev, "Failed to create irqdomain\n");
 594                 return -ENODEV;
 595         }
 596
 597         return 0;
 598 }
 599
 600 int ab8500_suspend(struct ab8500 *ab8500)
 601 {
 602         if (atomic_read(&ab8500->transfer_ongoing))
 603                 return -EINVAL;
 604
 605         return 0;
 606 }
 607
 608 static const struct mfd_cell ab8500_bm_devs[] = {
 609         {
 610                 .name = "ab8500-charger",
 611                 .of_compatible = "stericsson,ab8500-charger",
 612                 .platform_data = &ab8500_bm_data,
 613                 .pdata_size = sizeof(ab8500_bm_data),
 614         },
 615         {
 616                 .name = "ab8500-btemp",
 617                 .of_compatible = "stericsson,ab8500-btemp",
 618                 .platform_data = &ab8500_bm_data,
 619                 .pdata_size = sizeof(ab8500_bm_data),
 620         },
 621         {
 622                 .name = "ab8500-fg",
 623                 .of_compatible = "stericsson,ab8500-fg",
 624                 .platform_data = &ab8500_bm_data,
 625                 .pdata_size = sizeof(ab8500_bm_data),
 626         },
 627         {
 628                 .name = "ab8500-chargalg",
 629                 .of_compatible = "stericsson,ab8500-chargalg",
 630                 .platform_data = &ab8500_bm_data,
 631                 .pdata_size = sizeof(ab8500_bm_data),
 632         },
 633 };
 634
 635 static const struct mfd_cell ab8500_devs[] = {
 636 #ifdef CONFIG_DEBUG_FS
 637         {
 638                 .name = "ab8500-debug",
 639                 .of_compatible = "stericsson,ab8500-debug",
 640         },
 641 #endif
 642         {
 643                 .name = "ab8500-sysctrl",
 644                 .of_compatible = "stericsson,ab8500-sysctrl",
 645         },
 646         {
 647                 .name = "ab8500-ext-regulator",
 648                 .of_compatible = "stericsson,ab8500-ext-regulator",
 649         },
 650         {
 651                 .name = "ab8500-regulator",
 652                 .of_compatible = "stericsson,ab8500-regulator",
 653         },
 654         {
 655                 .name = "abx500-clk",
 656                 .of_compatible = "stericsson,abx500-clk",
 657         },
 658         {
 659                 .name = "ab8500-gpadc",
 660                 .of_compatible = "stericsson,ab8500-gpadc",
 661         },
 662         {
 663                 .name = "ab8500-rtc",
 664                 .of_compatible = "stericsson,ab8500-rtc",
 665         },
 666         {
 667                 .name = "ab8500-acc-det",
 668                 .of_compatible = "stericsson,ab8500-acc-det",
 669         },
 670         {
 671
 672                 .name = "ab8500-poweron-key",
 673                 .of_compatible = "stericsson,ab8500-poweron-key",
 674         },
 675         {
 676                 .name = "ab8500-pwm",
 677                 .of_compatible = "stericsson,ab8500-pwm",
 678                 .id = 1,
 679         },
 680         {
 681                 .name = "ab8500-pwm",
 682                 .of_compatible = "stericsson,ab8500-pwm",
 683                 .id = 2,
 684         },
 685         {
 686                 .name = "ab8500-pwm",
 687                 .of_compatible = "stericsson,ab8500-pwm",
 688                 .id = 3,
 689         },
 690         {
 691                 .name = "ab8500-denc",
 692                 .of_compatible = "stericsson,ab8500-denc",
 693         },
 694         {
 695                 .name = "pinctrl-ab8500",
 696                 .of_compatible = "stericsson,ab8500-gpio",
 697         },
 698         {
 699                 .name = "abx500-temp",
 700                 .of_compatible = "stericsson,abx500-temp",
 701         },
 702         {
 703                 .name = "ab8500-usb",
 704                 .of_compatible = "stericsson,ab8500-usb",
 705         },
 706         {
 707                 .name = "ab8500-codec",
 708                 .of_compatible = "stericsson,ab8500-codec",
 709         },
 710 };
 711
 712 static const struct mfd_cell ab9540_devs[] = {
 713 #ifdef CONFIG_DEBUG_FS
 714         {
 715                 .name = "ab8500-debug",
 716         },
 717 #endif
 718         {
 719                 .name = "ab8500-sysctrl",
 720         },
 721         {
 722                 .name = "ab8500-ext-regulator",
 723         },
 724         {
 725                 .name = "ab8500-regulator",
 726         },
 727         {
 728                 .name = "abx500-clk",
 729                 .of_compatible = "stericsson,abx500-clk",
 730         },
 731         {
 732                 .name = "ab8500-gpadc",
 733                 .of_compatible = "stericsson,ab8500-gpadc",
 734         },
 735         {
 736                 .name = "ab8500-rtc",
 737         },
 738         {
 739                 .name = "ab8500-acc-det",
 740         },
 741         {
 742                 .name = "ab8500-poweron-key",
 743         },
 744         {
 745                 .name = "ab8500-pwm",
 746                 .id = 1,
 747         },
 748         {
 749                 .name = "abx500-temp",
 750         },
 751         {
 752                 .name = "pinctrl-ab9540",
 753                 .of_compatible = "stericsson,ab9540-gpio",
 754         },
 755         {
 756                 .name = "ab9540-usb",
 757         },
 758         {
 759                 .name = "ab9540-codec",
 760         },
 761         {
 762                 .name = "ab-iddet",
 763         },
 764 };
 765
 766 /* Device list for ab8505  */
 767 static const struct mfd_cell ab8505_devs[] = {
 768 #ifdef CONFIG_DEBUG_FS
 769         {
 770                 .name = "ab8500-debug",
 771         },
 772 #endif
 773         {
 774                 .name = "ab8500-sysctrl",
 775         },
 776         {
 777                 .name = "ab8500-regulator",
 778         },
 779         {
 780                 .name = "abx500-clk",
 781                 .of_compatible = "stericsson,abx500-clk",
 782         },
 783         {
 784                 .name = "ab8500-gpadc",
 785                 .of_compatible = "stericsson,ab8500-gpadc",
 786         },
 787         {
 788                 .name = "ab8500-rtc",
 789         },
 790         {
 791                 .name = "ab8500-acc-det",
 792         },
 793         {
 794                 .name = "ab8500-poweron-key",
 795         },
 796         {
 797                 .name = "ab8500-pwm",
 798                 .id = 1,
 799         },
 800         {
 801                 .name = "pinctrl-ab8505",
 802         },
 803         {
 804                 .name = "ab8500-usb",
 805         },
 806         {
 807                 .name = "ab8500-codec",
 808         },
 809         {
 810                 .name = "ab-iddet",
 811         },
 812 };
 813
 814 static const struct mfd_cell ab8540_devs[] = {
 815 #ifdef CONFIG_DEBUG_FS
 816         {
 817                 .name = "ab8500-debug",
 818         },
 819 #endif
 820         {
 821                 .name = "ab8500-sysctrl",
 822         },
 823         {
 824                 .name = "ab8500-ext-regulator",
 825         },
 826         {
 827                 .name = "ab8500-regulator",
 828         },
 829         {
 830                 .name = "abx500-clk",
 831                 .of_compatible = "stericsson,abx500-clk",
 832         },
 833         {
 834                 .name = "ab8500-gpadc",
 835                 .of_compatible = "stericsson,ab8500-gpadc",
 836         },
 837         {
 838                 .name = "ab8500-acc-det",
 839         },
 840         {
 841                 .name = "ab8500-poweron-key",
 842         },
 843         {
 844                 .name = "ab8500-pwm",
 845                 .id = 1,
 846         },
 847         {
 848                 .name = "abx500-temp",
 849         },
 850         {
 851                 .name = "pinctrl-ab8540",
 852         },
 853         {
 854                 .name = "ab8540-usb",
 855         },
 856         {
 857                 .name = "ab8540-codec",
 858         },
 859         {
 860                 .name = "ab-iddet",
 861         },
 862 };
 863
 864 static const struct mfd_cell ab8540_cut1_devs[] = {
 865         {
 866                 .name = "ab8500-rtc",
 867                 .of_compatible = "stericsson,ab8500-rtc",
 868         },
 869 };
 870
 871 static const struct mfd_cell ab8540_cut2_devs[] = {
 872         {
 873                 .name = "ab8540-rtc",
 874                 .of_compatible = "stericsson,ab8540-rtc",
 875         },
 876 };
 877
 878 static ssize_t show_chip_id(struct device *dev,
 879                                 struct device_attribute *attr, char *buf)
 880 {
 881         struct ab8500 *ab8500;
 882
 883         ab8500 = dev_get_drvdata(dev);
 884
 885         return sprintf(buf, "%#x\n", ab8500 ? ab8500->chip_id : -EINVAL);
 886 }
 887
 888 /*
 889  * ab8500 has switched off due to (SWITCH_OFF_STATUS):
 890  * 0x01 Swoff bit programming
 891  * 0x02 Thermal protection activation
 892  * 0x04 Vbat lower then BattOk falling threshold
 893  * 0x08 Watchdog expired
 894  * 0x10 Non presence of 32kHz clock
 895  * 0x20 Battery level lower than power on reset threshold
 896  * 0x40 Power on key 1 pressed longer than 10 seconds
 897  * 0x80 DB8500 thermal shutdown
 898  */
 899 static ssize_t show_switch_off_status(struct device *dev,
 900                                 struct device_attribute *attr, char *buf)
 901 {
 902         int ret;
 903         u8 value;
 904         struct ab8500 *ab8500;
 905
 906         ab8500 = dev_get_drvdata(dev);
 907         ret = get_register_interruptible(ab8500, AB8500_RTC,
 908                 AB8500_SWITCH_OFF_STATUS, &value);
 909         if (ret < 0)
 910                 return ret;
 911         return sprintf(buf, "%#x\n", value);
 912 }
 913
 914 /* use mask and set to override the register turn_on_stat value */
 915 void ab8500_override_turn_on_stat(u8 mask, u8 set)
 916 {
 917         spin_lock(&on_stat_lock);
 918         turn_on_stat_mask = mask;
 919         turn_on_stat_set = set;
 920         spin_unlock(&on_stat_lock);
 921 }
 922
 923 /*
 924  * ab8500 has turned on due to (TURN_ON_STATUS):
 925  * 0x01 PORnVbat
 926  * 0x02 PonKey1dbF
 927  * 0x04 PonKey2dbF
 928  * 0x08 RTCAlarm
 929  * 0x10 MainChDet
 930  * 0x20 VbusDet
 931  * 0x40 UsbIDDetect
 932  * 0x80 Reserved
 933  */
 934 static ssize_t show_turn_on_status(struct device *dev,
 935                                 struct device_attribute *attr, char *buf)
 936 {
 937         int ret;
 938         u8 value;
 939         struct ab8500 *ab8500;
 940
 941         ab8500 = dev_get_drvdata(dev);
 942         ret = get_register_interruptible(ab8500, AB8500_SYS_CTRL1_BLOCK,
 943                 AB8500_TURN_ON_STATUS, &value);
 944         if (ret < 0)
 945                 return ret;
 946
 947         /*
 948          * In L9540, turn_on_status register is not updated correctly if
 949          * the device is rebooted with AC/USB charger connected. Due to
 950          * this, the device boots android instead of entering into charge
 951          * only mode. Read the AC/USB status register to detect the charger
 952          * presence and update the turn on status manually.
 953          */
 954         if (is_ab9540(ab8500)) {
 955                 spin_lock(&on_stat_lock);
 956                 value = (value & turn_on_stat_mask) | turn_on_stat_set;
 957                 spin_unlock(&on_stat_lock);
 958         }
 959
 960         return sprintf(buf, "%#x\n", value);
 961 }
 962
 963 static ssize_t show_turn_on_status_2(struct device *dev,
 964                                 struct device_attribute *attr, char *buf)
 965 {
 966         int ret;
 967         u8 value;
 968         struct ab8500 *ab8500;
 969
 970         ab8500 = dev_get_drvdata(dev);
 971         ret = get_register_interruptible(ab8500, AB8500_SYS_CTRL1_BLOCK,
 972                 AB8505_TURN_ON_STATUS_2, &value);
 973         if (ret < 0)
 974                 return ret;
 975         return sprintf(buf, "%#x\n", (value & 0x1));
 976 }
 977
 978 static ssize_t show_ab9540_dbbrstn(struct device *dev,
 979                                 struct device_attribute *attr, char *buf)
 980 {
 981         struct ab8500 *ab8500;
 982         int ret;
 983         u8 value;
 984
 985         ab8500 = dev_get_drvdata(dev);
 986
 987         ret = get_register_interruptible(ab8500, AB8500_REGU_CTRL2,
 988                 AB9540_MODEM_CTRL2_REG, &value);
 989         if (ret < 0)
 990                 return ret;
 991
 992         return sprintf(buf, "%d\n",
 993                         (value & AB9540_MODEM_CTRL2_SWDBBRSTN_BIT) ? 1 : 0);
 994 }
 995
 996 static ssize_t store_ab9540_dbbrstn(struct device *dev,
 997         struct device_attribute *attr, const char *buf, size_t count)
 998 {
 999         struct ab8500 *ab8500;
1000         int ret = count;
1001         int err;
1002         u8 bitvalues;
1003
1004         ab8500 = dev_get_drvdata(dev);
1005
1006         if (count > 0) {
1007                 switch (buf[0]) {
1008                 case '0':
1009                         bitvalues = 0;
1010                         break;
1011                 case '1':
1012                         bitvalues = AB9540_MODEM_CTRL2_SWDBBRSTN_BIT;
1013                         break;
1014                 default:
1015                         goto exit;
1016                 }
1017
1018                 err = mask_and_set_register_interruptible(ab8500,
1019                         AB8500_REGU_CTRL2, AB9540_MODEM_CTRL2_REG,
1020                         AB9540_MODEM_CTRL2_SWDBBRSTN_BIT, bitvalues);
1021                 if (err)
1022                         dev_info(ab8500->dev,
1023                                 "Failed to set DBBRSTN %c, err %#x\n",
1024                                 buf[0], err);
1025         }
1026
1027 exit:
1028         return ret;
1029 }
1030
1031 static DEVICE_ATTR(chip_id, S_IRUGO, show_chip_id, NULL);
1032 static DEVICE_ATTR(switch_off_status, S_IRUGO, show_switch_off_status, NULL);
1033 static DEVICE_ATTR(turn_on_status, S_IRUGO, show_turn_on_status, NULL);
1034 static DEVICE_ATTR(turn_on_status_2, S_IRUGO, show_turn_on_status_2, NULL);
1035 static DEVICE_ATTR(dbbrstn, S_IRUGO | S_IWUSR,
1036                         show_ab9540_dbbrstn, store_ab9540_dbbrstn);
1037
1038 static struct attribute *ab8500_sysfs_entries[] = {
1039         &dev_attr_chip_id.attr,
1040         &dev_attr_switch_off_status.attr,
1041         &dev_attr_turn_on_status.attr,
1042         NULL,
1043 };
1044
1045 static struct attribute *ab8505_sysfs_entries[] = {
1046         &dev_attr_turn_on_status_2.attr,
1047         NULL,
1048 };
1049
1050 static struct attribute *ab9540_sysfs_entries[] = {
1051         &dev_attr_chip_id.attr,
1052         &dev_attr_switch_off_status.attr,
1053         &dev_attr_turn_on_status.attr,
1054         &dev_attr_dbbrstn.attr,
1055         NULL,
1056 };
1057
1058 static struct attribute_group ab8500_attr_group = {
1059         .attrs  = ab8500_sysfs_entries,
1060 };
1061
1062 static struct attribute_group ab8505_attr_group = {
1063         .attrs  = ab8505_sysfs_entries,
1064 };
1065
1066 static struct attribute_group ab9540_attr_group = {
1067         .attrs  = ab9540_sysfs_entries,
1068 };
1069
1070 static int ab8500_probe(struct platform_device *pdev)
1071 {
1072         static const char * const switch_off_status[] = {
1073                 "Swoff bit programming",
1074                 "Thermal protection activation",
1075                 "Vbat lower then BattOk falling threshold",
1076                 "Watchdog expired",
1077                 "Non presence of 32kHz clock",
1078                 "Battery level lower than power on reset threshold",
1079                 "Power on key 1 pressed longer than 10 seconds",
1080                 "DB8500 thermal shutdown"};
1081         static const char * const turn_on_status[] = {
1082                 "Battery rising (Vbat)",
1083                 "Power On Key 1 dbF",
1084                 "Power On Key 2 dbF",
1085                 "RTC Alarm",
1086                 "Main Charger Detect",
1087                 "Vbus Detect (USB)",
1088                 "USB ID Detect",
1089                 "UART Factory Mode Detect"};
1090         const struct platform_device_id *platid = platform_get_device_id(pdev);
1091         enum ab8500_version version = AB8500_VERSION_UNDEFINED;
1092         struct device_node *np = pdev->dev.of_node;
1093         struct ab8500 *ab8500;
1094         struct resource *resource;
1095         int ret;
1096         int i;
1097         u8 value;
1098
1099         ab8500 = devm_kzalloc(&pdev->dev, sizeof(*ab8500), GFP_KERNEL);
1100         if (!ab8500)
1101                 return -ENOMEM;
1102
1103         ab8500->dev = &pdev->dev;
1104
1105         resource = platform_get_resource(pdev, IORESOURCE_IRQ, 0);
1106         if (!resource) {
1107                 dev_err(&pdev->dev, "no IRQ resource\n");
1108                 return -ENODEV;
1109         }
1110
1111         ab8500->irq = resource->start;
1112
1113         ab8500->read = ab8500_prcmu_read;
1114         ab8500->write = ab8500_prcmu_write;
1115         ab8500->write_masked = ab8500_prcmu_write_masked;
1116
1117         mutex_init(&ab8500->lock);
1118         mutex_init(&ab8500->irq_lock);
1119         atomic_set(&ab8500->transfer_ongoing, 0);
1120
1121         platform_set_drvdata(pdev, ab8500);
1122
1123         if (platid)
1124                 version = platid->driver_data;
1125
1126         if (version != AB8500_VERSION_UNDEFINED)
1127                 ab8500->version = version;
1128         else {
1129                 ret = get_register_interruptible(ab8500, AB8500_MISC,
1130                         AB8500_IC_NAME_REG, &value);
1131                 if (ret < 0) {
1132                         dev_err(&pdev->dev, "could not probe HW\n");
1133                         return ret;
1134                 }
1135
1136                 ab8500->version = value;
1137         }
1138
1139         ret = get_register_interruptible(ab8500, AB8500_MISC,
1140                 AB8500_REV_REG, &value);
1141         if (ret < 0)
1142                 return ret;
1143
1144         ab8500->chip_id = value;
1145
1146         dev_info(ab8500->dev, "detected chip, %s rev. %1x.%1x\n",
1147                         ab8500_version_str[ab8500->version],
1148                         ab8500->chip_id >> 4,
1149                         ab8500->chip_id & 0x0F);
1150
1151         /* Configure AB8540 */
1152         if (is_ab8540(ab8500)) {
1153                 ab8500->mask_size = AB8540_NUM_IRQ_REGS;
1154                 ab8500->irq_reg_offset = ab8540_irq_regoffset;
1155                 ab8500->it_latchhier_num = AB8540_IT_LATCHHIER_NUM;
1156         } /* Configure AB8500 or AB9540 IRQ */
1157         else if (is_ab9540(ab8500) || is_ab8505(ab8500)) {
1158                 ab8500->mask_size = AB9540_NUM_IRQ_REGS;
1159                 ab8500->irq_reg_offset = ab9540_irq_regoffset;
1160                 ab8500->it_latchhier_num = AB8500_IT_LATCHHIER_NUM;
1161         } else {
1162                 ab8500->mask_size = AB8500_NUM_IRQ_REGS;
1163                 ab8500->irq_reg_offset = ab8500_irq_regoffset;
1164                 ab8500->it_latchhier_num = AB8500_IT_LATCHHIER_NUM;
1165         }
1166         ab8500->mask = devm_kzalloc(&pdev->dev, ab8500->mask_size,
1167                                     GFP_KERNEL);
1168         if (!ab8500->mask)
1169                 return -ENOMEM;
1170         ab8500->oldmask = devm_kzalloc(&pdev->dev, ab8500->mask_size,
1171                                        GFP_KERNEL);
1172         if (!ab8500->oldmask)
1173                 return -ENOMEM;
1174
1175         /*
1176          * ab8500 has switched off due to (SWITCH_OFF_STATUS):
1177          * 0x01 Swoff bit programming
1178          * 0x02 Thermal protection activation
1179          * 0x04 Vbat lower then BattOk falling threshold
1180          * 0x08 Watchdog expired
1181          * 0x10 Non presence of 32kHz clock
1182          * 0x20 Battery level lower than power on reset threshold
1183          * 0x40 Power on key 1 pressed longer than 10 seconds
1184          * 0x80 DB8500 thermal shutdown
1185          */
1186
1187         ret = get_register_interruptible(ab8500, AB8500_RTC,
1188                 AB8500_SWITCH_OFF_STATUS, &value);
1189         if (ret < 0)
1190                 return ret;
1191         dev_info(ab8500->dev, "switch off cause(s) (%#x): ", value);
1192
1193         if (value) {
1194                 for (i = 0; i < ARRAY_SIZE(switch_off_status); i++) {
1195                         if (value & 1)
1196                                 pr_cont(" \"%s\"", switch_off_status[i]);
1197                         value = value >> 1;
1198
1199                 }
1200                 pr_cont("\n");
1201         } else {
1202                 pr_cont(" None\n");
1203         }
1204         ret = get_register_interruptible(ab8500, AB8500_SYS_CTRL1_BLOCK,
1205                 AB8500_TURN_ON_STATUS, &value);
1206         if (ret < 0)
1207                 return ret;
1208         dev_info(ab8500->dev, "turn on reason(s) (%#x): ", value);
1209
1210         if (value) {
1211                 for (i = 0; i < ARRAY_SIZE(turn_on_status); i++) {
1212                         if (value & 1)
1213                                 pr_cont("\"%s\" ", turn_on_status[i]);
1214                         value = value >> 1;
1215                 }
1216                 pr_cont("\n");
1217         } else {
1218                 pr_cont("None\n");
1219         }
1220
1221         if (is_ab9540(ab8500)) {
1222                 ret = get_register_interruptible(ab8500, AB8500_CHARGER,
1223                         AB8500_CH_USBCH_STAT1_REG, &value);
1224                 if (ret < 0)
1225                         return ret;
1226                 if ((value & VBUS_DET_DBNC1) && (value & VBUS_DET_DBNC100))
1227                         ab8500_override_turn_on_stat(~AB8500_POW_KEY_1_ON,
1228                                                      AB8500_VBUS_DET);
1229         }
1230
1231         /* Clear and mask all interrupts */
1232         for (i = 0; i < ab8500->mask_size; i++) {
1233                 /*
1234                  * Interrupt register 12 doesn't exist prior to AB8500 version
1235                  * 2.0
1236                  */
1237                 if (ab8500->irq_reg_offset[i] == 11 &&
1238                                 is_ab8500_1p1_or_earlier(ab8500))
1239                         continue;
1240
1241                 if (ab8500->irq_reg_offset[i] < 0)
1242                         continue;
1243
1244                 get_register_interruptible(ab8500, AB8500_INTERRUPT,
1245                         AB8500_IT_LATCH1_REG + ab8500->irq_reg_offset[i],
1246                         &value);
1247                 set_register_interruptible(ab8500, AB8500_INTERRUPT,
1248                         AB8500_IT_MASK1_REG + ab8500->irq_reg_offset[i], 0xff);
1249         }
1250
1251         ret = abx500_register_ops(ab8500->dev, &ab8500_ops);
1252         if (ret)
1253                 return ret;
1254
1255         for (i = 0; i < ab8500->mask_size; i++)
1256                 ab8500->mask[i] = ab8500->oldmask[i] = 0xff;
1257
1258         ret = ab8500_irq_init(ab8500, np);
1259         if (ret)
1260                 return ret;
1261
1262         ret = devm_request_threaded_irq(&pdev->dev, ab8500->irq, NULL,
1263                         ab8500_hierarchical_irq,
1264                         IRQF_ONESHOT | IRQF_NO_SUSPEND,
1265                         "ab8500", ab8500);
1266         if (ret)
1267                 return ret;
1268
1269         if (is_ab9540(ab8500))
1270                 ret = mfd_add_devices(ab8500->dev, 0, ab9540_devs,
1271                                 ARRAY_SIZE(ab9540_devs), NULL,
1272                                 0, ab8500->domain);
1273         else if (is_ab8540(ab8500)) {
1274                 ret = mfd_add_devices(ab8500->dev, 0, ab8540_devs,
1275                               ARRAY_SIZE(ab8540_devs), NULL,
1276                               0, ab8500->domain);
1277                 if (ret)
1278                         return ret;
1279
1280                 if (is_ab8540_1p2_or_earlier(ab8500))
1281                         ret = mfd_add_devices(ab8500->dev, 0, ab8540_cut1_devs,
1282                               ARRAY_SIZE(ab8540_cut1_devs), NULL,
1283                               0, ab8500->domain);
1284                 else /* ab8540 >= cut2 */
1285                         ret = mfd_add_devices(ab8500->dev, 0, ab8540_cut2_devs,
1286                               ARRAY_SIZE(ab8540_cut2_devs), NULL,
1287                               0, ab8500->domain);
1288         } else if (is_ab8505(ab8500))
1289                 ret = mfd_add_devices(ab8500->dev, 0, ab8505_devs,
1290                               ARRAY_SIZE(ab8505_devs), NULL,
1291                               0, ab8500->domain);
1292         else
1293                 ret = mfd_add_devices(ab8500->dev, 0, ab8500_devs,
1294                                 ARRAY_SIZE(ab8500_devs), NULL,
1295                                 0, ab8500->domain);
1296         if (ret)
1297                 return ret;
1298
1299         if (!no_bm) {
1300                 /* Add battery management devices */
1301                 ret = mfd_add_devices(ab8500->dev, 0, ab8500_bm_devs,
1302                                       ARRAY_SIZE(ab8500_bm_devs), NULL,
1303                                       0, ab8500->domain);
1304                 if (ret)
1305                         dev_err(ab8500->dev, "error adding bm devices\n");
1306         }
1307
1308         if (((is_ab8505(ab8500) || is_ab9540(ab8500)) &&
1309                         ab8500->chip_id >= AB8500_CUT2P0) || is_ab8540(ab8500))
1310                 ret = sysfs_create_group(&ab8500->dev->kobj,
1311                                         &ab9540_attr_group);
1312         else
1313                 ret = sysfs_create_group(&ab8500->dev->kobj,
1314                                         &ab8500_attr_group);
1315
1316         if ((is_ab8505(ab8500) || is_ab9540(ab8500)) &&
1317                         ab8500->chip_id >= AB8500_CUT2P0)
1318                 ret = sysfs_create_group(&ab8500->dev->kobj,
1319                                          &ab8505_attr_group);
1320
1321         if (ret)
1322                 dev_err(ab8500->dev, "error creating sysfs entries\n");
1323
1324         return ret;
1325 }
1326
1327 static int ab8500_remove(struct platform_device *pdev)
1328 {
1329         struct ab8500 *ab8500 = platform_get_drvdata(pdev);
1330
1331         if (((is_ab8505(ab8500) || is_ab9540(ab8500)) &&
1332                         ab8500->chip_id >= AB8500_CUT2P0) || is_ab8540(ab8500))
1333                 sysfs_remove_group(&ab8500->dev->kobj, &ab9540_attr_group);
1334         else
1335                 sysfs_remove_group(&ab8500->dev->kobj, &ab8500_attr_group);
1336
1337         if ((is_ab8505(ab8500) || is_ab9540(ab8500)) &&
1338                         ab8500->chip_id >= AB8500_CUT2P0)
1339                 sysfs_remove_group(&ab8500->dev->kobj, &ab8505_attr_group);
1340
1341         mfd_remove_devices(ab8500->dev);
1342
1343         return 0;
1344 }
1345
1346 static const struct platform_device_id ab8500_id[] = {
1347         { "ab8500-core", AB8500_VERSION_AB8500 },
1348         { "ab8505-i2c", AB8500_VERSION_AB8505 },
1349         { "ab9540-i2c", AB8500_VERSION_AB9540 },
1350         { "ab8540-i2c", AB8500_VERSION_AB8540 },
1351         { }
1352 };
1353
1354 static struct platform_driver ab8500_core_driver = {
1355         .driver = {
1356                 .name = "ab8500-core",
1357         },
1358         .probe  = ab8500_probe,
1359         .remove = ab8500_remove,
1360         .id_table = ab8500_id,
1361 };
1362
1363 static int __init ab8500_core_init(void)
1364 {
1365         return platform_driver_register(&ab8500_core_driver);
1366 }
1367
1368 static void __exit ab8500_core_exit(void)
1369 {
1370         platform_driver_unregister(&ab8500_core_driver);
1371 }
1372 core_initcall(ab8500_core_init);
1373 module_exit(ab8500_core_exit);
1374
1375 MODULE_AUTHOR("Mattias Wallin, Srinidhi Kasagar, Rabin Vincent");
1376 MODULE_DESCRIPTION("AB8500 MFD core");
1377 MODULE_LICENSE("GPL v2");