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