blob: 5fec23a9ac039f34eaf6cf902acbfb6521aa7ab4 [file] [log] [blame]
Margarita Olaya36e52872011-06-09 14:50:00 -05001/*
2 * tps65912-core.c -- TI TPS65912x
3 *
4 * Copyright 2011 Texas Instruments Inc.
5 *
6 * Author: Margarita Olaya Cabrera <magi@slimlogic.co.uk>
7 *
8 * This program is free software; you can redistribute it and/or modify it
9 * under the terms of the GNU General Public License as published by the
10 * Free Software Foundation; either version 2 of the License, or (at your
11 * option) any later version.
12 *
13 * This driver is based on wm8350 implementation.
14 */
15
16#include <linux/module.h>
17#include <linux/moduleparam.h>
18#include <linux/init.h>
19#include <linux/slab.h>
20#include <linux/gpio.h>
21#include <linux/mfd/core.h>
22#include <linux/mfd/tps65912.h>
23
24static struct mfd_cell tps65912s[] = {
25 {
26 .name = "tps65912-pmic",
27 },
28};
29
30int tps65912_set_bits(struct tps65912 *tps65912, u8 reg, u8 mask)
31{
32 u8 data;
33 int err;
34
35 mutex_lock(&tps65912->io_mutex);
36
37 err = tps65912->read(tps65912, reg, 1, &data);
38 if (err) {
39 dev_err(tps65912->dev, "Read from reg 0x%x failed\n", reg);
40 goto out;
41 }
42
43 data |= mask;
44 err = tps65912->write(tps65912, reg, 1, &data);
45 if (err)
46 dev_err(tps65912->dev, "Write to reg 0x%x failed\n", reg);
47
48out:
49 mutex_unlock(&tps65912->io_mutex);
50 return err;
51}
52EXPORT_SYMBOL_GPL(tps65912_set_bits);
53
54int tps65912_clear_bits(struct tps65912 *tps65912, u8 reg, u8 mask)
55{
56 u8 data;
57 int err;
58
59 mutex_lock(&tps65912->io_mutex);
60 err = tps65912->read(tps65912, reg, 1, &data);
61 if (err) {
62 dev_err(tps65912->dev, "Read from reg 0x%x failed\n", reg);
63 goto out;
64 }
65
66 data &= ~mask;
67 err = tps65912->write(tps65912, reg, 1, &data);
68 if (err)
69 dev_err(tps65912->dev, "Write to reg 0x%x failed\n", reg);
70
71out:
72 mutex_unlock(&tps65912->io_mutex);
73 return err;
74}
75EXPORT_SYMBOL_GPL(tps65912_clear_bits);
76
77static inline int tps65912_read(struct tps65912 *tps65912, u8 reg)
78{
79 u8 val;
80 int err;
81
82 err = tps65912->read(tps65912, reg, 1, &val);
83 if (err < 0)
84 return err;
85
86 return val;
87}
88
89static inline int tps65912_write(struct tps65912 *tps65912, u8 reg, u8 val)
90{
91 return tps65912->write(tps65912, reg, 1, &val);
92}
93
94int tps65912_reg_read(struct tps65912 *tps65912, u8 reg)
95{
96 int data;
97
98 mutex_lock(&tps65912->io_mutex);
99
100 data = tps65912_read(tps65912, reg);
101 if (data < 0)
102 dev_err(tps65912->dev, "Read from reg 0x%x failed\n", reg);
103
104 mutex_unlock(&tps65912->io_mutex);
105 return data;
106}
107EXPORT_SYMBOL_GPL(tps65912_reg_read);
108
109int tps65912_reg_write(struct tps65912 *tps65912, u8 reg, u8 val)
110{
111 int err;
112
113 mutex_lock(&tps65912->io_mutex);
114
115 err = tps65912_write(tps65912, reg, val);
116 if (err < 0)
117 dev_err(tps65912->dev, "Write for reg 0x%x failed\n", reg);
118
119 mutex_unlock(&tps65912->io_mutex);
120 return err;
121}
122EXPORT_SYMBOL_GPL(tps65912_reg_write);
123
124int tps65912_device_init(struct tps65912 *tps65912)
125{
126 struct tps65912_board *pmic_plat_data = tps65912->dev->platform_data;
Margarita Olayad49a0f32011-06-09 14:50:13 -0500127 struct tps65912_platform_data *init_data;
Margarita Olaya36e52872011-06-09 14:50:00 -0500128 int ret, dcdc_avs, value;
129
Margarita Olayad49a0f32011-06-09 14:50:13 -0500130 init_data = kzalloc(sizeof(struct tps65912_platform_data), GFP_KERNEL);
131 if (init_data == NULL)
132 return -ENOMEM;
133
Margarita Olaya36e52872011-06-09 14:50:00 -0500134 mutex_init(&tps65912->io_mutex);
135 dev_set_drvdata(tps65912->dev, tps65912);
136
137 dcdc_avs = (pmic_plat_data->is_dcdc1_avs << 0 |
138 pmic_plat_data->is_dcdc2_avs << 1 |
139 pmic_plat_data->is_dcdc3_avs << 2 |
140 pmic_plat_data->is_dcdc4_avs << 3);
141 if (dcdc_avs) {
142 tps65912->read(tps65912, TPS65912_I2C_SPI_CFG, 1, &value);
143 dcdc_avs |= value;
144 tps65912->write(tps65912, TPS65912_I2C_SPI_CFG, 1, &dcdc_avs);
145 }
146
147 ret = mfd_add_devices(tps65912->dev, -1,
148 tps65912s, ARRAY_SIZE(tps65912s),
149 NULL, 0);
150 if (ret < 0)
151 goto err;
152
Jesper Juhl677df0c2011-09-20 14:13:06 -0700153 init_data->irq = pmic_plat_data->irq;
154 init_data->irq_base = pmic_plat_data->irq;
Margarita Olayad49a0f32011-06-09 14:50:13 -0500155 ret = tps65912_irq_init(tps65912, init_data->irq, init_data);
156 if (ret < 0)
157 goto err;
158
Jesper Juhl677df0c2011-09-20 14:13:06 -0700159 kfree(init_data);
Margarita Olaya36e52872011-06-09 14:50:00 -0500160 return ret;
161
162err:
Margarita Olayad49a0f32011-06-09 14:50:13 -0500163 kfree(init_data);
Margarita Olaya36e52872011-06-09 14:50:00 -0500164 mfd_remove_devices(tps65912->dev);
165 kfree(tps65912);
166 return ret;
167}
168
169void tps65912_device_exit(struct tps65912 *tps65912)
170{
171 mfd_remove_devices(tps65912->dev);
172 kfree(tps65912);
173}
174
175MODULE_AUTHOR("Margarita Olaya <magi@slimlogic.co.uk>");
176MODULE_DESCRIPTION("TPS65912x chip family multi-function driver");
177MODULE_LICENSE("GPL");