linux/audit.h: move ptrace.h include to kernel header
[linux-2.6/linux-acpi-2.6/ibm-acpi-2.6.git] / drivers / mfd / ab8500-core.c
blobe1650badd106da6e3992b219e77fdc35e20ad1c8
1 /*
2 * Copyright (C) ST-Ericsson SA 2010
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 */
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>
28 * Interrupt register offsets
29 * Bank : 0x0E
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
48 * latch registers
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
70 * mask registers
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
99 * latch hierarchy registers
101 #define AB8500_IT_LATCHHIER1_REG 0x60
102 #define AB8500_IT_LATCHHIER2_REG 0x61
103 #define AB8500_IT_LATCHHIER3_REG 0x62
105 #define AB8500_IT_LATCHHIER_NUM 3
107 #define AB8500_REV_REG 0x80
108 #define AB8500_IC_NAME_REG 0x82
109 #define AB8500_SWITCH_OFF_STATUS 0x00
111 #define AB8500_TURN_ON_STATUS 0x00
113 static bool no_bm; /* No battery management */
114 module_param(no_bm, bool, S_IRUGO);
116 #define AB9540_MODEM_CTRL2_REG 0x23
117 #define AB9540_MODEM_CTRL2_SWDBBRSTN_BIT BIT(2)
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
124 * This is one off from the register names, i.e. AB8500_IT_MASK1_REG is at
125 * offset 0.
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,
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,
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",
144 static int ab8500_prcmu_write(struct ab8500 *ab8500, u16 addr, u8 data)
146 int ret;
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;
154 static int ab8500_prcmu_write_masked(struct ab8500 *ab8500, u16 addr, u8 mask,
155 u8 data)
157 int ret;
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;
166 static int ab8500_prcmu_read(struct ab8500 *ab8500, u16 addr)
168 int ret;
169 u8 data;
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;
176 return (int)data;
179 static int ab8500_get_chip_id(struct device *dev)
181 struct ab8500 *ab8500;
183 if (!dev)
184 return -EINVAL;
185 ab8500 = dev_get_drvdata(dev->parent);
186 return ab8500 ? (int)ab8500->chip_id : -EINVAL;
189 static int set_register_interruptible(struct ab8500 *ab8500, u8 bank,
190 u8 reg, u8 data)
192 int ret;
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;
199 dev_vdbg(ab8500->dev, "wr: addr %#x <= %#x\n", addr, data);
201 mutex_lock(&ab8500->lock);
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);
209 return ret;
212 static int ab8500_set_register(struct device *dev, u8 bank,
213 u8 reg, u8 value)
215 int ret;
216 struct ab8500 *ab8500 = dev_get_drvdata(dev->parent);
218 atomic_inc(&ab8500->transfer_ongoing);
219 ret = set_register_interruptible(ab8500, bank, reg, value);
220 atomic_dec(&ab8500->transfer_ongoing);
221 return ret;
224 static int get_register_interruptible(struct ab8500 *ab8500, u8 bank,
225 u8 reg, u8 *value)
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;
232 mutex_lock(&ab8500->lock);
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;
241 mutex_unlock(&ab8500->lock);
242 dev_vdbg(ab8500->dev, "rd: addr %#x => data %#x\n", addr, ret);
244 return ret;
247 static int ab8500_get_register(struct device *dev, u8 bank,
248 u8 reg, u8 *value)
250 int ret;
251 struct ab8500 *ab8500 = dev_get_drvdata(dev->parent);
253 atomic_inc(&ab8500->transfer_ongoing);
254 ret = get_register_interruptible(ab8500, bank, reg, value);
255 atomic_dec(&ab8500->transfer_ongoing);
256 return ret;
259 static int mask_and_set_register_interruptible(struct ab8500 *ab8500, u8 bank,
260 u8 reg, u8 bitmask, u8 bitvalues)
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;
267 mutex_lock(&ab8500->lock);
269 if (ab8500->write_masked == NULL) {
270 u8 data;
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;
279 data = (u8)ret;
280 data = (~bitmask & data) | (bitmask & bitvalues);
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);
287 dev_vdbg(ab8500->dev, "mask: addr %#x => data %#x\n", addr,
288 data);
289 goto out;
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;
300 static int ab8500_mask_and_set_register(struct device *dev,
301 u8 bank, u8 reg, u8 bitmask, u8 bitvalues)
303 int ret;
304 struct ab8500 *ab8500 = dev_get_drvdata(dev->parent);
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;
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,
324 static void ab8500_irq_lock(struct irq_data *data)
326 struct ab8500 *ab8500 = irq_data_get_irq_chip_data(data);
328 mutex_lock(&ab8500->irq_lock);
329 atomic_inc(&ab8500->transfer_ongoing);
332 static void ab8500_irq_sync_unlock(struct irq_data *data)
334 struct ab8500 *ab8500 = irq_data_get_irq_chip_data(data);
335 int i;
337 for (i = 0; i < ab8500->mask_size; i++) {
338 u8 old = ab8500->oldmask[i];
339 u8 new = ab8500->mask[i];
340 int reg;
342 if (new == old)
343 continue;
346 * Interrupt register 12 doesn't exist prior to AB8500 version
347 * 2.0
349 if (ab8500->irq_reg_offset[i] == 11 &&
350 is_ab8500_1p1_or_earlier(ab8500))
351 continue;
353 ab8500->oldmask[i] = new;
355 reg = AB8500_IT_MASK1_REG + ab8500->irq_reg_offset[i];
356 set_register_interruptible(ab8500, AB8500_INTERRUPT, reg, new);
358 atomic_dec(&ab8500->transfer_ongoing);
359 mutex_unlock(&ab8500->irq_lock);
362 static void ab8500_irq_mask(struct irq_data *data)
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);
369 ab8500->mask[index] |= mask;
372 static void ab8500_irq_unmask(struct irq_data *data)
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);
379 ab8500->mask[index] &= ~mask;
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,
391 static int ab8500_handle_hierarchical_line(struct ab8500 *ab8500,
392 int latch_offset, u8 latch_val)
394 int int_bit = __ffs(latch_val);
395 int line, i;
397 do {
398 int_bit = __ffs(latch_val);
400 for (i = 0; i < ab8500->mask_size; i++)
401 if (ab8500->irq_reg_offset[i] == latch_offset)
402 break;
404 if (i >= ab8500->mask_size) {
405 dev_err(ab8500->dev, "Register offset 0x%2x not declared\n",
406 latch_offset);
407 return -ENXIO;
410 line = (i << 3) + int_bit;
411 latch_val &= ~(1 << int_bit);
413 handle_nested_irq(ab8500->irq_base + line);
414 } while (latch_val);
416 return 0;
419 static int ab8500_handle_hierarchical_latch(struct ab8500 *ab8500,
420 int hier_offset, u8 hier_val)
422 int latch_bit, status;
423 u8 latch_offset, latch_val;
425 do {
426 latch_bit = __ffs(hier_val);
427 latch_offset = (hier_offset << 3) + latch_bit;
429 /* Fix inconsistent ITFromLatch25 bit mapping... */
430 if (unlikely(latch_offset == 17))
431 latch_offset = 24;
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;
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);
448 return 0;
451 static irqreturn_t ab8500_hierarchical_irq(int irq, void *dev)
453 struct ab8500 *ab8500 = dev;
454 u8 i;
456 dev_vdbg(ab8500->dev, "interrupt\n");
458 /* Hierarchical interrupt version */
459 for (i = 0; i < AB8500_IT_LATCHHIER_NUM; i++) {
460 int status;
461 u8 hier_val;
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;
468 status = ab8500_handle_hierarchical_latch(ab8500, i, hier_val);
469 if (status < 0)
470 break;
472 return IRQ_HANDLED;
476 * ab8500_irq_get_virq(): Map an interrupt on a chip to a virtual IRQ
478 * @ab8500: ab8500_irq controller to operate on.
479 * @irq: index of the interrupt requested in the chip IRQs
481 * Useful for drivers to request their own IRQs.
483 static int ab8500_irq_get_virq(struct ab8500 *ab8500, int irq)
485 if (!ab8500)
486 return -EINVAL;
488 return irq_create_mapping(ab8500->domain, irq);
491 static irqreturn_t ab8500_irq(int irq, void *dev)
493 struct ab8500 *ab8500 = dev;
494 int i;
496 dev_vdbg(ab8500->dev, "interrupt\n");
498 atomic_inc(&ab8500->transfer_ongoing);
500 for (i = 0; i < ab8500->mask_size; i++) {
501 int regoffset = ab8500->irq_reg_offset[i];
502 int status;
503 u8 value;
506 * Interrupt register 12 doesn't exist prior to AB8500 version
507 * 2.0
509 if (regoffset == 11 && is_ab8500_1p1_or_earlier(ab8500))
510 continue;
512 status = get_register_interruptible(ab8500, AB8500_INTERRUPT,
513 AB8500_IT_LATCH1_REG + regoffset, &value);
514 if (status < 0 || value == 0)
515 continue;
517 do {
518 int bit = __ffs(value);
519 int line = i * 8 + bit;
520 int virq = ab8500_irq_get_virq(ab8500, line);
522 handle_nested_irq(virq);
523 value &= ~(1 << bit);
525 } while (value);
527 atomic_dec(&ab8500->transfer_ongoing);
528 return IRQ_HANDLED;
531 static int ab8500_irq_map(struct irq_domain *d, unsigned int virq,
532 irq_hw_number_t hwirq)
534 struct ab8500 *ab8500 = d->host_data;
536 if (!ab8500)
537 return -EINVAL;
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
549 return 0;
552 static struct irq_domain_ops ab8500_irq_ops = {
553 .map = ab8500_irq_map,
554 .xlate = irq_domain_xlate_twocell,
557 static int ab8500_irq_init(struct ab8500 *ab8500, struct device_node *np)
559 int num_irqs;
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;
568 /* If ->irq_base is zero this will give a linear mapping */
569 ab8500->domain = irq_domain_add_simple(NULL,
570 num_irqs, ab8500->irq_base,
571 &ab8500_irq_ops, ab8500);
573 if (!ab8500->domain) {
574 dev_err(ab8500->dev, "Failed to create irqdomain\n");
575 return -ENOSYS;
578 return 0;
581 int ab8500_suspend(struct ab8500 *ab8500)
583 if (atomic_read(&ab8500->transfer_ongoing))
584 return -EINVAL;
585 else
586 return 0;
589 static struct resource ab8500_gpadc_resources[] = {
591 .name = "HW_CONV_END",
592 .start = AB8500_INT_GP_HW_ADC_CONV_END,
593 .end = AB8500_INT_GP_HW_ADC_CONV_END,
594 .flags = IORESOURCE_IRQ,
597 .name = "SW_CONV_END",
598 .start = AB8500_INT_GP_SW_ADC_CONV_END,
599 .end = AB8500_INT_GP_SW_ADC_CONV_END,
600 .flags = IORESOURCE_IRQ,
604 static struct resource ab8500_rtc_resources[] = {
606 .name = "60S",
607 .start = AB8500_INT_RTC_60S,
608 .end = AB8500_INT_RTC_60S,
609 .flags = IORESOURCE_IRQ,
612 .name = "ALARM",
613 .start = AB8500_INT_RTC_ALARM,
614 .end = AB8500_INT_RTC_ALARM,
615 .flags = IORESOURCE_IRQ,
619 static struct resource ab8500_poweronkey_db_resources[] = {
621 .name = "ONKEY_DBF",
622 .start = AB8500_INT_PON_KEY1DB_F,
623 .end = AB8500_INT_PON_KEY1DB_F,
624 .flags = IORESOURCE_IRQ,
627 .name = "ONKEY_DBR",
628 .start = AB8500_INT_PON_KEY1DB_R,
629 .end = AB8500_INT_PON_KEY1DB_R,
630 .flags = IORESOURCE_IRQ,
634 static struct resource ab8500_av_acc_detect_resources[] = {
636 .name = "ACC_DETECT_1DB_F",
637 .start = AB8500_INT_ACC_DETECT_1DB_F,
638 .end = AB8500_INT_ACC_DETECT_1DB_F,
639 .flags = IORESOURCE_IRQ,
642 .name = "ACC_DETECT_1DB_R",
643 .start = AB8500_INT_ACC_DETECT_1DB_R,
644 .end = AB8500_INT_ACC_DETECT_1DB_R,
645 .flags = IORESOURCE_IRQ,
648 .name = "ACC_DETECT_21DB_F",
649 .start = AB8500_INT_ACC_DETECT_21DB_F,
650 .end = AB8500_INT_ACC_DETECT_21DB_F,
651 .flags = IORESOURCE_IRQ,
654 .name = "ACC_DETECT_21DB_R",
655 .start = AB8500_INT_ACC_DETECT_21DB_R,
656 .end = AB8500_INT_ACC_DETECT_21DB_R,
657 .flags = IORESOURCE_IRQ,
660 .name = "ACC_DETECT_22DB_F",
661 .start = AB8500_INT_ACC_DETECT_22DB_F,
662 .end = AB8500_INT_ACC_DETECT_22DB_F,
663 .flags = IORESOURCE_IRQ,
666 .name = "ACC_DETECT_22DB_R",
667 .start = AB8500_INT_ACC_DETECT_22DB_R,
668 .end = AB8500_INT_ACC_DETECT_22DB_R,
669 .flags = IORESOURCE_IRQ,
673 static struct resource ab8500_charger_resources[] = {
675 .name = "MAIN_CH_UNPLUG_DET",
676 .start = AB8500_INT_MAIN_CH_UNPLUG_DET,
677 .end = AB8500_INT_MAIN_CH_UNPLUG_DET,
678 .flags = IORESOURCE_IRQ,
681 .name = "MAIN_CHARGE_PLUG_DET",
682 .start = AB8500_INT_MAIN_CH_PLUG_DET,
683 .end = AB8500_INT_MAIN_CH_PLUG_DET,
684 .flags = IORESOURCE_IRQ,
687 .name = "VBUS_DET_R",
688 .start = AB8500_INT_VBUS_DET_R,
689 .end = AB8500_INT_VBUS_DET_R,
690 .flags = IORESOURCE_IRQ,
693 .name = "VBUS_DET_F",
694 .start = AB8500_INT_VBUS_DET_F,
695 .end = AB8500_INT_VBUS_DET_F,
696 .flags = IORESOURCE_IRQ,
699 .name = "USB_LINK_STATUS",
700 .start = AB8500_INT_USB_LINK_STATUS,
701 .end = AB8500_INT_USB_LINK_STATUS,
702 .flags = IORESOURCE_IRQ,
705 .name = "VBUS_OVV",
706 .start = AB8500_INT_VBUS_OVV,
707 .end = AB8500_INT_VBUS_OVV,
708 .flags = IORESOURCE_IRQ,
711 .name = "USB_CH_TH_PROT_R",
712 .start = AB8500_INT_USB_CH_TH_PROT_R,
713 .end = AB8500_INT_USB_CH_TH_PROT_R,
714 .flags = IORESOURCE_IRQ,
717 .name = "USB_CH_TH_PROT_F",
718 .start = AB8500_INT_USB_CH_TH_PROT_F,
719 .end = AB8500_INT_USB_CH_TH_PROT_F,
720 .flags = IORESOURCE_IRQ,
723 .name = "MAIN_EXT_CH_NOT_OK",
724 .start = AB8500_INT_MAIN_EXT_CH_NOT_OK,
725 .end = AB8500_INT_MAIN_EXT_CH_NOT_OK,
726 .flags = IORESOURCE_IRQ,
729 .name = "MAIN_CH_TH_PROT_R",
730 .start = AB8500_INT_MAIN_CH_TH_PROT_R,
731 .end = AB8500_INT_MAIN_CH_TH_PROT_R,
732 .flags = IORESOURCE_IRQ,
735 .name = "MAIN_CH_TH_PROT_F",
736 .start = AB8500_INT_MAIN_CH_TH_PROT_F,
737 .end = AB8500_INT_MAIN_CH_TH_PROT_F,
738 .flags = IORESOURCE_IRQ,
741 .name = "USB_CHARGER_NOT_OKR",
742 .start = AB8500_INT_USB_CHARGER_NOT_OKR,
743 .end = AB8500_INT_USB_CHARGER_NOT_OKR,
744 .flags = IORESOURCE_IRQ,
747 .name = "CH_WD_EXP",
748 .start = AB8500_INT_CH_WD_EXP,
749 .end = AB8500_INT_CH_WD_EXP,
750 .flags = IORESOURCE_IRQ,
754 static struct resource ab8500_btemp_resources[] = {
756 .name = "BAT_CTRL_INDB",
757 .start = AB8500_INT_BAT_CTRL_INDB,
758 .end = AB8500_INT_BAT_CTRL_INDB,
759 .flags = IORESOURCE_IRQ,
762 .name = "BTEMP_LOW",
763 .start = AB8500_INT_BTEMP_LOW,
764 .end = AB8500_INT_BTEMP_LOW,
765 .flags = IORESOURCE_IRQ,
768 .name = "BTEMP_HIGH",
769 .start = AB8500_INT_BTEMP_HIGH,
770 .end = AB8500_INT_BTEMP_HIGH,
771 .flags = IORESOURCE_IRQ,
774 .name = "BTEMP_LOW_MEDIUM",
775 .start = AB8500_INT_BTEMP_LOW_MEDIUM,
776 .end = AB8500_INT_BTEMP_LOW_MEDIUM,
777 .flags = IORESOURCE_IRQ,
780 .name = "BTEMP_MEDIUM_HIGH",
781 .start = AB8500_INT_BTEMP_MEDIUM_HIGH,
782 .end = AB8500_INT_BTEMP_MEDIUM_HIGH,
783 .flags = IORESOURCE_IRQ,
787 static struct resource ab8500_fg_resources[] = {
789 .name = "NCONV_ACCU",
790 .start = AB8500_INT_CCN_CONV_ACC,
791 .end = AB8500_INT_CCN_CONV_ACC,
792 .flags = IORESOURCE_IRQ,
795 .name = "BATT_OVV",
796 .start = AB8500_INT_BATT_OVV,
797 .end = AB8500_INT_BATT_OVV,
798 .flags = IORESOURCE_IRQ,
801 .name = "LOW_BAT_F",
802 .start = AB8500_INT_LOW_BAT_F,
803 .end = AB8500_INT_LOW_BAT_F,
804 .flags = IORESOURCE_IRQ,
807 .name = "LOW_BAT_R",
808 .start = AB8500_INT_LOW_BAT_R,
809 .end = AB8500_INT_LOW_BAT_R,
810 .flags = IORESOURCE_IRQ,
813 .name = "CC_INT_CALIB",
814 .start = AB8500_INT_CC_INT_CALIB,
815 .end = AB8500_INT_CC_INT_CALIB,
816 .flags = IORESOURCE_IRQ,
819 .name = "CCEOC",
820 .start = AB8500_INT_CCEOC,
821 .end = AB8500_INT_CCEOC,
822 .flags = IORESOURCE_IRQ,
826 static struct resource ab8500_chargalg_resources[] = {};
828 #ifdef CONFIG_DEBUG_FS
829 static struct resource ab8500_debug_resources[] = {
831 .name = "IRQ_FIRST",
832 .start = AB8500_INT_MAIN_EXT_CH_NOT_OK,
833 .end = AB8500_INT_MAIN_EXT_CH_NOT_OK,
834 .flags = IORESOURCE_IRQ,
837 .name = "IRQ_LAST",
838 .start = AB8500_INT_XTAL32K_KO,
839 .end = AB8500_INT_XTAL32K_KO,
840 .flags = IORESOURCE_IRQ,
843 #endif
845 static struct resource ab8500_usb_resources[] = {
847 .name = "ID_WAKEUP_R",
848 .start = AB8500_INT_ID_WAKEUP_R,
849 .end = AB8500_INT_ID_WAKEUP_R,
850 .flags = IORESOURCE_IRQ,
853 .name = "ID_WAKEUP_F",
854 .start = AB8500_INT_ID_WAKEUP_F,
855 .end = AB8500_INT_ID_WAKEUP_F,
856 .flags = IORESOURCE_IRQ,
859 .name = "VBUS_DET_F",
860 .start = AB8500_INT_VBUS_DET_F,
861 .end = AB8500_INT_VBUS_DET_F,
862 .flags = IORESOURCE_IRQ,
865 .name = "VBUS_DET_R",
866 .start = AB8500_INT_VBUS_DET_R,
867 .end = AB8500_INT_VBUS_DET_R,
868 .flags = IORESOURCE_IRQ,
871 .name = "USB_LINK_STATUS",
872 .start = AB8500_INT_USB_LINK_STATUS,
873 .end = AB8500_INT_USB_LINK_STATUS,
874 .flags = IORESOURCE_IRQ,
877 .name = "USB_ADP_PROBE_PLUG",
878 .start = AB8500_INT_ADP_PROBE_PLUG,
879 .end = AB8500_INT_ADP_PROBE_PLUG,
880 .flags = IORESOURCE_IRQ,
883 .name = "USB_ADP_PROBE_UNPLUG",
884 .start = AB8500_INT_ADP_PROBE_UNPLUG,
885 .end = AB8500_INT_ADP_PROBE_UNPLUG,
886 .flags = IORESOURCE_IRQ,
890 static struct resource ab8505_iddet_resources[] = {
892 .name = "KeyDeglitch",
893 .start = AB8505_INT_KEYDEGLITCH,
894 .end = AB8505_INT_KEYDEGLITCH,
895 .flags = IORESOURCE_IRQ,
898 .name = "KP",
899 .start = AB8505_INT_KP,
900 .end = AB8505_INT_KP,
901 .flags = IORESOURCE_IRQ,
904 .name = "IKP",
905 .start = AB8505_INT_IKP,
906 .end = AB8505_INT_IKP,
907 .flags = IORESOURCE_IRQ,
910 .name = "IKR",
911 .start = AB8505_INT_IKR,
912 .end = AB8505_INT_IKR,
913 .flags = IORESOURCE_IRQ,
916 .name = "KeyStuck",
917 .start = AB8505_INT_KEYSTUCK,
918 .end = AB8505_INT_KEYSTUCK,
919 .flags = IORESOURCE_IRQ,
923 static struct resource ab8500_temp_resources[] = {
925 .name = "AB8500_TEMP_WARM",
926 .start = AB8500_INT_TEMP_WARM,
927 .end = AB8500_INT_TEMP_WARM,
928 .flags = IORESOURCE_IRQ,
932 static struct mfd_cell abx500_common_devs[] = {
933 #ifdef CONFIG_DEBUG_FS
935 .name = "ab8500-debug",
936 .of_compatible = "stericsson,ab8500-debug",
937 .num_resources = ARRAY_SIZE(ab8500_debug_resources),
938 .resources = ab8500_debug_resources,
940 #endif
942 .name = "ab8500-sysctrl",
943 .of_compatible = "stericsson,ab8500-sysctrl",
946 .name = "ab8500-regulator",
947 .of_compatible = "stericsson,ab8500-regulator",
950 .name = "abx500-clk",
951 .of_compatible = "stericsson,abx500-clk",
954 .name = "ab8500-gpadc",
955 .of_compatible = "stericsson,ab8500-gpadc",
956 .num_resources = ARRAY_SIZE(ab8500_gpadc_resources),
957 .resources = ab8500_gpadc_resources,
960 .name = "ab8500-rtc",
961 .of_compatible = "stericsson,ab8500-rtc",
962 .num_resources = ARRAY_SIZE(ab8500_rtc_resources),
963 .resources = ab8500_rtc_resources,
966 .name = "ab8500-acc-det",
967 .of_compatible = "stericsson,ab8500-acc-det",
968 .num_resources = ARRAY_SIZE(ab8500_av_acc_detect_resources),
969 .resources = ab8500_av_acc_detect_resources,
972 .name = "ab8500-poweron-key",
973 .of_compatible = "stericsson,ab8500-poweron-key",
974 .num_resources = ARRAY_SIZE(ab8500_poweronkey_db_resources),
975 .resources = ab8500_poweronkey_db_resources,
978 .name = "ab8500-pwm",
979 .of_compatible = "stericsson,ab8500-pwm",
980 .id = 1,
983 .name = "ab8500-pwm",
984 .of_compatible = "stericsson,ab8500-pwm",
985 .id = 2,
988 .name = "ab8500-pwm",
989 .of_compatible = "stericsson,ab8500-pwm",
990 .id = 3,
993 .name = "ab8500-leds",
994 .of_compatible = "stericsson,ab8500-leds",
997 .name = "ab8500-denc",
998 .of_compatible = "stericsson,ab8500-denc",
1001 .name = "ab8500-temp",
1002 .of_compatible = "stericsson,ab8500-temp",
1003 .num_resources = ARRAY_SIZE(ab8500_temp_resources),
1004 .resources = ab8500_temp_resources,
1008 static struct mfd_cell ab8500_bm_devs[] = {
1010 .name = "ab8500-charger",
1011 .of_compatible = "stericsson,ab8500-charger",
1012 .num_resources = ARRAY_SIZE(ab8500_charger_resources),
1013 .resources = ab8500_charger_resources,
1014 #ifndef CONFIG_OF
1015 .platform_data = &ab8500_bm_data,
1016 .pdata_size = sizeof(ab8500_bm_data),
1017 #endif
1020 .name = "ab8500-btemp",
1021 .of_compatible = "stericsson,ab8500-btemp",
1022 .num_resources = ARRAY_SIZE(ab8500_btemp_resources),
1023 .resources = ab8500_btemp_resources,
1024 #ifndef CONFIG_OF
1025 .platform_data = &ab8500_bm_data,
1026 .pdata_size = sizeof(ab8500_bm_data),
1027 #endif
1030 .name = "ab8500-fg",
1031 .of_compatible = "stericsson,ab8500-fg",
1032 .num_resources = ARRAY_SIZE(ab8500_fg_resources),
1033 .resources = ab8500_fg_resources,
1034 #ifndef CONFIG_OF
1035 .platform_data = &ab8500_bm_data,
1036 .pdata_size = sizeof(ab8500_bm_data),
1037 #endif
1040 .name = "ab8500-chargalg",
1041 .of_compatible = "stericsson,ab8500-chargalg",
1042 .num_resources = ARRAY_SIZE(ab8500_chargalg_resources),
1043 .resources = ab8500_chargalg_resources,
1044 #ifndef CONFIG_OF
1045 .platform_data = &ab8500_bm_data,
1046 .pdata_size = sizeof(ab8500_bm_data),
1047 #endif
1051 static struct mfd_cell ab8500_devs[] = {
1053 .name = "ab8500-gpio",
1054 .of_compatible = "stericsson,ab8500-gpio",
1057 .name = "ab8500-usb",
1058 .of_compatible = "stericsson,ab8500-usb",
1059 .num_resources = ARRAY_SIZE(ab8500_usb_resources),
1060 .resources = ab8500_usb_resources,
1063 .name = "ab8500-codec",
1064 .of_compatible = "stericsson,ab8500-codec",
1068 static struct mfd_cell ab9540_devs[] = {
1070 .name = "ab8500-gpio",
1073 .name = "ab9540-usb",
1074 .num_resources = ARRAY_SIZE(ab8500_usb_resources),
1075 .resources = ab8500_usb_resources,
1078 .name = "ab9540-codec",
1082 /* Device list common to ab9540 and ab8505 */
1083 static struct mfd_cell ab9540_ab8505_devs[] = {
1085 .name = "ab-iddet",
1086 .num_resources = ARRAY_SIZE(ab8505_iddet_resources),
1087 .resources = ab8505_iddet_resources,
1091 static ssize_t show_chip_id(struct device *dev,
1092 struct device_attribute *attr, char *buf)
1094 struct ab8500 *ab8500;
1096 ab8500 = dev_get_drvdata(dev);
1097 return sprintf(buf, "%#x\n", ab8500 ? ab8500->chip_id : -EINVAL);
1101 * ab8500 has switched off due to (SWITCH_OFF_STATUS):
1102 * 0x01 Swoff bit programming
1103 * 0x02 Thermal protection activation
1104 * 0x04 Vbat lower then BattOk falling threshold
1105 * 0x08 Watchdog expired
1106 * 0x10 Non presence of 32kHz clock
1107 * 0x20 Battery level lower than power on reset threshold
1108 * 0x40 Power on key 1 pressed longer than 10 seconds
1109 * 0x80 DB8500 thermal shutdown
1111 static ssize_t show_switch_off_status(struct device *dev,
1112 struct device_attribute *attr, char *buf)
1114 int ret;
1115 u8 value;
1116 struct ab8500 *ab8500;
1118 ab8500 = dev_get_drvdata(dev);
1119 ret = get_register_interruptible(ab8500, AB8500_RTC,
1120 AB8500_SWITCH_OFF_STATUS, &value);
1121 if (ret < 0)
1122 return ret;
1123 return sprintf(buf, "%#x\n", value);
1127 * ab8500 has turned on due to (TURN_ON_STATUS):
1128 * 0x01 PORnVbat
1129 * 0x02 PonKey1dbF
1130 * 0x04 PonKey2dbF
1131 * 0x08 RTCAlarm
1132 * 0x10 MainChDet
1133 * 0x20 VbusDet
1134 * 0x40 UsbIDDetect
1135 * 0x80 Reserved
1137 static ssize_t show_turn_on_status(struct device *dev,
1138 struct device_attribute *attr, char *buf)
1140 int ret;
1141 u8 value;
1142 struct ab8500 *ab8500;
1144 ab8500 = dev_get_drvdata(dev);
1145 ret = get_register_interruptible(ab8500, AB8500_SYS_CTRL1_BLOCK,
1146 AB8500_TURN_ON_STATUS, &value);
1147 if (ret < 0)
1148 return ret;
1149 return sprintf(buf, "%#x\n", value);
1152 static ssize_t show_ab9540_dbbrstn(struct device *dev,
1153 struct device_attribute *attr, char *buf)
1155 struct ab8500 *ab8500;
1156 int ret;
1157 u8 value;
1159 ab8500 = dev_get_drvdata(dev);
1161 ret = get_register_interruptible(ab8500, AB8500_REGU_CTRL2,
1162 AB9540_MODEM_CTRL2_REG, &value);
1163 if (ret < 0)
1164 return ret;
1166 return sprintf(buf, "%d\n",
1167 (value & AB9540_MODEM_CTRL2_SWDBBRSTN_BIT) ? 1 : 0);
1170 static ssize_t store_ab9540_dbbrstn(struct device *dev,
1171 struct device_attribute *attr, const char *buf, size_t count)
1173 struct ab8500 *ab8500;
1174 int ret = count;
1175 int err;
1176 u8 bitvalues;
1178 ab8500 = dev_get_drvdata(dev);
1180 if (count > 0) {
1181 switch (buf[0]) {
1182 case '0':
1183 bitvalues = 0;
1184 break;
1185 case '1':
1186 bitvalues = AB9540_MODEM_CTRL2_SWDBBRSTN_BIT;
1187 break;
1188 default:
1189 goto exit;
1192 err = mask_and_set_register_interruptible(ab8500,
1193 AB8500_REGU_CTRL2, AB9540_MODEM_CTRL2_REG,
1194 AB9540_MODEM_CTRL2_SWDBBRSTN_BIT, bitvalues);
1195 if (err)
1196 dev_info(ab8500->dev,
1197 "Failed to set DBBRSTN %c, err %#x\n",
1198 buf[0], err);
1201 exit:
1202 return ret;
1205 static DEVICE_ATTR(chip_id, S_IRUGO, show_chip_id, NULL);
1206 static DEVICE_ATTR(switch_off_status, S_IRUGO, show_switch_off_status, NULL);
1207 static DEVICE_ATTR(turn_on_status, S_IRUGO, show_turn_on_status, NULL);
1208 static DEVICE_ATTR(dbbrstn, S_IRUGO | S_IWUSR,
1209 show_ab9540_dbbrstn, store_ab9540_dbbrstn);
1211 static struct attribute *ab8500_sysfs_entries[] = {
1212 &dev_attr_chip_id.attr,
1213 &dev_attr_switch_off_status.attr,
1214 &dev_attr_turn_on_status.attr,
1215 NULL,
1218 static struct attribute *ab9540_sysfs_entries[] = {
1219 &dev_attr_chip_id.attr,
1220 &dev_attr_switch_off_status.attr,
1221 &dev_attr_turn_on_status.attr,
1222 &dev_attr_dbbrstn.attr,
1223 NULL,
1226 static struct attribute_group ab8500_attr_group = {
1227 .attrs = ab8500_sysfs_entries,
1230 static struct attribute_group ab9540_attr_group = {
1231 .attrs = ab9540_sysfs_entries,
1234 static int ab8500_probe(struct platform_device *pdev)
1236 static char *switch_off_status[] = {
1237 "Swoff bit programming",
1238 "Thermal protection activation",
1239 "Vbat lower then BattOk falling threshold",
1240 "Watchdog expired",
1241 "Non presence of 32kHz clock",
1242 "Battery level lower than power on reset threshold",
1243 "Power on key 1 pressed longer than 10 seconds",
1244 "DB8500 thermal shutdown"};
1245 struct ab8500_platform_data *plat = dev_get_platdata(&pdev->dev);
1246 const struct platform_device_id *platid = platform_get_device_id(pdev);
1247 enum ab8500_version version = AB8500_VERSION_UNDEFINED;
1248 struct device_node *np = pdev->dev.of_node;
1249 struct ab8500 *ab8500;
1250 struct resource *resource;
1251 int ret;
1252 int i;
1253 u8 value;
1255 ab8500 = devm_kzalloc(&pdev->dev, sizeof *ab8500, GFP_KERNEL);
1256 if (!ab8500)
1257 return -ENOMEM;
1259 if (plat)
1260 ab8500->irq_base = plat->irq_base;
1262 ab8500->dev = &pdev->dev;
1264 resource = platform_get_resource(pdev, IORESOURCE_IRQ, 0);
1265 if (!resource)
1266 return -ENODEV;
1268 ab8500->irq = resource->start;
1270 ab8500->read = ab8500_prcmu_read;
1271 ab8500->write = ab8500_prcmu_write;
1272 ab8500->write_masked = ab8500_prcmu_write_masked;
1274 mutex_init(&ab8500->lock);
1275 mutex_init(&ab8500->irq_lock);
1276 atomic_set(&ab8500->transfer_ongoing, 0);
1278 platform_set_drvdata(pdev, ab8500);
1280 if (platid)
1281 version = platid->driver_data;
1283 if (version != AB8500_VERSION_UNDEFINED)
1284 ab8500->version = version;
1285 else {
1286 ret = get_register_interruptible(ab8500, AB8500_MISC,
1287 AB8500_IC_NAME_REG, &value);
1288 if (ret < 0)
1289 return ret;
1291 ab8500->version = value;
1294 ret = get_register_interruptible(ab8500, AB8500_MISC,
1295 AB8500_REV_REG, &value);
1296 if (ret < 0)
1297 return ret;
1299 ab8500->chip_id = value;
1301 dev_info(ab8500->dev, "detected chip, %s rev. %1x.%1x\n",
1302 ab8500_version_str[ab8500->version],
1303 ab8500->chip_id >> 4,
1304 ab8500->chip_id & 0x0F);
1306 /* Configure AB8500 or AB9540 IRQ */
1307 if (is_ab9540(ab8500) || is_ab8505(ab8500)) {
1308 ab8500->mask_size = AB9540_NUM_IRQ_REGS;
1309 ab8500->irq_reg_offset = ab9540_irq_regoffset;
1310 } else {
1311 ab8500->mask_size = AB8500_NUM_IRQ_REGS;
1312 ab8500->irq_reg_offset = ab8500_irq_regoffset;
1314 ab8500->mask = devm_kzalloc(&pdev->dev, ab8500->mask_size, GFP_KERNEL);
1315 if (!ab8500->mask)
1316 return -ENOMEM;
1317 ab8500->oldmask = devm_kzalloc(&pdev->dev, ab8500->mask_size, GFP_KERNEL);
1318 if (!ab8500->oldmask)
1319 return -ENOMEM;
1322 * ab8500 has switched off due to (SWITCH_OFF_STATUS):
1323 * 0x01 Swoff bit programming
1324 * 0x02 Thermal protection activation
1325 * 0x04 Vbat lower then BattOk falling threshold
1326 * 0x08 Watchdog expired
1327 * 0x10 Non presence of 32kHz clock
1328 * 0x20 Battery level lower than power on reset threshold
1329 * 0x40 Power on key 1 pressed longer than 10 seconds
1330 * 0x80 DB8500 thermal shutdown
1333 ret = get_register_interruptible(ab8500, AB8500_RTC,
1334 AB8500_SWITCH_OFF_STATUS, &value);
1335 if (ret < 0)
1336 return ret;
1337 dev_info(ab8500->dev, "switch off cause(s) (%#x): ", value);
1339 if (value) {
1340 for (i = 0; i < ARRAY_SIZE(switch_off_status); i++) {
1341 if (value & 1)
1342 printk(KERN_CONT " \"%s\"",
1343 switch_off_status[i]);
1344 value = value >> 1;
1347 printk(KERN_CONT "\n");
1348 } else {
1349 printk(KERN_CONT " None\n");
1352 if (plat && plat->init)
1353 plat->init(ab8500);
1355 /* Clear and mask all interrupts */
1356 for (i = 0; i < ab8500->mask_size; i++) {
1358 * Interrupt register 12 doesn't exist prior to AB8500 version
1359 * 2.0
1361 if (ab8500->irq_reg_offset[i] == 11 &&
1362 is_ab8500_1p1_or_earlier(ab8500))
1363 continue;
1365 get_register_interruptible(ab8500, AB8500_INTERRUPT,
1366 AB8500_IT_LATCH1_REG + ab8500->irq_reg_offset[i],
1367 &value);
1368 set_register_interruptible(ab8500, AB8500_INTERRUPT,
1369 AB8500_IT_MASK1_REG + ab8500->irq_reg_offset[i], 0xff);
1372 ret = abx500_register_ops(ab8500->dev, &ab8500_ops);
1373 if (ret)
1374 return ret;
1376 for (i = 0; i < ab8500->mask_size; i++)
1377 ab8500->mask[i] = ab8500->oldmask[i] = 0xff;
1379 ret = ab8500_irq_init(ab8500, np);
1380 if (ret)
1381 return ret;
1383 /* Activate this feature only in ab9540 */
1384 /* till tests are done on ab8500 1p2 or later*/
1385 if (is_ab9540(ab8500)) {
1386 ret = devm_request_threaded_irq(&pdev->dev, ab8500->irq, NULL,
1387 ab8500_hierarchical_irq,
1388 IRQF_ONESHOT | IRQF_NO_SUSPEND,
1389 "ab8500", ab8500);
1391 else {
1392 ret = devm_request_threaded_irq(&pdev->dev, ab8500->irq, NULL,
1393 ab8500_irq,
1394 IRQF_ONESHOT | IRQF_NO_SUSPEND,
1395 "ab8500", ab8500);
1396 if (ret)
1397 return ret;
1400 ret = mfd_add_devices(ab8500->dev, 0, abx500_common_devs,
1401 ARRAY_SIZE(abx500_common_devs), NULL,
1402 ab8500->irq_base, ab8500->domain);
1403 if (ret)
1404 return ret;
1406 if (is_ab9540(ab8500))
1407 ret = mfd_add_devices(ab8500->dev, 0, ab9540_devs,
1408 ARRAY_SIZE(ab9540_devs), NULL,
1409 ab8500->irq_base, ab8500->domain);
1410 else
1411 ret = mfd_add_devices(ab8500->dev, 0, ab8500_devs,
1412 ARRAY_SIZE(ab8500_devs), NULL,
1413 ab8500->irq_base, ab8500->domain);
1414 if (ret)
1415 return ret;
1417 if (is_ab9540(ab8500) || is_ab8505(ab8500))
1418 ret = mfd_add_devices(ab8500->dev, 0, ab9540_ab8505_devs,
1419 ARRAY_SIZE(ab9540_ab8505_devs), NULL,
1420 ab8500->irq_base, ab8500->domain);
1421 if (ret)
1422 return ret;
1424 if (!no_bm) {
1425 /* Add battery management devices */
1426 ret = mfd_add_devices(ab8500->dev, 0, ab8500_bm_devs,
1427 ARRAY_SIZE(ab8500_bm_devs), NULL,
1428 ab8500->irq_base, ab8500->domain);
1429 if (ret)
1430 dev_err(ab8500->dev, "error adding bm devices\n");
1433 if (is_ab9540(ab8500))
1434 ret = sysfs_create_group(&ab8500->dev->kobj,
1435 &ab9540_attr_group);
1436 else
1437 ret = sysfs_create_group(&ab8500->dev->kobj,
1438 &ab8500_attr_group);
1439 if (ret)
1440 dev_err(ab8500->dev, "error creating sysfs entries\n");
1442 return ret;
1445 static int ab8500_remove(struct platform_device *pdev)
1447 struct ab8500 *ab8500 = platform_get_drvdata(pdev);
1449 if (is_ab9540(ab8500))
1450 sysfs_remove_group(&ab8500->dev->kobj, &ab9540_attr_group);
1451 else
1452 sysfs_remove_group(&ab8500->dev->kobj, &ab8500_attr_group);
1454 mfd_remove_devices(ab8500->dev);
1456 return 0;
1459 static const struct platform_device_id ab8500_id[] = {
1460 { "ab8500-core", AB8500_VERSION_AB8500 },
1461 { "ab8505-i2c", AB8500_VERSION_AB8505 },
1462 { "ab9540-i2c", AB8500_VERSION_AB9540 },
1463 { "ab8540-i2c", AB8500_VERSION_AB8540 },
1467 static struct platform_driver ab8500_core_driver = {
1468 .driver = {
1469 .name = "ab8500-core",
1470 .owner = THIS_MODULE,
1472 .probe = ab8500_probe,
1473 .remove = ab8500_remove,
1474 .id_table = ab8500_id,
1477 static int __init ab8500_core_init(void)
1479 return platform_driver_register(&ab8500_core_driver);
1482 static void __exit ab8500_core_exit(void)
1484 platform_driver_unregister(&ab8500_core_driver);
1486 core_initcall(ab8500_core_init);
1487 module_exit(ab8500_core_exit);
1489 MODULE_AUTHOR("Mattias Wallin, Srinidhi Kasagar, Rabin Vincent");
1490 MODULE_DESCRIPTION("AB8500 MFD core");
1491 MODULE_LICENSE("GPL v2");