1 // SPDX-License-Identifier: GPL-2.0-only
2 /*
3  * Core driver for TI TPS6586x PMIC family
4  *
5  * Copyright (c) 2010 CompuLab Ltd.
6  * Mike Rapoport <mike@compulab.co.il>
7  *
8  * Based on da903x.c.
9  * Copyright (C) 2008 Compulab, Ltd.
10  * Mike Rapoport <mike@compulab.co.il>
11  * Copyright (C) 2006-2008 Marvell International Ltd.
12  * Eric Miao <eric.miao@marvell.com>
13  */
14 
15 #include <linux/interrupt.h>
16 #include <linux/irq.h>
17 #include <linux/irqdomain.h>
18 #include <linux/kernel.h>
19 #include <linux/module.h>
20 #include <linux/mutex.h>
21 #include <linux/slab.h>
22 #include <linux/err.h>
23 #include <linux/i2c.h>
24 #include <linux/platform_device.h>
25 #include <linux/regmap.h>
26 #include <linux/of.h>
27 
28 #include <linux/mfd/core.h>
29 #include <linux/mfd/tps6586x.h>
30 
31 #define TPS6586X_SUPPLYENE	0x14
32 #define EXITSLREQ_BIT		BIT(1)
33 #define SLEEP_MODE_BIT		BIT(3)
34 
35 /* interrupt control registers */
36 #define TPS6586X_INT_ACK1	0xb5
37 #define TPS6586X_INT_ACK2	0xb6
38 #define TPS6586X_INT_ACK3	0xb7
39 #define TPS6586X_INT_ACK4	0xb8
40 
41 /* interrupt mask registers */
42 #define TPS6586X_INT_MASK1	0xb0
43 #define TPS6586X_INT_MASK2	0xb1
44 #define TPS6586X_INT_MASK3	0xb2
45 #define TPS6586X_INT_MASK4	0xb3
46 #define TPS6586X_INT_MASK5	0xb4
47 
48 /* device id */
49 #define TPS6586X_VERSIONCRC	0xcd
50 
51 /* Maximum register */
52 #define TPS6586X_MAX_REGISTER	TPS6586X_VERSIONCRC
53 
54 struct tps6586x_irq_data {
55 	u8	mask_reg;
56 	u8	mask_mask;
57 };
58 
59 #define TPS6586X_IRQ(_reg, _mask)				\
60 	{							\
61 		.mask_reg = (_reg) - TPS6586X_INT_MASK1,	\
62 		.mask_mask = (_mask),				\
63 	}
64 
65 static const struct tps6586x_irq_data tps6586x_irqs[] = {
66 	[TPS6586X_INT_PLDO_0]	= TPS6586X_IRQ(TPS6586X_INT_MASK1, 1 << 0),
67 	[TPS6586X_INT_PLDO_1]	= TPS6586X_IRQ(TPS6586X_INT_MASK1, 1 << 1),
68 	[TPS6586X_INT_PLDO_2]	= TPS6586X_IRQ(TPS6586X_INT_MASK1, 1 << 2),
69 	[TPS6586X_INT_PLDO_3]	= TPS6586X_IRQ(TPS6586X_INT_MASK1, 1 << 3),
70 	[TPS6586X_INT_PLDO_4]	= TPS6586X_IRQ(TPS6586X_INT_MASK1, 1 << 4),
71 	[TPS6586X_INT_PLDO_5]	= TPS6586X_IRQ(TPS6586X_INT_MASK1, 1 << 5),
72 	[TPS6586X_INT_PLDO_6]	= TPS6586X_IRQ(TPS6586X_INT_MASK1, 1 << 6),
73 	[TPS6586X_INT_PLDO_7]	= TPS6586X_IRQ(TPS6586X_INT_MASK1, 1 << 7),
74 	[TPS6586X_INT_COMP_DET]	= TPS6586X_IRQ(TPS6586X_INT_MASK4, 1 << 0),
75 	[TPS6586X_INT_ADC]	= TPS6586X_IRQ(TPS6586X_INT_MASK2, 1 << 1),
76 	[TPS6586X_INT_PLDO_8]	= TPS6586X_IRQ(TPS6586X_INT_MASK2, 1 << 2),
77 	[TPS6586X_INT_PLDO_9]	= TPS6586X_IRQ(TPS6586X_INT_MASK2, 1 << 3),
78 	[TPS6586X_INT_PSM_0]	= TPS6586X_IRQ(TPS6586X_INT_MASK2, 1 << 4),
79 	[TPS6586X_INT_PSM_1]	= TPS6586X_IRQ(TPS6586X_INT_MASK2, 1 << 5),
80 	[TPS6586X_INT_PSM_2]	= TPS6586X_IRQ(TPS6586X_INT_MASK2, 1 << 6),
81 	[TPS6586X_INT_PSM_3]	= TPS6586X_IRQ(TPS6586X_INT_MASK2, 1 << 7),
82 	[TPS6586X_INT_RTC_ALM1]	= TPS6586X_IRQ(TPS6586X_INT_MASK5, 1 << 4),
83 	[TPS6586X_INT_ACUSB_OVP] = TPS6586X_IRQ(TPS6586X_INT_MASK5, 0x03),
84 	[TPS6586X_INT_USB_DET]	= TPS6586X_IRQ(TPS6586X_INT_MASK5, 1 << 2),
85 	[TPS6586X_INT_AC_DET]	= TPS6586X_IRQ(TPS6586X_INT_MASK5, 1 << 3),
86 	[TPS6586X_INT_BAT_DET]	= TPS6586X_IRQ(TPS6586X_INT_MASK3, 1 << 0),
87 	[TPS6586X_INT_CHG_STAT]	= TPS6586X_IRQ(TPS6586X_INT_MASK4, 0xfc),
88 	[TPS6586X_INT_CHG_TEMP]	= TPS6586X_IRQ(TPS6586X_INT_MASK3, 0x06),
89 	[TPS6586X_INT_PP]	= TPS6586X_IRQ(TPS6586X_INT_MASK3, 0xf0),
90 	[TPS6586X_INT_RESUME]	= TPS6586X_IRQ(TPS6586X_INT_MASK5, 1 << 5),
91 	[TPS6586X_INT_LOW_SYS]	= TPS6586X_IRQ(TPS6586X_INT_MASK5, 1 << 6),
92 	[TPS6586X_INT_RTC_ALM2] = TPS6586X_IRQ(TPS6586X_INT_MASK4, 1 << 1),
93 };
94 
95 static const struct resource tps6586x_rtc_resources[] = {
96 	{
97 		.start  = TPS6586X_INT_RTC_ALM1,
98 		.end	= TPS6586X_INT_RTC_ALM1,
99 		.flags	= IORESOURCE_IRQ,
100 	},
101 };
102 
103 static const struct mfd_cell tps6586x_cell[] = {
104 	{
105 		.name = "tps6586x-gpio",
106 	},
107 	{
108 		.name = "tps6586x-regulator",
109 	},
110 	{
111 		.name = "tps6586x-rtc",
112 		.num_resources = ARRAY_SIZE(tps6586x_rtc_resources),
113 		.resources = &tps6586x_rtc_resources[0],
114 	},
115 	{
116 		.name = "tps6586x-onkey",
117 	},
118 };
119 
120 struct tps6586x {
121 	struct device		*dev;
122 	struct i2c_client	*client;
123 	struct regmap		*regmap;
124 	int			version;
125 
126 	int			irq;
127 	struct irq_chip		irq_chip;
128 	struct mutex		irq_lock;
129 	int			irq_base;
130 	u32			irq_en;
131 	u8			mask_reg[5];
132 	struct irq_domain	*irq_domain;
133 };
134 
dev_to_tps6586x(struct device * dev)135 static inline struct tps6586x *dev_to_tps6586x(struct device *dev)
136 {
137 	return i2c_get_clientdata(to_i2c_client(dev));
138 }
139 
tps6586x_write(struct device * dev,int reg,uint8_t val)140 int tps6586x_write(struct device *dev, int reg, uint8_t val)
141 {
142 	struct tps6586x *tps6586x = dev_to_tps6586x(dev);
143 
144 	return regmap_write(tps6586x->regmap, reg, val);
145 }
146 EXPORT_SYMBOL_GPL(tps6586x_write);
147 
tps6586x_writes(struct device * dev,int reg,int len,uint8_t * val)148 int tps6586x_writes(struct device *dev, int reg, int len, uint8_t *val)
149 {
150 	struct tps6586x *tps6586x = dev_to_tps6586x(dev);
151 
152 	return regmap_bulk_write(tps6586x->regmap, reg, val, len);
153 }
154 EXPORT_SYMBOL_GPL(tps6586x_writes);
155 
tps6586x_read(struct device * dev,int reg,uint8_t * val)156 int tps6586x_read(struct device *dev, int reg, uint8_t *val)
157 {
158 	struct tps6586x *tps6586x = dev_to_tps6586x(dev);
159 	unsigned int rval;
160 	int ret;
161 
162 	ret = regmap_read(tps6586x->regmap, reg, &rval);
163 	if (!ret)
164 		*val = rval;
165 	return ret;
166 }
167 EXPORT_SYMBOL_GPL(tps6586x_read);
168 
tps6586x_reads(struct device * dev,int reg,int len,uint8_t * val)169 int tps6586x_reads(struct device *dev, int reg, int len, uint8_t *val)
170 {
171 	struct tps6586x *tps6586x = dev_to_tps6586x(dev);
172 
173 	return regmap_bulk_read(tps6586x->regmap, reg, val, len);
174 }
175 EXPORT_SYMBOL_GPL(tps6586x_reads);
176 
tps6586x_set_bits(struct device * dev,int reg,uint8_t bit_mask)177 int tps6586x_set_bits(struct device *dev, int reg, uint8_t bit_mask)
178 {
179 	struct tps6586x *tps6586x = dev_to_tps6586x(dev);
180 
181 	return regmap_update_bits(tps6586x->regmap, reg, bit_mask, bit_mask);
182 }
183 EXPORT_SYMBOL_GPL(tps6586x_set_bits);
184 
tps6586x_clr_bits(struct device * dev,int reg,uint8_t bit_mask)185 int tps6586x_clr_bits(struct device *dev, int reg, uint8_t bit_mask)
186 {
187 	struct tps6586x *tps6586x = dev_to_tps6586x(dev);
188 
189 	return regmap_update_bits(tps6586x->regmap, reg, bit_mask, 0);
190 }
191 EXPORT_SYMBOL_GPL(tps6586x_clr_bits);
192 
tps6586x_update(struct device * dev,int reg,uint8_t val,uint8_t mask)193 int tps6586x_update(struct device *dev, int reg, uint8_t val, uint8_t mask)
194 {
195 	struct tps6586x *tps6586x = dev_to_tps6586x(dev);
196 
197 	return regmap_update_bits(tps6586x->regmap, reg, mask, val);
198 }
199 EXPORT_SYMBOL_GPL(tps6586x_update);
200 
tps6586x_irq_get_virq(struct device * dev,int irq)201 int tps6586x_irq_get_virq(struct device *dev, int irq)
202 {
203 	struct tps6586x *tps6586x = dev_to_tps6586x(dev);
204 
205 	return irq_create_mapping(tps6586x->irq_domain, irq);
206 }
207 EXPORT_SYMBOL_GPL(tps6586x_irq_get_virq);
208 
tps6586x_get_version(struct device * dev)209 int tps6586x_get_version(struct device *dev)
210 {
211 	struct tps6586x *tps6586x = dev_get_drvdata(dev);
212 
213 	return tps6586x->version;
214 }
215 EXPORT_SYMBOL_GPL(tps6586x_get_version);
216 
__remove_subdev(struct device * dev,void * unused)217 static int __remove_subdev(struct device *dev, void *unused)
218 {
219 	platform_device_unregister(to_platform_device(dev));
220 	return 0;
221 }
222 
tps6586x_remove_subdevs(struct tps6586x * tps6586x)223 static int tps6586x_remove_subdevs(struct tps6586x *tps6586x)
224 {
225 	return device_for_each_child(tps6586x->dev, NULL, __remove_subdev);
226 }
227 
tps6586x_irq_lock(struct irq_data * data)228 static void tps6586x_irq_lock(struct irq_data *data)
229 {
230 	struct tps6586x *tps6586x = irq_data_get_irq_chip_data(data);
231 
232 	mutex_lock(&tps6586x->irq_lock);
233 }
234 
tps6586x_irq_enable(struct irq_data * irq_data)235 static void tps6586x_irq_enable(struct irq_data *irq_data)
236 {
237 	struct tps6586x *tps6586x = irq_data_get_irq_chip_data(irq_data);
238 	unsigned int __irq = irq_data->hwirq;
239 	const struct tps6586x_irq_data *data = &tps6586x_irqs[__irq];
240 
241 	tps6586x->mask_reg[data->mask_reg] &= ~data->mask_mask;
242 	tps6586x->irq_en |= (1 << __irq);
243 }
244 
tps6586x_irq_disable(struct irq_data * irq_data)245 static void tps6586x_irq_disable(struct irq_data *irq_data)
246 {
247 	struct tps6586x *tps6586x = irq_data_get_irq_chip_data(irq_data);
248 
249 	unsigned int __irq = irq_data->hwirq;
250 	const struct tps6586x_irq_data *data = &tps6586x_irqs[__irq];
251 
252 	tps6586x->mask_reg[data->mask_reg] |= data->mask_mask;
253 	tps6586x->irq_en &= ~(1 << __irq);
254 }
255 
tps6586x_irq_sync_unlock(struct irq_data * data)256 static void tps6586x_irq_sync_unlock(struct irq_data *data)
257 {
258 	struct tps6586x *tps6586x = irq_data_get_irq_chip_data(data);
259 	int i;
260 
261 	for (i = 0; i < ARRAY_SIZE(tps6586x->mask_reg); i++) {
262 		int ret;
263 		ret = tps6586x_write(tps6586x->dev,
264 					    TPS6586X_INT_MASK1 + i,
265 					    tps6586x->mask_reg[i]);
266 		WARN_ON(ret);
267 	}
268 
269 	mutex_unlock(&tps6586x->irq_lock);
270 }
271 
272 #ifdef CONFIG_PM_SLEEP
tps6586x_irq_set_wake(struct irq_data * irq_data,unsigned int on)273 static int tps6586x_irq_set_wake(struct irq_data *irq_data, unsigned int on)
274 {
275 	struct tps6586x *tps6586x = irq_data_get_irq_chip_data(irq_data);
276 	return irq_set_irq_wake(tps6586x->irq, on);
277 }
278 #else
279 #define tps6586x_irq_set_wake NULL
280 #endif
281 
282 static struct irq_chip tps6586x_irq_chip = {
283 	.name = "tps6586x",
284 	.irq_bus_lock = tps6586x_irq_lock,
285 	.irq_bus_sync_unlock = tps6586x_irq_sync_unlock,
286 	.irq_disable = tps6586x_irq_disable,
287 	.irq_enable = tps6586x_irq_enable,
288 	.irq_set_wake = tps6586x_irq_set_wake,
289 };
290 
tps6586x_irq_map(struct irq_domain * h,unsigned int virq,irq_hw_number_t hw)291 static int tps6586x_irq_map(struct irq_domain *h, unsigned int virq,
292 				irq_hw_number_t hw)
293 {
294 	struct tps6586x *tps6586x = h->host_data;
295 
296 	irq_set_chip_data(virq, tps6586x);
297 	irq_set_chip_and_handler(virq, &tps6586x_irq_chip, handle_simple_irq);
298 	irq_set_nested_thread(virq, 1);
299 	irq_set_noprobe(virq);
300 
301 	return 0;
302 }
303 
304 static const struct irq_domain_ops tps6586x_domain_ops = {
305 	.map    = tps6586x_irq_map,
306 	.xlate  = irq_domain_xlate_twocell,
307 };
308 
tps6586x_irq(int irq,void * data)309 static irqreturn_t tps6586x_irq(int irq, void *data)
310 {
311 	struct tps6586x *tps6586x = data;
312 	uint32_t acks;
313 	__le32 val;
314 	int ret = 0;
315 
316 	ret = tps6586x_reads(tps6586x->dev, TPS6586X_INT_ACK1,
317 			     sizeof(acks), (uint8_t *)&val);
318 
319 	if (ret < 0) {
320 		dev_err(tps6586x->dev, "failed to read interrupt status\n");
321 		return IRQ_NONE;
322 	}
323 
324 	acks = le32_to_cpu(val);
325 
326 	while (acks) {
327 		int i = __ffs(acks);
328 
329 		if (tps6586x->irq_en & (1 << i))
330 			handle_nested_irq(
331 				irq_find_mapping(tps6586x->irq_domain, i));
332 
333 		acks &= ~(1 << i);
334 	}
335 
336 	return IRQ_HANDLED;
337 }
338 
tps6586x_irq_init(struct tps6586x * tps6586x,int irq,int irq_base)339 static int tps6586x_irq_init(struct tps6586x *tps6586x, int irq,
340 				       int irq_base)
341 {
342 	int i, ret;
343 	u8 tmp[4];
344 	int new_irq_base;
345 	int irq_num = ARRAY_SIZE(tps6586x_irqs);
346 
347 	tps6586x->irq = irq;
348 
349 	mutex_init(&tps6586x->irq_lock);
350 	for (i = 0; i < 5; i++) {
351 		tps6586x->mask_reg[i] = 0xff;
352 		tps6586x_write(tps6586x->dev, TPS6586X_INT_MASK1 + i, 0xff);
353 	}
354 
355 	tps6586x_reads(tps6586x->dev, TPS6586X_INT_ACK1, sizeof(tmp), tmp);
356 
357 	if  (irq_base > 0) {
358 		new_irq_base = irq_alloc_descs(irq_base, 0, irq_num, -1);
359 		if (new_irq_base < 0) {
360 			dev_err(tps6586x->dev,
361 				"Failed to alloc IRQs: %d\n", new_irq_base);
362 			return new_irq_base;
363 		}
364 	} else {
365 		new_irq_base = 0;
366 	}
367 
368 	tps6586x->irq_domain = irq_domain_add_simple(tps6586x->dev->of_node,
369 				irq_num, new_irq_base, &tps6586x_domain_ops,
370 				tps6586x);
371 	if (!tps6586x->irq_domain) {
372 		dev_err(tps6586x->dev, "Failed to create IRQ domain\n");
373 		return -ENOMEM;
374 	}
375 	ret = request_threaded_irq(irq, NULL, tps6586x_irq, IRQF_ONESHOT,
376 				   "tps6586x", tps6586x);
377 
378 	if (!ret)
379 		device_init_wakeup(tps6586x->dev, 1);
380 
381 	return ret;
382 }
383 
tps6586x_add_subdevs(struct tps6586x * tps6586x,struct tps6586x_platform_data * pdata)384 static int tps6586x_add_subdevs(struct tps6586x *tps6586x,
385 					  struct tps6586x_platform_data *pdata)
386 {
387 	struct tps6586x_subdev_info *subdev;
388 	struct platform_device *pdev;
389 	int i, ret = 0;
390 
391 	for (i = 0; i < pdata->num_subdevs; i++) {
392 		subdev = &pdata->subdevs[i];
393 
394 		pdev = platform_device_alloc(subdev->name, subdev->id);
395 		if (!pdev) {
396 			ret = -ENOMEM;
397 			goto failed;
398 		}
399 
400 		pdev->dev.parent = tps6586x->dev;
401 		pdev->dev.platform_data = subdev->platform_data;
402 		pdev->dev.of_node = subdev->of_node;
403 
404 		ret = platform_device_add(pdev);
405 		if (ret) {
406 			platform_device_put(pdev);
407 			goto failed;
408 		}
409 	}
410 	return 0;
411 
412 failed:
413 	tps6586x_remove_subdevs(tps6586x);
414 	return ret;
415 }
416 
417 #ifdef CONFIG_OF
tps6586x_parse_dt(struct i2c_client * client)418 static struct tps6586x_platform_data *tps6586x_parse_dt(struct i2c_client *client)
419 {
420 	struct device_node *np = client->dev.of_node;
421 	struct tps6586x_platform_data *pdata;
422 
423 	pdata = devm_kzalloc(&client->dev, sizeof(*pdata), GFP_KERNEL);
424 	if (!pdata)
425 		return NULL;
426 
427 	pdata->num_subdevs = 0;
428 	pdata->subdevs = NULL;
429 	pdata->gpio_base = -1;
430 	pdata->irq_base = -1;
431 	pdata->pm_off = of_property_read_bool(np, "ti,system-power-controller");
432 
433 	return pdata;
434 }
435 
436 static const struct of_device_id tps6586x_of_match[] = {
437 	{ .compatible = "ti,tps6586x", },
438 	{ },
439 };
440 #else
tps6586x_parse_dt(struct i2c_client * client)441 static struct tps6586x_platform_data *tps6586x_parse_dt(struct i2c_client *client)
442 {
443 	return NULL;
444 }
445 #endif
446 
is_volatile_reg(struct device * dev,unsigned int reg)447 static bool is_volatile_reg(struct device *dev, unsigned int reg)
448 {
449 	/* Cache all interrupt mask register */
450 	if ((reg >= TPS6586X_INT_MASK1) && (reg <= TPS6586X_INT_MASK5))
451 		return false;
452 
453 	return true;
454 }
455 
456 static const struct regmap_config tps6586x_regmap_config = {
457 	.reg_bits = 8,
458 	.val_bits = 8,
459 	.max_register = TPS6586X_MAX_REGISTER,
460 	.volatile_reg = is_volatile_reg,
461 	.cache_type = REGCACHE_RBTREE,
462 };
463 
464 static struct device *tps6586x_dev;
tps6586x_power_off(void)465 static void tps6586x_power_off(void)
466 {
467 	if (tps6586x_clr_bits(tps6586x_dev, TPS6586X_SUPPLYENE, EXITSLREQ_BIT))
468 		return;
469 
470 	tps6586x_set_bits(tps6586x_dev, TPS6586X_SUPPLYENE, SLEEP_MODE_BIT);
471 }
472 
tps6586x_print_version(struct i2c_client * client,int version)473 static void tps6586x_print_version(struct i2c_client *client, int version)
474 {
475 	const char *name;
476 
477 	switch (version) {
478 	case TPS658621A:
479 		name = "TPS658621A";
480 		break;
481 	case TPS658621CD:
482 		name = "TPS658621C/D";
483 		break;
484 	case TPS658623:
485 		name = "TPS658623";
486 		break;
487 	case TPS658640:
488 	case TPS658640v2:
489 		name = "TPS658640";
490 		break;
491 	case TPS658643:
492 		name = "TPS658643";
493 		break;
494 	default:
495 		name = "TPS6586X";
496 		break;
497 	}
498 
499 	dev_info(&client->dev, "Found %s, VERSIONCRC is %02x\n", name, version);
500 }
501 
tps6586x_i2c_probe(struct i2c_client * client,const struct i2c_device_id * id)502 static int tps6586x_i2c_probe(struct i2c_client *client,
503 					const struct i2c_device_id *id)
504 {
505 	struct tps6586x_platform_data *pdata = dev_get_platdata(&client->dev);
506 	struct tps6586x *tps6586x;
507 	int ret;
508 	int version;
509 
510 	if (!pdata && client->dev.of_node)
511 		pdata = tps6586x_parse_dt(client);
512 
513 	if (!pdata) {
514 		dev_err(&client->dev, "tps6586x requires platform data\n");
515 		return -ENOTSUPP;
516 	}
517 
518 	version = i2c_smbus_read_byte_data(client, TPS6586X_VERSIONCRC);
519 	if (version < 0) {
520 		dev_err(&client->dev, "Chip ID read failed: %d\n", version);
521 		return -EIO;
522 	}
523 
524 	tps6586x = devm_kzalloc(&client->dev, sizeof(*tps6586x), GFP_KERNEL);
525 	if (!tps6586x)
526 		return -ENOMEM;
527 
528 	tps6586x->version = version;
529 	tps6586x_print_version(client, tps6586x->version);
530 
531 	tps6586x->client = client;
532 	tps6586x->dev = &client->dev;
533 	i2c_set_clientdata(client, tps6586x);
534 
535 	tps6586x->regmap = devm_regmap_init_i2c(client,
536 					&tps6586x_regmap_config);
537 	if (IS_ERR(tps6586x->regmap)) {
538 		ret = PTR_ERR(tps6586x->regmap);
539 		dev_err(&client->dev, "regmap init failed: %d\n", ret);
540 		return ret;
541 	}
542 
543 
544 	if (client->irq) {
545 		ret = tps6586x_irq_init(tps6586x, client->irq,
546 					pdata->irq_base);
547 		if (ret) {
548 			dev_err(&client->dev, "IRQ init failed: %d\n", ret);
549 			return ret;
550 		}
551 	}
552 
553 	ret = mfd_add_devices(tps6586x->dev, -1,
554 			      tps6586x_cell, ARRAY_SIZE(tps6586x_cell),
555 			      NULL, 0, tps6586x->irq_domain);
556 	if (ret < 0) {
557 		dev_err(&client->dev, "mfd_add_devices failed: %d\n", ret);
558 		goto err_mfd_add;
559 	}
560 
561 	ret = tps6586x_add_subdevs(tps6586x, pdata);
562 	if (ret) {
563 		dev_err(&client->dev, "add devices failed: %d\n", ret);
564 		goto err_add_devs;
565 	}
566 
567 	if (pdata->pm_off && !pm_power_off) {
568 		tps6586x_dev = &client->dev;
569 		pm_power_off = tps6586x_power_off;
570 	}
571 
572 	return 0;
573 
574 err_add_devs:
575 	mfd_remove_devices(tps6586x->dev);
576 err_mfd_add:
577 	if (client->irq)
578 		free_irq(client->irq, tps6586x);
579 	return ret;
580 }
581 
tps6586x_i2c_remove(struct i2c_client * client)582 static int tps6586x_i2c_remove(struct i2c_client *client)
583 {
584 	struct tps6586x *tps6586x = i2c_get_clientdata(client);
585 
586 	tps6586x_remove_subdevs(tps6586x);
587 	mfd_remove_devices(tps6586x->dev);
588 	if (client->irq)
589 		free_irq(client->irq, tps6586x);
590 	return 0;
591 }
592 
tps6586x_i2c_suspend(struct device * dev)593 static int __maybe_unused tps6586x_i2c_suspend(struct device *dev)
594 {
595 	struct tps6586x *tps6586x = dev_get_drvdata(dev);
596 
597 	if (tps6586x->client->irq)
598 		disable_irq(tps6586x->client->irq);
599 
600 	return 0;
601 }
602 
tps6586x_i2c_resume(struct device * dev)603 static int __maybe_unused tps6586x_i2c_resume(struct device *dev)
604 {
605 	struct tps6586x *tps6586x = dev_get_drvdata(dev);
606 
607 	if (tps6586x->client->irq)
608 		enable_irq(tps6586x->client->irq);
609 
610 	return 0;
611 }
612 
613 static SIMPLE_DEV_PM_OPS(tps6586x_pm_ops, tps6586x_i2c_suspend,
614 			 tps6586x_i2c_resume);
615 
616 static const struct i2c_device_id tps6586x_id_table[] = {
617 	{ "tps6586x", 0 },
618 	{ },
619 };
620 MODULE_DEVICE_TABLE(i2c, tps6586x_id_table);
621 
622 static struct i2c_driver tps6586x_driver = {
623 	.driver	= {
624 		.name	= "tps6586x",
625 		.of_match_table = of_match_ptr(tps6586x_of_match),
626 		.pm	= &tps6586x_pm_ops,
627 	},
628 	.probe		= tps6586x_i2c_probe,
629 	.remove		= tps6586x_i2c_remove,
630 	.id_table	= tps6586x_id_table,
631 };
632 
tps6586x_init(void)633 static int __init tps6586x_init(void)
634 {
635 	return i2c_add_driver(&tps6586x_driver);
636 }
637 subsys_initcall(tps6586x_init);
638 
tps6586x_exit(void)639 static void __exit tps6586x_exit(void)
640 {
641 	i2c_del_driver(&tps6586x_driver);
642 }
643 module_exit(tps6586x_exit);
644 
645 MODULE_DESCRIPTION("TPS6586X core driver");
646 MODULE_AUTHOR("Mike Rapoport <mike@compulab.co.il>");
647 MODULE_LICENSE("GPL");
648