Loading...
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
54struct 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
65static 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
95static 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
103static 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
120struct 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
135static inline struct tps6586x *dev_to_tps6586x(struct device *dev)
136{
137 return i2c_get_clientdata(to_i2c_client(dev));
138}
139
140int 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}
146EXPORT_SYMBOL_GPL(tps6586x_write);
147
148int 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}
154EXPORT_SYMBOL_GPL(tps6586x_writes);
155
156int 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}
167EXPORT_SYMBOL_GPL(tps6586x_read);
168
169int 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}
175EXPORT_SYMBOL_GPL(tps6586x_reads);
176
177int 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}
183EXPORT_SYMBOL_GPL(tps6586x_set_bits);
184
185int 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}
191EXPORT_SYMBOL_GPL(tps6586x_clr_bits);
192
193int 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}
199EXPORT_SYMBOL_GPL(tps6586x_update);
200
201int 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}
207EXPORT_SYMBOL_GPL(tps6586x_irq_get_virq);
208
209int tps6586x_get_version(struct device *dev)
210{
211 struct tps6586x *tps6586x = dev_get_drvdata(dev);
212
213 return tps6586x->version;
214}
215EXPORT_SYMBOL_GPL(tps6586x_get_version);
216
217static int __remove_subdev(struct device *dev, void *unused)
218{
219 platform_device_unregister(to_platform_device(dev));
220 return 0;
221}
222
223static int tps6586x_remove_subdevs(struct tps6586x *tps6586x)
224{
225 return device_for_each_child(tps6586x->dev, NULL, __remove_subdev);
226}
227
228static 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
235static 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
245static 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
256static 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
273static 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
282static 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
291static 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
304static const struct irq_domain_ops tps6586x_domain_ops = {
305 .map = tps6586x_irq_map,
306 .xlate = irq_domain_xlate_twocell,
307};
308
309static 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
339static 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
384static 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
412failed:
413 tps6586x_remove_subdevs(tps6586x);
414 return ret;
415}
416
417#ifdef CONFIG_OF
418static 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
436static const struct of_device_id tps6586x_of_match[] = {
437 { .compatible = "ti,tps6586x", },
438 { },
439};
440#else
441static struct tps6586x_platform_data *tps6586x_parse_dt(struct i2c_client *client)
442{
443 return NULL;
444}
445#endif
446
447static 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
456static 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
464static struct device *tps6586x_dev;
465static 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
473static 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
502static 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
574err_add_devs:
575 mfd_remove_devices(tps6586x->dev);
576err_mfd_add:
577 if (client->irq)
578 free_irq(client->irq, tps6586x);
579 return ret;
580}
581
582static 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
593static 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
603static 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
613static SIMPLE_DEV_PM_OPS(tps6586x_pm_ops, tps6586x_i2c_suspend,
614 tps6586x_i2c_resume);
615
616static const struct i2c_device_id tps6586x_id_table[] = {
617 { "tps6586x", 0 },
618 { },
619};
620MODULE_DEVICE_TABLE(i2c, tps6586x_id_table);
621
622static 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
633static int __init tps6586x_init(void)
634{
635 return i2c_add_driver(&tps6586x_driver);
636}
637subsys_initcall(tps6586x_init);
638
639static void __exit tps6586x_exit(void)
640{
641 i2c_del_driver(&tps6586x_driver);
642}
643module_exit(tps6586x_exit);
644
645MODULE_DESCRIPTION("TPS6586X core driver");
646MODULE_AUTHOR("Mike Rapoport <mike@compulab.co.il>");
647MODULE_LICENSE("GPL");
1/*
2 * Core driver for TI TPS6586x PMIC family
3 *
4 * Copyright (c) 2010 CompuLab Ltd.
5 * Mike Rapoport <mike@compulab.co.il>
6 *
7 * Based on da903x.c.
8 * Copyright (C) 2008 Compulab, Ltd.
9 * Mike Rapoport <mike@compulab.co.il>
10 * Copyright (C) 2006-2008 Marvell International Ltd.
11 * Eric Miao <eric.miao@marvell.com>
12 *
13 * This program is free software; you can redistribute it and/or modify
14 * it under the terms of the GNU General Public License version 2 as
15 * published by the Free Software Foundation.
16 */
17
18#include <linux/interrupt.h>
19#include <linux/irq.h>
20#include <linux/kernel.h>
21#include <linux/module.h>
22#include <linux/mutex.h>
23#include <linux/slab.h>
24#include <linux/gpio.h>
25#include <linux/i2c.h>
26#include <linux/regulator/of_regulator.h>
27
28#include <linux/mfd/core.h>
29#include <linux/mfd/tps6586x.h>
30
31/* GPIO control registers */
32#define TPS6586X_GPIOSET1 0x5d
33#define TPS6586X_GPIOSET2 0x5e
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
51struct tps6586x_irq_data {
52 u8 mask_reg;
53 u8 mask_mask;
54};
55
56#define TPS6586X_IRQ(_reg, _mask) \
57 { \
58 .mask_reg = (_reg) - TPS6586X_INT_MASK1, \
59 .mask_mask = (_mask), \
60 }
61
62static const struct tps6586x_irq_data tps6586x_irqs[] = {
63 [TPS6586X_INT_PLDO_0] = TPS6586X_IRQ(TPS6586X_INT_MASK1, 1 << 0),
64 [TPS6586X_INT_PLDO_1] = TPS6586X_IRQ(TPS6586X_INT_MASK1, 1 << 1),
65 [TPS6586X_INT_PLDO_2] = TPS6586X_IRQ(TPS6586X_INT_MASK1, 1 << 2),
66 [TPS6586X_INT_PLDO_3] = TPS6586X_IRQ(TPS6586X_INT_MASK1, 1 << 3),
67 [TPS6586X_INT_PLDO_4] = TPS6586X_IRQ(TPS6586X_INT_MASK1, 1 << 4),
68 [TPS6586X_INT_PLDO_5] = TPS6586X_IRQ(TPS6586X_INT_MASK1, 1 << 5),
69 [TPS6586X_INT_PLDO_6] = TPS6586X_IRQ(TPS6586X_INT_MASK1, 1 << 6),
70 [TPS6586X_INT_PLDO_7] = TPS6586X_IRQ(TPS6586X_INT_MASK1, 1 << 7),
71 [TPS6586X_INT_COMP_DET] = TPS6586X_IRQ(TPS6586X_INT_MASK4, 1 << 0),
72 [TPS6586X_INT_ADC] = TPS6586X_IRQ(TPS6586X_INT_MASK2, 1 << 1),
73 [TPS6586X_INT_PLDO_8] = TPS6586X_IRQ(TPS6586X_INT_MASK2, 1 << 2),
74 [TPS6586X_INT_PLDO_9] = TPS6586X_IRQ(TPS6586X_INT_MASK2, 1 << 3),
75 [TPS6586X_INT_PSM_0] = TPS6586X_IRQ(TPS6586X_INT_MASK2, 1 << 4),
76 [TPS6586X_INT_PSM_1] = TPS6586X_IRQ(TPS6586X_INT_MASK2, 1 << 5),
77 [TPS6586X_INT_PSM_2] = TPS6586X_IRQ(TPS6586X_INT_MASK2, 1 << 6),
78 [TPS6586X_INT_PSM_3] = TPS6586X_IRQ(TPS6586X_INT_MASK2, 1 << 7),
79 [TPS6586X_INT_RTC_ALM1] = TPS6586X_IRQ(TPS6586X_INT_MASK5, 1 << 4),
80 [TPS6586X_INT_ACUSB_OVP] = TPS6586X_IRQ(TPS6586X_INT_MASK5, 0x03),
81 [TPS6586X_INT_USB_DET] = TPS6586X_IRQ(TPS6586X_INT_MASK5, 1 << 2),
82 [TPS6586X_INT_AC_DET] = TPS6586X_IRQ(TPS6586X_INT_MASK5, 1 << 3),
83 [TPS6586X_INT_BAT_DET] = TPS6586X_IRQ(TPS6586X_INT_MASK3, 1 << 0),
84 [TPS6586X_INT_CHG_STAT] = TPS6586X_IRQ(TPS6586X_INT_MASK4, 0xfc),
85 [TPS6586X_INT_CHG_TEMP] = TPS6586X_IRQ(TPS6586X_INT_MASK3, 0x06),
86 [TPS6586X_INT_PP] = TPS6586X_IRQ(TPS6586X_INT_MASK3, 0xf0),
87 [TPS6586X_INT_RESUME] = TPS6586X_IRQ(TPS6586X_INT_MASK5, 1 << 5),
88 [TPS6586X_INT_LOW_SYS] = TPS6586X_IRQ(TPS6586X_INT_MASK5, 1 << 6),
89 [TPS6586X_INT_RTC_ALM2] = TPS6586X_IRQ(TPS6586X_INT_MASK4, 1 << 1),
90};
91
92struct tps6586x {
93 struct mutex lock;
94 struct device *dev;
95 struct i2c_client *client;
96
97 struct gpio_chip gpio;
98 struct irq_chip irq_chip;
99 struct mutex irq_lock;
100 int irq_base;
101 u32 irq_en;
102 u8 mask_cache[5];
103 u8 mask_reg[5];
104};
105
106static inline int __tps6586x_read(struct i2c_client *client,
107 int reg, uint8_t *val)
108{
109 int ret;
110
111 ret = i2c_smbus_read_byte_data(client, reg);
112 if (ret < 0) {
113 dev_err(&client->dev, "failed reading at 0x%02x\n", reg);
114 return ret;
115 }
116
117 *val = (uint8_t)ret;
118
119 return 0;
120}
121
122static inline int __tps6586x_reads(struct i2c_client *client, int reg,
123 int len, uint8_t *val)
124{
125 int ret;
126
127 ret = i2c_smbus_read_i2c_block_data(client, reg, len, val);
128 if (ret < 0) {
129 dev_err(&client->dev, "failed reading from 0x%02x\n", reg);
130 return ret;
131 }
132
133 return 0;
134}
135
136static inline int __tps6586x_write(struct i2c_client *client,
137 int reg, uint8_t val)
138{
139 int ret;
140
141 ret = i2c_smbus_write_byte_data(client, reg, val);
142 if (ret < 0) {
143 dev_err(&client->dev, "failed writing 0x%02x to 0x%02x\n",
144 val, reg);
145 return ret;
146 }
147
148 return 0;
149}
150
151static inline int __tps6586x_writes(struct i2c_client *client, int reg,
152 int len, uint8_t *val)
153{
154 int ret, i;
155
156 for (i = 0; i < len; i++) {
157 ret = __tps6586x_write(client, reg + i, *(val + i));
158 if (ret < 0)
159 return ret;
160 }
161
162 return 0;
163}
164
165int tps6586x_write(struct device *dev, int reg, uint8_t val)
166{
167 return __tps6586x_write(to_i2c_client(dev), reg, val);
168}
169EXPORT_SYMBOL_GPL(tps6586x_write);
170
171int tps6586x_writes(struct device *dev, int reg, int len, uint8_t *val)
172{
173 return __tps6586x_writes(to_i2c_client(dev), reg, len, val);
174}
175EXPORT_SYMBOL_GPL(tps6586x_writes);
176
177int tps6586x_read(struct device *dev, int reg, uint8_t *val)
178{
179 return __tps6586x_read(to_i2c_client(dev), reg, val);
180}
181EXPORT_SYMBOL_GPL(tps6586x_read);
182
183int tps6586x_reads(struct device *dev, int reg, int len, uint8_t *val)
184{
185 return __tps6586x_reads(to_i2c_client(dev), reg, len, val);
186}
187EXPORT_SYMBOL_GPL(tps6586x_reads);
188
189int tps6586x_set_bits(struct device *dev, int reg, uint8_t bit_mask)
190{
191 struct tps6586x *tps6586x = dev_get_drvdata(dev);
192 uint8_t reg_val;
193 int ret = 0;
194
195 mutex_lock(&tps6586x->lock);
196
197 ret = __tps6586x_read(to_i2c_client(dev), reg, ®_val);
198 if (ret)
199 goto out;
200
201 if ((reg_val & bit_mask) != bit_mask) {
202 reg_val |= bit_mask;
203 ret = __tps6586x_write(to_i2c_client(dev), reg, reg_val);
204 }
205out:
206 mutex_unlock(&tps6586x->lock);
207 return ret;
208}
209EXPORT_SYMBOL_GPL(tps6586x_set_bits);
210
211int tps6586x_clr_bits(struct device *dev, int reg, uint8_t bit_mask)
212{
213 struct tps6586x *tps6586x = dev_get_drvdata(dev);
214 uint8_t reg_val;
215 int ret = 0;
216
217 mutex_lock(&tps6586x->lock);
218
219 ret = __tps6586x_read(to_i2c_client(dev), reg, ®_val);
220 if (ret)
221 goto out;
222
223 if (reg_val & bit_mask) {
224 reg_val &= ~bit_mask;
225 ret = __tps6586x_write(to_i2c_client(dev), reg, reg_val);
226 }
227out:
228 mutex_unlock(&tps6586x->lock);
229 return ret;
230}
231EXPORT_SYMBOL_GPL(tps6586x_clr_bits);
232
233int tps6586x_update(struct device *dev, int reg, uint8_t val, uint8_t mask)
234{
235 struct tps6586x *tps6586x = dev_get_drvdata(dev);
236 uint8_t reg_val;
237 int ret = 0;
238
239 mutex_lock(&tps6586x->lock);
240
241 ret = __tps6586x_read(tps6586x->client, reg, ®_val);
242 if (ret)
243 goto out;
244
245 if ((reg_val & mask) != val) {
246 reg_val = (reg_val & ~mask) | val;
247 ret = __tps6586x_write(tps6586x->client, reg, reg_val);
248 }
249out:
250 mutex_unlock(&tps6586x->lock);
251 return ret;
252}
253EXPORT_SYMBOL_GPL(tps6586x_update);
254
255static int tps6586x_gpio_get(struct gpio_chip *gc, unsigned offset)
256{
257 struct tps6586x *tps6586x = container_of(gc, struct tps6586x, gpio);
258 uint8_t val;
259 int ret;
260
261 ret = __tps6586x_read(tps6586x->client, TPS6586X_GPIOSET2, &val);
262 if (ret)
263 return ret;
264
265 return !!(val & (1 << offset));
266}
267
268
269static void tps6586x_gpio_set(struct gpio_chip *chip, unsigned offset,
270 int value)
271{
272 struct tps6586x *tps6586x = container_of(chip, struct tps6586x, gpio);
273
274 tps6586x_update(tps6586x->dev, TPS6586X_GPIOSET2,
275 value << offset, 1 << offset);
276}
277
278static int tps6586x_gpio_output(struct gpio_chip *gc, unsigned offset,
279 int value)
280{
281 struct tps6586x *tps6586x = container_of(gc, struct tps6586x, gpio);
282 uint8_t val, mask;
283
284 tps6586x_gpio_set(gc, offset, value);
285
286 val = 0x1 << (offset * 2);
287 mask = 0x3 << (offset * 2);
288
289 return tps6586x_update(tps6586x->dev, TPS6586X_GPIOSET1, val, mask);
290}
291
292static int tps6586x_gpio_init(struct tps6586x *tps6586x, int gpio_base)
293{
294 if (!gpio_base)
295 return 0;
296
297 tps6586x->gpio.owner = THIS_MODULE;
298 tps6586x->gpio.label = tps6586x->client->name;
299 tps6586x->gpio.dev = tps6586x->dev;
300 tps6586x->gpio.base = gpio_base;
301 tps6586x->gpio.ngpio = 4;
302 tps6586x->gpio.can_sleep = 1;
303
304 /* FIXME: add handling of GPIOs as dedicated inputs */
305 tps6586x->gpio.direction_output = tps6586x_gpio_output;
306 tps6586x->gpio.set = tps6586x_gpio_set;
307 tps6586x->gpio.get = tps6586x_gpio_get;
308
309 return gpiochip_add(&tps6586x->gpio);
310}
311
312static int __remove_subdev(struct device *dev, void *unused)
313{
314 platform_device_unregister(to_platform_device(dev));
315 return 0;
316}
317
318static int tps6586x_remove_subdevs(struct tps6586x *tps6586x)
319{
320 return device_for_each_child(tps6586x->dev, NULL, __remove_subdev);
321}
322
323static void tps6586x_irq_lock(struct irq_data *data)
324{
325 struct tps6586x *tps6586x = irq_data_get_irq_chip_data(data);
326
327 mutex_lock(&tps6586x->irq_lock);
328}
329
330static void tps6586x_irq_enable(struct irq_data *irq_data)
331{
332 struct tps6586x *tps6586x = irq_data_get_irq_chip_data(irq_data);
333 unsigned int __irq = irq_data->irq - tps6586x->irq_base;
334 const struct tps6586x_irq_data *data = &tps6586x_irqs[__irq];
335
336 tps6586x->mask_reg[data->mask_reg] &= ~data->mask_mask;
337 tps6586x->irq_en |= (1 << __irq);
338}
339
340static void tps6586x_irq_disable(struct irq_data *irq_data)
341{
342 struct tps6586x *tps6586x = irq_data_get_irq_chip_data(irq_data);
343
344 unsigned int __irq = irq_data->irq - tps6586x->irq_base;
345 const struct tps6586x_irq_data *data = &tps6586x_irqs[__irq];
346
347 tps6586x->mask_reg[data->mask_reg] |= data->mask_mask;
348 tps6586x->irq_en &= ~(1 << __irq);
349}
350
351static void tps6586x_irq_sync_unlock(struct irq_data *data)
352{
353 struct tps6586x *tps6586x = irq_data_get_irq_chip_data(data);
354 int i;
355
356 for (i = 0; i < ARRAY_SIZE(tps6586x->mask_reg); i++) {
357 if (tps6586x->mask_reg[i] != tps6586x->mask_cache[i]) {
358 if (!WARN_ON(tps6586x_write(tps6586x->dev,
359 TPS6586X_INT_MASK1 + i,
360 tps6586x->mask_reg[i])))
361 tps6586x->mask_cache[i] = tps6586x->mask_reg[i];
362 }
363 }
364
365 mutex_unlock(&tps6586x->irq_lock);
366}
367
368static irqreturn_t tps6586x_irq(int irq, void *data)
369{
370 struct tps6586x *tps6586x = data;
371 u32 acks;
372 int ret = 0;
373
374 ret = tps6586x_reads(tps6586x->dev, TPS6586X_INT_ACK1,
375 sizeof(acks), (uint8_t *)&acks);
376
377 if (ret < 0) {
378 dev_err(tps6586x->dev, "failed to read interrupt status\n");
379 return IRQ_NONE;
380 }
381
382 acks = le32_to_cpu(acks);
383
384 while (acks) {
385 int i = __ffs(acks);
386
387 if (tps6586x->irq_en & (1 << i))
388 handle_nested_irq(tps6586x->irq_base + i);
389
390 acks &= ~(1 << i);
391 }
392
393 return IRQ_HANDLED;
394}
395
396static int __devinit tps6586x_irq_init(struct tps6586x *tps6586x, int irq,
397 int irq_base)
398{
399 int i, ret;
400 u8 tmp[4];
401
402 if (!irq_base) {
403 dev_warn(tps6586x->dev, "No interrupt support on IRQ base\n");
404 return -EINVAL;
405 }
406
407 mutex_init(&tps6586x->irq_lock);
408 for (i = 0; i < 5; i++) {
409 tps6586x->mask_cache[i] = 0xff;
410 tps6586x->mask_reg[i] = 0xff;
411 tps6586x_write(tps6586x->dev, TPS6586X_INT_MASK1 + i, 0xff);
412 }
413
414 tps6586x_reads(tps6586x->dev, TPS6586X_INT_ACK1, sizeof(tmp), tmp);
415
416 tps6586x->irq_base = irq_base;
417
418 tps6586x->irq_chip.name = "tps6586x";
419 tps6586x->irq_chip.irq_enable = tps6586x_irq_enable;
420 tps6586x->irq_chip.irq_disable = tps6586x_irq_disable;
421 tps6586x->irq_chip.irq_bus_lock = tps6586x_irq_lock;
422 tps6586x->irq_chip.irq_bus_sync_unlock = tps6586x_irq_sync_unlock;
423
424 for (i = 0; i < ARRAY_SIZE(tps6586x_irqs); i++) {
425 int __irq = i + tps6586x->irq_base;
426 irq_set_chip_data(__irq, tps6586x);
427 irq_set_chip_and_handler(__irq, &tps6586x->irq_chip,
428 handle_simple_irq);
429 irq_set_nested_thread(__irq, 1);
430#ifdef CONFIG_ARM
431 set_irq_flags(__irq, IRQF_VALID);
432#endif
433 }
434
435 ret = request_threaded_irq(irq, NULL, tps6586x_irq, IRQF_ONESHOT,
436 "tps6586x", tps6586x);
437
438 if (!ret) {
439 device_init_wakeup(tps6586x->dev, 1);
440 enable_irq_wake(irq);
441 }
442
443 return ret;
444}
445
446static int __devinit tps6586x_add_subdevs(struct tps6586x *tps6586x,
447 struct tps6586x_platform_data *pdata)
448{
449 struct tps6586x_subdev_info *subdev;
450 struct platform_device *pdev;
451 int i, ret = 0;
452
453 for (i = 0; i < pdata->num_subdevs; i++) {
454 subdev = &pdata->subdevs[i];
455
456 pdev = platform_device_alloc(subdev->name, subdev->id);
457 if (!pdev) {
458 ret = -ENOMEM;
459 goto failed;
460 }
461
462 pdev->dev.parent = tps6586x->dev;
463 pdev->dev.platform_data = subdev->platform_data;
464 pdev->dev.of_node = subdev->of_node;
465
466 ret = platform_device_add(pdev);
467 if (ret) {
468 platform_device_put(pdev);
469 goto failed;
470 }
471 }
472 return 0;
473
474failed:
475 tps6586x_remove_subdevs(tps6586x);
476 return ret;
477}
478
479#ifdef CONFIG_OF
480static struct of_regulator_match tps6586x_matches[] = {
481 { .name = "sm0", .driver_data = (void *)TPS6586X_ID_SM_0 },
482 { .name = "sm1", .driver_data = (void *)TPS6586X_ID_SM_1 },
483 { .name = "sm2", .driver_data = (void *)TPS6586X_ID_SM_2 },
484 { .name = "ldo0", .driver_data = (void *)TPS6586X_ID_LDO_0 },
485 { .name = "ldo1", .driver_data = (void *)TPS6586X_ID_LDO_1 },
486 { .name = "ldo2", .driver_data = (void *)TPS6586X_ID_LDO_2 },
487 { .name = "ldo3", .driver_data = (void *)TPS6586X_ID_LDO_3 },
488 { .name = "ldo4", .driver_data = (void *)TPS6586X_ID_LDO_4 },
489 { .name = "ldo5", .driver_data = (void *)TPS6586X_ID_LDO_5 },
490 { .name = "ldo6", .driver_data = (void *)TPS6586X_ID_LDO_6 },
491 { .name = "ldo7", .driver_data = (void *)TPS6586X_ID_LDO_7 },
492 { .name = "ldo8", .driver_data = (void *)TPS6586X_ID_LDO_8 },
493 { .name = "ldo9", .driver_data = (void *)TPS6586X_ID_LDO_9 },
494 { .name = "ldo_rtc", .driver_data = (void *)TPS6586X_ID_LDO_RTC },
495};
496
497static struct tps6586x_platform_data *tps6586x_parse_dt(struct i2c_client *client)
498{
499 const unsigned int num = ARRAY_SIZE(tps6586x_matches);
500 struct device_node *np = client->dev.of_node;
501 struct tps6586x_platform_data *pdata;
502 struct tps6586x_subdev_info *devs;
503 struct device_node *regs;
504 unsigned int count;
505 unsigned int i, j;
506 int err;
507
508 regs = of_find_node_by_name(np, "regulators");
509 if (!regs)
510 return NULL;
511
512 err = of_regulator_match(&client->dev, regs, tps6586x_matches, num);
513 if (err < 0) {
514 of_node_put(regs);
515 return NULL;
516 }
517
518 of_node_put(regs);
519 count = err;
520
521 devs = devm_kzalloc(&client->dev, count * sizeof(*devs), GFP_KERNEL);
522 if (!devs)
523 return NULL;
524
525 for (i = 0, j = 0; i < num && j < count; i++) {
526 if (!tps6586x_matches[i].init_data)
527 continue;
528
529 devs[j].name = "tps6586x-regulator";
530 devs[j].platform_data = tps6586x_matches[i].init_data;
531 devs[j].id = (int)tps6586x_matches[i].driver_data;
532 devs[j].of_node = tps6586x_matches[i].of_node;
533 j++;
534 }
535
536 pdata = devm_kzalloc(&client->dev, sizeof(*pdata), GFP_KERNEL);
537 if (!pdata)
538 return NULL;
539
540 pdata->num_subdevs = count;
541 pdata->subdevs = devs;
542 pdata->gpio_base = -1;
543 pdata->irq_base = -1;
544
545 return pdata;
546}
547
548static struct of_device_id tps6586x_of_match[] = {
549 { .compatible = "ti,tps6586x", },
550 { },
551};
552#else
553static struct tps6586x_platform_data *tps6586x_parse_dt(struct i2c_client *client)
554{
555 return NULL;
556}
557#endif
558
559static int __devinit tps6586x_i2c_probe(struct i2c_client *client,
560 const struct i2c_device_id *id)
561{
562 struct tps6586x_platform_data *pdata = client->dev.platform_data;
563 struct tps6586x *tps6586x;
564 int ret;
565
566 if (!pdata && client->dev.of_node)
567 pdata = tps6586x_parse_dt(client);
568
569 if (!pdata) {
570 dev_err(&client->dev, "tps6586x requires platform data\n");
571 return -ENOTSUPP;
572 }
573
574 ret = i2c_smbus_read_byte_data(client, TPS6586X_VERSIONCRC);
575 if (ret < 0) {
576 dev_err(&client->dev, "Chip ID read failed: %d\n", ret);
577 return -EIO;
578 }
579
580 dev_info(&client->dev, "VERSIONCRC is %02x\n", ret);
581
582 tps6586x = kzalloc(sizeof(struct tps6586x), GFP_KERNEL);
583 if (tps6586x == NULL)
584 return -ENOMEM;
585
586 tps6586x->client = client;
587 tps6586x->dev = &client->dev;
588 i2c_set_clientdata(client, tps6586x);
589
590 mutex_init(&tps6586x->lock);
591
592 if (client->irq) {
593 ret = tps6586x_irq_init(tps6586x, client->irq,
594 pdata->irq_base);
595 if (ret) {
596 dev_err(&client->dev, "IRQ init failed: %d\n", ret);
597 goto err_irq_init;
598 }
599 }
600
601 ret = tps6586x_gpio_init(tps6586x, pdata->gpio_base);
602 if (ret) {
603 dev_err(&client->dev, "GPIO registration failed: %d\n", ret);
604 goto err_gpio_init;
605 }
606
607 ret = tps6586x_add_subdevs(tps6586x, pdata);
608 if (ret) {
609 dev_err(&client->dev, "add devices failed: %d\n", ret);
610 goto err_add_devs;
611 }
612
613 return 0;
614
615err_add_devs:
616 if (pdata->gpio_base) {
617 ret = gpiochip_remove(&tps6586x->gpio);
618 if (ret)
619 dev_err(&client->dev, "Can't remove gpio chip: %d\n",
620 ret);
621 }
622err_gpio_init:
623 if (client->irq)
624 free_irq(client->irq, tps6586x);
625err_irq_init:
626 kfree(tps6586x);
627 return ret;
628}
629
630static int __devexit tps6586x_i2c_remove(struct i2c_client *client)
631{
632 struct tps6586x *tps6586x = i2c_get_clientdata(client);
633 struct tps6586x_platform_data *pdata = client->dev.platform_data;
634 int ret;
635
636 if (client->irq)
637 free_irq(client->irq, tps6586x);
638
639 if (pdata->gpio_base) {
640 ret = gpiochip_remove(&tps6586x->gpio);
641 if (ret)
642 dev_err(&client->dev, "Can't remove gpio chip: %d\n",
643 ret);
644 }
645
646 tps6586x_remove_subdevs(tps6586x);
647 kfree(tps6586x);
648 return 0;
649}
650
651static const struct i2c_device_id tps6586x_id_table[] = {
652 { "tps6586x", 0 },
653 { },
654};
655MODULE_DEVICE_TABLE(i2c, tps6586x_id_table);
656
657static struct i2c_driver tps6586x_driver = {
658 .driver = {
659 .name = "tps6586x",
660 .owner = THIS_MODULE,
661 .of_match_table = of_match_ptr(tps6586x_of_match),
662 },
663 .probe = tps6586x_i2c_probe,
664 .remove = __devexit_p(tps6586x_i2c_remove),
665 .id_table = tps6586x_id_table,
666};
667
668static int __init tps6586x_init(void)
669{
670 return i2c_add_driver(&tps6586x_driver);
671}
672subsys_initcall(tps6586x_init);
673
674static void __exit tps6586x_exit(void)
675{
676 i2c_del_driver(&tps6586x_driver);
677}
678module_exit(tps6586x_exit);
679
680MODULE_DESCRIPTION("TPS6586X core driver");
681MODULE_AUTHOR("Mike Rapoport <mike@compulab.co.il>");
682MODULE_LICENSE("GPL");