2 * Core driver for TI TPS6586x PMIC family
4 * Copyright (c) 2010 CompuLab Ltd.
5 * Mike Rapoport <mike@compulab.co.il>
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>
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.
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>
27 #include <linux/mfd/core.h>
28 #include <linux/mfd/tps6586x.h>
30 /* GPIO control registers */
31 #define TPS6586X_GPIOSET1 0x5d
32 #define TPS6586X_GPIOSET2 0x5e
34 /* interrupt control registers */
35 #define TPS6586X_INT_ACK1 0xb5
36 #define TPS6586X_INT_ACK2 0xb6
37 #define TPS6586X_INT_ACK3 0xb7
38 #define TPS6586X_INT_ACK4 0xb8
40 /* interrupt mask registers */
41 #define TPS6586X_INT_MASK1 0xb0
42 #define TPS6586X_INT_MASK2 0xb1
43 #define TPS6586X_INT_MASK3 0xb2
44 #define TPS6586X_INT_MASK4 0xb3
45 #define TPS6586X_INT_MASK5 0xb4
48 #define TPS6586X_VERSIONCRC 0xcd
50 struct tps6586x_irq_data
{
55 #define TPS6586X_IRQ(_reg, _mask) \
57 .mask_reg = (_reg) - TPS6586X_INT_MASK1, \
58 .mask_mask = (_mask), \
61 static const struct tps6586x_irq_data tps6586x_irqs
[] = {
62 [TPS6586X_INT_PLDO_0
] = TPS6586X_IRQ(TPS6586X_INT_MASK1
, 1 << 0),
63 [TPS6586X_INT_PLDO_1
] = TPS6586X_IRQ(TPS6586X_INT_MASK1
, 1 << 1),
64 [TPS6586X_INT_PLDO_2
] = TPS6586X_IRQ(TPS6586X_INT_MASK1
, 1 << 2),
65 [TPS6586X_INT_PLDO_3
] = TPS6586X_IRQ(TPS6586X_INT_MASK1
, 1 << 3),
66 [TPS6586X_INT_PLDO_4
] = TPS6586X_IRQ(TPS6586X_INT_MASK1
, 1 << 4),
67 [TPS6586X_INT_PLDO_5
] = TPS6586X_IRQ(TPS6586X_INT_MASK1
, 1 << 5),
68 [TPS6586X_INT_PLDO_6
] = TPS6586X_IRQ(TPS6586X_INT_MASK1
, 1 << 6),
69 [TPS6586X_INT_PLDO_7
] = TPS6586X_IRQ(TPS6586X_INT_MASK1
, 1 << 7),
70 [TPS6586X_INT_COMP_DET
] = TPS6586X_IRQ(TPS6586X_INT_MASK4
, 1 << 0),
71 [TPS6586X_INT_ADC
] = TPS6586X_IRQ(TPS6586X_INT_MASK2
, 1 << 1),
72 [TPS6586X_INT_PLDO_8
] = TPS6586X_IRQ(TPS6586X_INT_MASK2
, 1 << 2),
73 [TPS6586X_INT_PLDO_9
] = TPS6586X_IRQ(TPS6586X_INT_MASK2
, 1 << 3),
74 [TPS6586X_INT_PSM_0
] = TPS6586X_IRQ(TPS6586X_INT_MASK2
, 1 << 4),
75 [TPS6586X_INT_PSM_1
] = TPS6586X_IRQ(TPS6586X_INT_MASK2
, 1 << 5),
76 [TPS6586X_INT_PSM_2
] = TPS6586X_IRQ(TPS6586X_INT_MASK2
, 1 << 6),
77 [TPS6586X_INT_PSM_3
] = TPS6586X_IRQ(TPS6586X_INT_MASK2
, 1 << 7),
78 [TPS6586X_INT_RTC_ALM1
] = TPS6586X_IRQ(TPS6586X_INT_MASK5
, 1 << 4),
79 [TPS6586X_INT_ACUSB_OVP
] = TPS6586X_IRQ(TPS6586X_INT_MASK5
, 0x03),
80 [TPS6586X_INT_USB_DET
] = TPS6586X_IRQ(TPS6586X_INT_MASK5
, 1 << 2),
81 [TPS6586X_INT_AC_DET
] = TPS6586X_IRQ(TPS6586X_INT_MASK5
, 1 << 3),
82 [TPS6586X_INT_BAT_DET
] = TPS6586X_IRQ(TPS6586X_INT_MASK3
, 1 << 0),
83 [TPS6586X_INT_CHG_STAT
] = TPS6586X_IRQ(TPS6586X_INT_MASK4
, 0xfc),
84 [TPS6586X_INT_CHG_TEMP
] = TPS6586X_IRQ(TPS6586X_INT_MASK3
, 0x06),
85 [TPS6586X_INT_PP
] = TPS6586X_IRQ(TPS6586X_INT_MASK3
, 0xf0),
86 [TPS6586X_INT_RESUME
] = TPS6586X_IRQ(TPS6586X_INT_MASK5
, 1 << 5),
87 [TPS6586X_INT_LOW_SYS
] = TPS6586X_IRQ(TPS6586X_INT_MASK5
, 1 << 6),
88 [TPS6586X_INT_RTC_ALM2
] = TPS6586X_IRQ(TPS6586X_INT_MASK4
, 1 << 1),
94 struct i2c_client
*client
;
96 struct gpio_chip gpio
;
97 struct irq_chip irq_chip
;
98 struct mutex irq_lock
;
105 static inline int __tps6586x_read(struct i2c_client
*client
,
106 int reg
, uint8_t *val
)
110 ret
= i2c_smbus_read_byte_data(client
, reg
);
112 dev_err(&client
->dev
, "failed reading at 0x%02x\n", reg
);
121 static inline int __tps6586x_reads(struct i2c_client
*client
, int reg
,
122 int len
, uint8_t *val
)
126 ret
= i2c_smbus_read_i2c_block_data(client
, reg
, len
, val
);
128 dev_err(&client
->dev
, "failed reading from 0x%02x\n", reg
);
135 static inline int __tps6586x_write(struct i2c_client
*client
,
136 int reg
, uint8_t val
)
140 ret
= i2c_smbus_write_byte_data(client
, reg
, val
);
142 dev_err(&client
->dev
, "failed writing 0x%02x to 0x%02x\n",
150 static inline int __tps6586x_writes(struct i2c_client
*client
, int reg
,
151 int len
, uint8_t *val
)
155 for (i
= 0; i
< len
; i
++) {
156 ret
= __tps6586x_write(client
, reg
+ i
, *(val
+ i
));
164 int tps6586x_write(struct device
*dev
, int reg
, uint8_t val
)
166 return __tps6586x_write(to_i2c_client(dev
), reg
, val
);
168 EXPORT_SYMBOL_GPL(tps6586x_write
);
170 int tps6586x_writes(struct device
*dev
, int reg
, int len
, uint8_t *val
)
172 return __tps6586x_writes(to_i2c_client(dev
), reg
, len
, val
);
174 EXPORT_SYMBOL_GPL(tps6586x_writes
);
176 int tps6586x_read(struct device
*dev
, int reg
, uint8_t *val
)
178 return __tps6586x_read(to_i2c_client(dev
), reg
, val
);
180 EXPORT_SYMBOL_GPL(tps6586x_read
);
182 int tps6586x_reads(struct device
*dev
, int reg
, int len
, uint8_t *val
)
184 return __tps6586x_reads(to_i2c_client(dev
), reg
, len
, val
);
186 EXPORT_SYMBOL_GPL(tps6586x_reads
);
188 int tps6586x_set_bits(struct device
*dev
, int reg
, uint8_t bit_mask
)
190 struct tps6586x
*tps6586x
= dev_get_drvdata(dev
);
194 mutex_lock(&tps6586x
->lock
);
196 ret
= __tps6586x_read(to_i2c_client(dev
), reg
, ®_val
);
200 if ((reg_val
& bit_mask
) == 0) {
202 ret
= __tps6586x_write(to_i2c_client(dev
), reg
, reg_val
);
205 mutex_unlock(&tps6586x
->lock
);
208 EXPORT_SYMBOL_GPL(tps6586x_set_bits
);
210 int tps6586x_clr_bits(struct device
*dev
, int reg
, uint8_t bit_mask
)
212 struct tps6586x
*tps6586x
= dev_get_drvdata(dev
);
216 mutex_lock(&tps6586x
->lock
);
218 ret
= __tps6586x_read(to_i2c_client(dev
), reg
, ®_val
);
222 if (reg_val
& bit_mask
) {
223 reg_val
&= ~bit_mask
;
224 ret
= __tps6586x_write(to_i2c_client(dev
), reg
, reg_val
);
227 mutex_unlock(&tps6586x
->lock
);
230 EXPORT_SYMBOL_GPL(tps6586x_clr_bits
);
232 int tps6586x_update(struct device
*dev
, int reg
, uint8_t val
, uint8_t mask
)
234 struct tps6586x
*tps6586x
= dev_get_drvdata(dev
);
238 mutex_lock(&tps6586x
->lock
);
240 ret
= __tps6586x_read(tps6586x
->client
, reg
, ®_val
);
244 if ((reg_val
& mask
) != val
) {
245 reg_val
= (reg_val
& ~mask
) | val
;
246 ret
= __tps6586x_write(tps6586x
->client
, reg
, reg_val
);
249 mutex_unlock(&tps6586x
->lock
);
252 EXPORT_SYMBOL_GPL(tps6586x_update
);
254 static int tps6586x_gpio_get(struct gpio_chip
*gc
, unsigned offset
)
256 struct tps6586x
*tps6586x
= container_of(gc
, struct tps6586x
, gpio
);
260 ret
= __tps6586x_read(tps6586x
->client
, TPS6586X_GPIOSET2
, &val
);
264 return !!(val
& (1 << offset
));
268 static void tps6586x_gpio_set(struct gpio_chip
*chip
, unsigned offset
,
271 struct tps6586x
*tps6586x
= container_of(chip
, struct tps6586x
, gpio
);
273 __tps6586x_write(tps6586x
->client
, TPS6586X_GPIOSET2
,
277 static int tps6586x_gpio_output(struct gpio_chip
*gc
, unsigned offset
,
280 struct tps6586x
*tps6586x
= container_of(gc
, struct tps6586x
, gpio
);
283 tps6586x_gpio_set(gc
, offset
, value
);
285 val
= 0x1 << (offset
* 2);
286 mask
= 0x3 << (offset
* 2);
288 return tps6586x_update(tps6586x
->dev
, TPS6586X_GPIOSET1
, val
, mask
);
291 static int tps6586x_gpio_init(struct tps6586x
*tps6586x
, int gpio_base
)
296 tps6586x
->gpio
.owner
= THIS_MODULE
;
297 tps6586x
->gpio
.label
= tps6586x
->client
->name
;
298 tps6586x
->gpio
.dev
= tps6586x
->dev
;
299 tps6586x
->gpio
.base
= gpio_base
;
300 tps6586x
->gpio
.ngpio
= 4;
301 tps6586x
->gpio
.can_sleep
= 1;
303 /* FIXME: add handling of GPIOs as dedicated inputs */
304 tps6586x
->gpio
.direction_output
= tps6586x_gpio_output
;
305 tps6586x
->gpio
.set
= tps6586x_gpio_set
;
306 tps6586x
->gpio
.get
= tps6586x_gpio_get
;
308 return gpiochip_add(&tps6586x
->gpio
);
311 static int __remove_subdev(struct device
*dev
, void *unused
)
313 platform_device_unregister(to_platform_device(dev
));
317 static int tps6586x_remove_subdevs(struct tps6586x
*tps6586x
)
319 return device_for_each_child(tps6586x
->dev
, NULL
, __remove_subdev
);
322 static void tps6586x_irq_lock(struct irq_data
*data
)
324 struct tps6586x
*tps6586x
= irq_data_get_irq_chip_data(data
);
326 mutex_lock(&tps6586x
->irq_lock
);
329 static void tps6586x_irq_enable(struct irq_data
*irq_data
)
331 struct tps6586x
*tps6586x
= irq_data_get_irq_chip_data(irq_data
);
332 unsigned int __irq
= irq_data
->irq
- tps6586x
->irq_base
;
333 const struct tps6586x_irq_data
*data
= &tps6586x_irqs
[__irq
];
335 tps6586x
->mask_reg
[data
->mask_reg
] &= ~data
->mask_mask
;
336 tps6586x
->irq_en
|= (1 << __irq
);
339 static void tps6586x_irq_disable(struct irq_data
*irq_data
)
341 struct tps6586x
*tps6586x
= irq_data_get_irq_chip_data(irq_data
);
343 unsigned int __irq
= irq_data
->irq
- tps6586x
->irq_base
;
344 const struct tps6586x_irq_data
*data
= &tps6586x_irqs
[__irq
];
346 tps6586x
->mask_reg
[data
->mask_reg
] |= data
->mask_mask
;
347 tps6586x
->irq_en
&= ~(1 << __irq
);
350 static void tps6586x_irq_sync_unlock(struct irq_data
*data
)
352 struct tps6586x
*tps6586x
= irq_data_get_irq_chip_data(data
);
355 for (i
= 0; i
< ARRAY_SIZE(tps6586x
->mask_reg
); i
++) {
356 if (tps6586x
->mask_reg
[i
] != tps6586x
->mask_cache
[i
]) {
357 if (!WARN_ON(tps6586x_write(tps6586x
->dev
,
358 TPS6586X_INT_MASK1
+ i
,
359 tps6586x
->mask_reg
[i
])))
360 tps6586x
->mask_cache
[i
] = tps6586x
->mask_reg
[i
];
364 mutex_unlock(&tps6586x
->irq_lock
);
367 static irqreturn_t
tps6586x_irq(int irq
, void *data
)
369 struct tps6586x
*tps6586x
= data
;
373 ret
= tps6586x_reads(tps6586x
->dev
, TPS6586X_INT_ACK1
,
374 sizeof(acks
), (uint8_t *)&acks
);
377 dev_err(tps6586x
->dev
, "failed to read interrupt status\n");
381 acks
= le32_to_cpu(acks
);
386 if (tps6586x
->irq_en
& (1 << i
))
387 handle_nested_irq(tps6586x
->irq_base
+ i
);
395 static int __devinit
tps6586x_irq_init(struct tps6586x
*tps6586x
, int irq
,
402 dev_warn(tps6586x
->dev
, "No interrupt support on IRQ base\n");
406 mutex_init(&tps6586x
->irq_lock
);
407 for (i
= 0; i
< 5; i
++) {
408 tps6586x
->mask_cache
[i
] = 0xff;
409 tps6586x
->mask_reg
[i
] = 0xff;
410 tps6586x_write(tps6586x
->dev
, TPS6586X_INT_MASK1
+ i
, 0xff);
413 tps6586x_reads(tps6586x
->dev
, TPS6586X_INT_ACK1
, sizeof(tmp
), tmp
);
415 tps6586x
->irq_base
= irq_base
;
417 tps6586x
->irq_chip
.name
= "tps6586x";
418 tps6586x
->irq_chip
.irq_enable
= tps6586x_irq_enable
;
419 tps6586x
->irq_chip
.irq_disable
= tps6586x_irq_disable
;
420 tps6586x
->irq_chip
.irq_bus_lock
= tps6586x_irq_lock
;
421 tps6586x
->irq_chip
.irq_bus_sync_unlock
= tps6586x_irq_sync_unlock
;
423 for (i
= 0; i
< ARRAY_SIZE(tps6586x_irqs
); i
++) {
424 int __irq
= i
+ tps6586x
->irq_base
;
425 irq_set_chip_data(__irq
, tps6586x
);
426 irq_set_chip_and_handler(__irq
, &tps6586x
->irq_chip
,
428 irq_set_nested_thread(__irq
, 1);
430 set_irq_flags(__irq
, IRQF_VALID
);
434 ret
= request_threaded_irq(irq
, NULL
, tps6586x_irq
, IRQF_ONESHOT
,
435 "tps6586x", tps6586x
);
438 device_init_wakeup(tps6586x
->dev
, 1);
439 enable_irq_wake(irq
);
445 static int __devinit
tps6586x_add_subdevs(struct tps6586x
*tps6586x
,
446 struct tps6586x_platform_data
*pdata
)
448 struct tps6586x_subdev_info
*subdev
;
449 struct platform_device
*pdev
;
452 for (i
= 0; i
< pdata
->num_subdevs
; i
++) {
453 subdev
= &pdata
->subdevs
[i
];
455 pdev
= platform_device_alloc(subdev
->name
, subdev
->id
);
461 pdev
->dev
.parent
= tps6586x
->dev
;
462 pdev
->dev
.platform_data
= subdev
->platform_data
;
464 ret
= platform_device_add(pdev
);
466 platform_device_put(pdev
);
473 tps6586x_remove_subdevs(tps6586x
);
477 static int __devinit
tps6586x_i2c_probe(struct i2c_client
*client
,
478 const struct i2c_device_id
*id
)
480 struct tps6586x_platform_data
*pdata
= client
->dev
.platform_data
;
481 struct tps6586x
*tps6586x
;
485 dev_err(&client
->dev
, "tps6586x requires platform data\n");
489 ret
= i2c_smbus_read_byte_data(client
, TPS6586X_VERSIONCRC
);
491 dev_err(&client
->dev
, "Chip ID read failed: %d\n", ret
);
495 dev_info(&client
->dev
, "VERSIONCRC is %02x\n", ret
);
497 tps6586x
= kzalloc(sizeof(struct tps6586x
), GFP_KERNEL
);
498 if (tps6586x
== NULL
)
501 tps6586x
->client
= client
;
502 tps6586x
->dev
= &client
->dev
;
503 i2c_set_clientdata(client
, tps6586x
);
505 mutex_init(&tps6586x
->lock
);
508 ret
= tps6586x_irq_init(tps6586x
, client
->irq
,
511 dev_err(&client
->dev
, "IRQ init failed: %d\n", ret
);
516 ret
= tps6586x_gpio_init(tps6586x
, pdata
->gpio_base
);
518 dev_err(&client
->dev
, "GPIO registration failed: %d\n", ret
);
522 ret
= tps6586x_add_subdevs(tps6586x
, pdata
);
524 dev_err(&client
->dev
, "add devices failed: %d\n", ret
);
531 if (pdata
->gpio_base
) {
532 ret
= gpiochip_remove(&tps6586x
->gpio
);
534 dev_err(&client
->dev
, "Can't remove gpio chip: %d\n",
539 free_irq(client
->irq
, tps6586x
);
545 static int __devexit
tps6586x_i2c_remove(struct i2c_client
*client
)
547 struct tps6586x
*tps6586x
= i2c_get_clientdata(client
);
548 struct tps6586x_platform_data
*pdata
= client
->dev
.platform_data
;
552 free_irq(client
->irq
, tps6586x
);
554 if (pdata
->gpio_base
) {
555 ret
= gpiochip_remove(&tps6586x
->gpio
);
557 dev_err(&client
->dev
, "Can't remove gpio chip: %d\n",
561 tps6586x_remove_subdevs(tps6586x
);
566 static const struct i2c_device_id tps6586x_id_table
[] = {
570 MODULE_DEVICE_TABLE(i2c
, tps6586x_id_table
);
572 static struct i2c_driver tps6586x_driver
= {
575 .owner
= THIS_MODULE
,
577 .probe
= tps6586x_i2c_probe
,
578 .remove
= __devexit_p(tps6586x_i2c_remove
),
579 .id_table
= tps6586x_id_table
,
582 static int __init
tps6586x_init(void)
584 return i2c_add_driver(&tps6586x_driver
);
586 subsys_initcall(tps6586x_init
);
588 static void __exit
tps6586x_exit(void)
590 i2c_del_driver(&tps6586x_driver
);
592 module_exit(tps6586x_exit
);
594 MODULE_DESCRIPTION("TPS6586X core driver");
595 MODULE_AUTHOR("Mike Rapoport <mike@compulab.co.il>");
596 MODULE_LICENSE("GPL");