1
2
3
4
5
6
7
8
9#include <linux/err.h>
10#include <linux/init.h>
11#include <linux/slab.h>
12#include <linux/i2c.h>
13#include <linux/interrupt.h>
14#include <linux/of.h>
15#include <linux/of_device.h>
16#include <linux/of_irq.h>
17#include <linux/pm_runtime.h>
18#include <linux/mutex.h>
19#include <linux/mfd/core.h>
20#include <linux/mfd/max8998.h>
21#include <linux/mfd/max8998-private.h>
22
23#define RTC_I2C_ADDR (0x0c >> 1)
24
25static const struct mfd_cell max8998_devs[] = {
26 {
27 .name = "max8998-pmic",
28 }, {
29 .name = "max8998-rtc",
30 }, {
31 .name = "max8998-battery",
32 },
33};
34
35static const struct mfd_cell lp3974_devs[] = {
36 {
37 .name = "lp3974-pmic",
38 }, {
39 .name = "lp3974-rtc",
40 },
41};
42
43int max8998_read_reg(struct i2c_client *i2c, u8 reg, u8 *dest)
44{
45 struct max8998_dev *max8998 = i2c_get_clientdata(i2c);
46 int ret;
47
48 mutex_lock(&max8998->iolock);
49 ret = i2c_smbus_read_byte_data(i2c, reg);
50 mutex_unlock(&max8998->iolock);
51 if (ret < 0)
52 return ret;
53
54 ret &= 0xff;
55 *dest = ret;
56 return 0;
57}
58EXPORT_SYMBOL(max8998_read_reg);
59
60int max8998_bulk_read(struct i2c_client *i2c, u8 reg, int count, u8 *buf)
61{
62 struct max8998_dev *max8998 = i2c_get_clientdata(i2c);
63 int ret;
64
65 mutex_lock(&max8998->iolock);
66 ret = i2c_smbus_read_i2c_block_data(i2c, reg, count, buf);
67 mutex_unlock(&max8998->iolock);
68 if (ret < 0)
69 return ret;
70
71 return 0;
72}
73EXPORT_SYMBOL(max8998_bulk_read);
74
75int max8998_write_reg(struct i2c_client *i2c, u8 reg, u8 value)
76{
77 struct max8998_dev *max8998 = i2c_get_clientdata(i2c);
78 int ret;
79
80 mutex_lock(&max8998->iolock);
81 ret = i2c_smbus_write_byte_data(i2c, reg, value);
82 mutex_unlock(&max8998->iolock);
83 return ret;
84}
85EXPORT_SYMBOL(max8998_write_reg);
86
87int max8998_bulk_write(struct i2c_client *i2c, u8 reg, int count, u8 *buf)
88{
89 struct max8998_dev *max8998 = i2c_get_clientdata(i2c);
90 int ret;
91
92 mutex_lock(&max8998->iolock);
93 ret = i2c_smbus_write_i2c_block_data(i2c, reg, count, buf);
94 mutex_unlock(&max8998->iolock);
95 if (ret < 0)
96 return ret;
97
98 return 0;
99}
100EXPORT_SYMBOL(max8998_bulk_write);
101
102int max8998_update_reg(struct i2c_client *i2c, u8 reg, u8 val, u8 mask)
103{
104 struct max8998_dev *max8998 = i2c_get_clientdata(i2c);
105 int ret;
106
107 mutex_lock(&max8998->iolock);
108 ret = i2c_smbus_read_byte_data(i2c, reg);
109 if (ret >= 0) {
110 u8 old_val = ret & 0xff;
111 u8 new_val = (val & mask) | (old_val & (~mask));
112 ret = i2c_smbus_write_byte_data(i2c, reg, new_val);
113 }
114 mutex_unlock(&max8998->iolock);
115 return ret;
116}
117EXPORT_SYMBOL(max8998_update_reg);
118
119#ifdef CONFIG_OF
120static const struct of_device_id max8998_dt_match[] = {
121 { .compatible = "maxim,max8998", .data = (void *)TYPE_MAX8998 },
122 { .compatible = "national,lp3974", .data = (void *)TYPE_LP3974 },
123 { .compatible = "ti,lp3974", .data = (void *)TYPE_LP3974 },
124 {},
125};
126#endif
127
128
129
130
131
132
133
134
135
136
137static struct max8998_platform_data *max8998_i2c_parse_dt_pdata(
138 struct device *dev)
139{
140 struct max8998_platform_data *pd;
141
142 pd = devm_kzalloc(dev, sizeof(*pd), GFP_KERNEL);
143 if (!pd)
144 return ERR_PTR(-ENOMEM);
145
146 pd->ono = irq_of_parse_and_map(dev->of_node, 1);
147
148
149
150
151
152
153 return pd;
154}
155
156static inline unsigned long max8998_i2c_get_driver_data(struct i2c_client *i2c,
157 const struct i2c_device_id *id)
158{
159 if (i2c->dev.of_node)
160 return (unsigned long)of_device_get_match_data(&i2c->dev);
161
162 return id->driver_data;
163}
164
165static int max8998_i2c_probe(struct i2c_client *i2c,
166 const struct i2c_device_id *id)
167{
168 struct max8998_platform_data *pdata = dev_get_platdata(&i2c->dev);
169 struct max8998_dev *max8998;
170 int ret = 0;
171
172 max8998 = devm_kzalloc(&i2c->dev, sizeof(struct max8998_dev),
173 GFP_KERNEL);
174 if (max8998 == NULL)
175 return -ENOMEM;
176
177 if (IS_ENABLED(CONFIG_OF) && i2c->dev.of_node) {
178 pdata = max8998_i2c_parse_dt_pdata(&i2c->dev);
179 if (IS_ERR(pdata))
180 return PTR_ERR(pdata);
181 }
182
183 i2c_set_clientdata(i2c, max8998);
184 max8998->dev = &i2c->dev;
185 max8998->i2c = i2c;
186 max8998->irq = i2c->irq;
187 max8998->type = max8998_i2c_get_driver_data(i2c, id);
188 max8998->pdata = pdata;
189 if (pdata) {
190 max8998->ono = pdata->ono;
191 max8998->irq_base = pdata->irq_base;
192 max8998->wakeup = pdata->wakeup;
193 }
194 mutex_init(&max8998->iolock);
195
196 max8998->rtc = i2c_new_dummy_device(i2c->adapter, RTC_I2C_ADDR);
197 if (IS_ERR(max8998->rtc)) {
198 dev_err(&i2c->dev, "Failed to allocate I2C device for RTC\n");
199 return PTR_ERR(max8998->rtc);
200 }
201 i2c_set_clientdata(max8998->rtc, max8998);
202
203 max8998_irq_init(max8998);
204
205 pm_runtime_set_active(max8998->dev);
206
207 switch (max8998->type) {
208 case TYPE_LP3974:
209 ret = mfd_add_devices(max8998->dev, -1,
210 lp3974_devs, ARRAY_SIZE(lp3974_devs),
211 NULL, 0, NULL);
212 break;
213 case TYPE_MAX8998:
214 ret = mfd_add_devices(max8998->dev, -1,
215 max8998_devs, ARRAY_SIZE(max8998_devs),
216 NULL, 0, NULL);
217 break;
218 default:
219 ret = -EINVAL;
220 }
221
222 if (ret < 0)
223 goto err;
224
225 device_init_wakeup(max8998->dev, max8998->wakeup);
226
227 return ret;
228
229err:
230 mfd_remove_devices(max8998->dev);
231 max8998_irq_exit(max8998);
232 i2c_unregister_device(max8998->rtc);
233 return ret;
234}
235
236static const struct i2c_device_id max8998_i2c_id[] = {
237 { "max8998", TYPE_MAX8998 },
238 { "lp3974", TYPE_LP3974},
239 { }
240};
241
242static int max8998_suspend(struct device *dev)
243{
244 struct i2c_client *i2c = to_i2c_client(dev);
245 struct max8998_dev *max8998 = i2c_get_clientdata(i2c);
246
247 if (device_may_wakeup(dev))
248 irq_set_irq_wake(max8998->irq, 1);
249 return 0;
250}
251
252static int max8998_resume(struct device *dev)
253{
254 struct i2c_client *i2c = to_i2c_client(dev);
255 struct max8998_dev *max8998 = i2c_get_clientdata(i2c);
256
257 if (device_may_wakeup(dev))
258 irq_set_irq_wake(max8998->irq, 0);
259
260
261
262
263
264 return max8998_irq_resume(i2c_get_clientdata(i2c));
265}
266
267struct max8998_reg_dump {
268 u8 addr;
269 u8 val;
270};
271#define SAVE_ITEM(x) { .addr = (x), .val = 0x0, }
272static struct max8998_reg_dump max8998_dump[] = {
273 SAVE_ITEM(MAX8998_REG_IRQM1),
274 SAVE_ITEM(MAX8998_REG_IRQM2),
275 SAVE_ITEM(MAX8998_REG_IRQM3),
276 SAVE_ITEM(MAX8998_REG_IRQM4),
277 SAVE_ITEM(MAX8998_REG_STATUSM1),
278 SAVE_ITEM(MAX8998_REG_STATUSM2),
279 SAVE_ITEM(MAX8998_REG_CHGR1),
280 SAVE_ITEM(MAX8998_REG_CHGR2),
281 SAVE_ITEM(MAX8998_REG_LDO_ACTIVE_DISCHARGE1),
282 SAVE_ITEM(MAX8998_REG_LDO_ACTIVE_DISCHARGE1),
283 SAVE_ITEM(MAX8998_REG_BUCK_ACTIVE_DISCHARGE3),
284 SAVE_ITEM(MAX8998_REG_ONOFF1),
285 SAVE_ITEM(MAX8998_REG_ONOFF2),
286 SAVE_ITEM(MAX8998_REG_ONOFF3),
287 SAVE_ITEM(MAX8998_REG_ONOFF4),
288 SAVE_ITEM(MAX8998_REG_BUCK1_VOLTAGE1),
289 SAVE_ITEM(MAX8998_REG_BUCK1_VOLTAGE2),
290 SAVE_ITEM(MAX8998_REG_BUCK1_VOLTAGE3),
291 SAVE_ITEM(MAX8998_REG_BUCK1_VOLTAGE4),
292 SAVE_ITEM(MAX8998_REG_BUCK2_VOLTAGE1),
293 SAVE_ITEM(MAX8998_REG_BUCK2_VOLTAGE2),
294 SAVE_ITEM(MAX8998_REG_LDO2_LDO3),
295 SAVE_ITEM(MAX8998_REG_LDO4),
296 SAVE_ITEM(MAX8998_REG_LDO5),
297 SAVE_ITEM(MAX8998_REG_LDO6),
298 SAVE_ITEM(MAX8998_REG_LDO7),
299 SAVE_ITEM(MAX8998_REG_LDO8_LDO9),
300 SAVE_ITEM(MAX8998_REG_LDO10_LDO11),
301 SAVE_ITEM(MAX8998_REG_LDO12),
302 SAVE_ITEM(MAX8998_REG_LDO13),
303 SAVE_ITEM(MAX8998_REG_LDO14),
304 SAVE_ITEM(MAX8998_REG_LDO15),
305 SAVE_ITEM(MAX8998_REG_LDO16),
306 SAVE_ITEM(MAX8998_REG_LDO17),
307 SAVE_ITEM(MAX8998_REG_BKCHR),
308 SAVE_ITEM(MAX8998_REG_LBCNFG1),
309 SAVE_ITEM(MAX8998_REG_LBCNFG2),
310};
311
312static int max8998_freeze(struct device *dev)
313{
314 struct i2c_client *i2c = to_i2c_client(dev);
315 int i;
316
317 for (i = 0; i < ARRAY_SIZE(max8998_dump); i++)
318 max8998_read_reg(i2c, max8998_dump[i].addr,
319 &max8998_dump[i].val);
320
321 return 0;
322}
323
324
325static int max8998_restore(struct device *dev)
326{
327 struct i2c_client *i2c = to_i2c_client(dev);
328 int i;
329
330 for (i = 0; i < ARRAY_SIZE(max8998_dump); i++)
331 max8998_write_reg(i2c, max8998_dump[i].addr,
332 max8998_dump[i].val);
333
334 return 0;
335}
336
337static const struct dev_pm_ops max8998_pm = {
338 .suspend = max8998_suspend,
339 .resume = max8998_resume,
340 .freeze = max8998_freeze,
341 .restore = max8998_restore,
342};
343
344static struct i2c_driver max8998_i2c_driver = {
345 .driver = {
346 .name = "max8998",
347 .pm = &max8998_pm,
348 .suppress_bind_attrs = true,
349 .of_match_table = of_match_ptr(max8998_dt_match),
350 },
351 .probe = max8998_i2c_probe,
352 .id_table = max8998_i2c_id,
353};
354
355static int __init max8998_i2c_init(void)
356{
357 return i2c_add_driver(&max8998_i2c_driver);
358}
359
360subsys_initcall(max8998_i2c_init);
361
