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