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