treewide: remove redundant IS_ERR() before error code check
[linux/fpc-iii.git] / drivers / mfd / max8998.c
blob785f8e9841b76218e2abe12f307ae75c95aa040e
1 // SPDX-License-Identifier: GPL-2.0+
2 //
3 // max8998.c - mfd core driver for the Maxim 8998
4 //
5 // Copyright (C) 2009-2010 Samsung Electronics
6 // Kyungmin Park <kyungmin.park@samsung.com>
7 // Marek Szyprowski <m.szyprowski@samsung.com>
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_irq.h>
16 #include <linux/pm_runtime.h>
17 #include <linux/mutex.h>
18 #include <linux/mfd/core.h>
19 #include <linux/mfd/max8998.h>
20 #include <linux/mfd/max8998-private.h>
22 #define RTC_I2C_ADDR (0x0c >> 1)
24 static const struct mfd_cell max8998_devs[] = {
26 .name = "max8998-pmic",
27 }, {
28 .name = "max8998-rtc",
29 }, {
30 .name = "max8998-battery",
34 static const struct mfd_cell lp3974_devs[] = {
36 .name = "lp3974-pmic",
37 }, {
38 .name = "lp3974-rtc",
42 int max8998_read_reg(struct i2c_client *i2c, u8 reg, u8 *dest)
44 struct max8998_dev *max8998 = i2c_get_clientdata(i2c);
45 int ret;
47 mutex_lock(&max8998->iolock);
48 ret = i2c_smbus_read_byte_data(i2c, reg);
49 mutex_unlock(&max8998->iolock);
50 if (ret < 0)
51 return ret;
53 ret &= 0xff;
54 *dest = ret;
55 return 0;
57 EXPORT_SYMBOL(max8998_read_reg);
59 int max8998_bulk_read(struct i2c_client *i2c, u8 reg, int count, u8 *buf)
61 struct max8998_dev *max8998 = i2c_get_clientdata(i2c);
62 int ret;
64 mutex_lock(&max8998->iolock);
65 ret = i2c_smbus_read_i2c_block_data(i2c, reg, count, buf);
66 mutex_unlock(&max8998->iolock);
67 if (ret < 0)
68 return ret;
70 return 0;
72 EXPORT_SYMBOL(max8998_bulk_read);
74 int max8998_write_reg(struct i2c_client *i2c, u8 reg, u8 value)
76 struct max8998_dev *max8998 = i2c_get_clientdata(i2c);
77 int ret;
79 mutex_lock(&max8998->iolock);
80 ret = i2c_smbus_write_byte_data(i2c, reg, value);
81 mutex_unlock(&max8998->iolock);
82 return ret;
84 EXPORT_SYMBOL(max8998_write_reg);
86 int max8998_bulk_write(struct i2c_client *i2c, u8 reg, int count, u8 *buf)
88 struct max8998_dev *max8998 = i2c_get_clientdata(i2c);
89 int ret;
91 mutex_lock(&max8998->iolock);
92 ret = i2c_smbus_write_i2c_block_data(i2c, reg, count, buf);
93 mutex_unlock(&max8998->iolock);
94 if (ret < 0)
95 return ret;
97 return 0;
99 EXPORT_SYMBOL(max8998_bulk_write);
101 int max8998_update_reg(struct i2c_client *i2c, u8 reg, u8 val, u8 mask)
103 struct max8998_dev *max8998 = i2c_get_clientdata(i2c);
104 int ret;
106 mutex_lock(&max8998->iolock);
107 ret = i2c_smbus_read_byte_data(i2c, reg);
108 if (ret >= 0) {
109 u8 old_val = ret & 0xff;
110 u8 new_val = (val & mask) | (old_val & (~mask));
111 ret = i2c_smbus_write_byte_data(i2c, reg, new_val);
113 mutex_unlock(&max8998->iolock);
114 return ret;
116 EXPORT_SYMBOL(max8998_update_reg);
118 #ifdef CONFIG_OF
119 static const struct of_device_id max8998_dt_match[] = {
120 { .compatible = "maxim,max8998", .data = (void *)TYPE_MAX8998 },
121 { .compatible = "national,lp3974", .data = (void *)TYPE_LP3974 },
122 { .compatible = "ti,lp3974", .data = (void *)TYPE_LP3974 },
125 #endif
128 * Only the common platform data elements for max8998 are parsed here from the
129 * device tree. Other sub-modules of max8998 such as pmic, rtc and others have
130 * to parse their own platform data elements from device tree.
132 * The max8998 platform data structure is instantiated here and the drivers for
133 * the sub-modules need not instantiate another instance while parsing their
134 * platform data.
136 static struct max8998_platform_data *max8998_i2c_parse_dt_pdata(
137 struct device *dev)
139 struct max8998_platform_data *pd;
141 pd = devm_kzalloc(dev, sizeof(*pd), GFP_KERNEL);
142 if (!pd)
143 return ERR_PTR(-ENOMEM);
145 pd->ono = irq_of_parse_and_map(dev->of_node, 1);
148 * ToDo: the 'wakeup' member in the platform data is more of a linux
149 * specfic information. Hence, there is no binding for that yet and
150 * not parsed here.
152 return pd;
155 static inline unsigned long max8998_i2c_get_driver_data(struct i2c_client *i2c,
156 const struct i2c_device_id *id)
158 if (IS_ENABLED(CONFIG_OF) && i2c->dev.of_node) {
159 const struct of_device_id *match;
160 match = of_match_node(max8998_dt_match, i2c->dev.of_node);
161 return (unsigned long)match->data;
164 return id->driver_data;
167 static int max8998_i2c_probe(struct i2c_client *i2c,
168 const struct i2c_device_id *id)
170 struct max8998_platform_data *pdata = dev_get_platdata(&i2c->dev);
171 struct max8998_dev *max8998;
172 int ret = 0;
174 max8998 = devm_kzalloc(&i2c->dev, sizeof(struct max8998_dev),
175 GFP_KERNEL);
176 if (max8998 == NULL)
177 return -ENOMEM;
179 if (IS_ENABLED(CONFIG_OF) && i2c->dev.of_node) {
180 pdata = max8998_i2c_parse_dt_pdata(&i2c->dev);
181 if (IS_ERR(pdata))
182 return PTR_ERR(pdata);
185 i2c_set_clientdata(i2c, max8998);
186 max8998->dev = &i2c->dev;
187 max8998->i2c = i2c;
188 max8998->irq = i2c->irq;
189 max8998->type = max8998_i2c_get_driver_data(i2c, id);
190 max8998->pdata = pdata;
191 if (pdata) {
192 max8998->ono = pdata->ono;
193 max8998->irq_base = pdata->irq_base;
194 max8998->wakeup = pdata->wakeup;
196 mutex_init(&max8998->iolock);
198 max8998->rtc = i2c_new_dummy_device(i2c->adapter, RTC_I2C_ADDR);
199 if (IS_ERR(max8998->rtc)) {
200 dev_err(&i2c->dev, "Failed to allocate I2C device for RTC\n");
201 return PTR_ERR(max8998->rtc);
203 i2c_set_clientdata(max8998->rtc, max8998);
205 max8998_irq_init(max8998);
207 pm_runtime_set_active(max8998->dev);
209 switch (max8998->type) {
210 case TYPE_LP3974:
211 ret = mfd_add_devices(max8998->dev, -1,
212 lp3974_devs, ARRAY_SIZE(lp3974_devs),
213 NULL, 0, NULL);
214 break;
215 case TYPE_MAX8998:
216 ret = mfd_add_devices(max8998->dev, -1,
217 max8998_devs, ARRAY_SIZE(max8998_devs),
218 NULL, 0, NULL);
219 break;
220 default:
221 ret = -EINVAL;
224 if (ret < 0)
225 goto err;
227 device_init_wakeup(max8998->dev, max8998->wakeup);
229 return ret;
231 err:
232 mfd_remove_devices(max8998->dev);
233 max8998_irq_exit(max8998);
234 i2c_unregister_device(max8998->rtc);
235 return ret;
238 static const struct i2c_device_id max8998_i2c_id[] = {
239 { "max8998", TYPE_MAX8998 },
240 { "lp3974", TYPE_LP3974},
244 static int max8998_suspend(struct device *dev)
246 struct i2c_client *i2c = to_i2c_client(dev);
247 struct max8998_dev *max8998 = i2c_get_clientdata(i2c);
249 if (device_may_wakeup(dev))
250 irq_set_irq_wake(max8998->irq, 1);
251 return 0;
254 static int max8998_resume(struct device *dev)
256 struct i2c_client *i2c = to_i2c_client(dev);
257 struct max8998_dev *max8998 = i2c_get_clientdata(i2c);
259 if (device_may_wakeup(dev))
260 irq_set_irq_wake(max8998->irq, 0);
262 * In LP3974, if IRQ registers are not "read & clear"
263 * when it's set during sleep, the interrupt becomes
264 * disabled.
266 return max8998_irq_resume(i2c_get_clientdata(i2c));
269 struct max8998_reg_dump {
270 u8 addr;
271 u8 val;
273 #define SAVE_ITEM(x) { .addr = (x), .val = 0x0, }
274 static struct max8998_reg_dump max8998_dump[] = {
275 SAVE_ITEM(MAX8998_REG_IRQM1),
276 SAVE_ITEM(MAX8998_REG_IRQM2),
277 SAVE_ITEM(MAX8998_REG_IRQM3),
278 SAVE_ITEM(MAX8998_REG_IRQM4),
279 SAVE_ITEM(MAX8998_REG_STATUSM1),
280 SAVE_ITEM(MAX8998_REG_STATUSM2),
281 SAVE_ITEM(MAX8998_REG_CHGR1),
282 SAVE_ITEM(MAX8998_REG_CHGR2),
283 SAVE_ITEM(MAX8998_REG_LDO_ACTIVE_DISCHARGE1),
284 SAVE_ITEM(MAX8998_REG_LDO_ACTIVE_DISCHARGE1),
285 SAVE_ITEM(MAX8998_REG_BUCK_ACTIVE_DISCHARGE3),
286 SAVE_ITEM(MAX8998_REG_ONOFF1),
287 SAVE_ITEM(MAX8998_REG_ONOFF2),
288 SAVE_ITEM(MAX8998_REG_ONOFF3),
289 SAVE_ITEM(MAX8998_REG_ONOFF4),
290 SAVE_ITEM(MAX8998_REG_BUCK1_VOLTAGE1),
291 SAVE_ITEM(MAX8998_REG_BUCK1_VOLTAGE2),
292 SAVE_ITEM(MAX8998_REG_BUCK1_VOLTAGE3),
293 SAVE_ITEM(MAX8998_REG_BUCK1_VOLTAGE4),
294 SAVE_ITEM(MAX8998_REG_BUCK2_VOLTAGE1),
295 SAVE_ITEM(MAX8998_REG_BUCK2_VOLTAGE2),
296 SAVE_ITEM(MAX8998_REG_LDO2_LDO3),
297 SAVE_ITEM(MAX8998_REG_LDO4),
298 SAVE_ITEM(MAX8998_REG_LDO5),
299 SAVE_ITEM(MAX8998_REG_LDO6),
300 SAVE_ITEM(MAX8998_REG_LDO7),
301 SAVE_ITEM(MAX8998_REG_LDO8_LDO9),
302 SAVE_ITEM(MAX8998_REG_LDO10_LDO11),
303 SAVE_ITEM(MAX8998_REG_LDO12),
304 SAVE_ITEM(MAX8998_REG_LDO13),
305 SAVE_ITEM(MAX8998_REG_LDO14),
306 SAVE_ITEM(MAX8998_REG_LDO15),
307 SAVE_ITEM(MAX8998_REG_LDO16),
308 SAVE_ITEM(MAX8998_REG_LDO17),
309 SAVE_ITEM(MAX8998_REG_BKCHR),
310 SAVE_ITEM(MAX8998_REG_LBCNFG1),
311 SAVE_ITEM(MAX8998_REG_LBCNFG2),
313 /* Save registers before hibernation */
314 static int max8998_freeze(struct device *dev)
316 struct i2c_client *i2c = to_i2c_client(dev);
317 int i;
319 for (i = 0; i < ARRAY_SIZE(max8998_dump); i++)
320 max8998_read_reg(i2c, max8998_dump[i].addr,
321 &max8998_dump[i].val);
323 return 0;
326 /* Restore registers after hibernation */
327 static int max8998_restore(struct device *dev)
329 struct i2c_client *i2c = to_i2c_client(dev);
330 int i;
332 for (i = 0; i < ARRAY_SIZE(max8998_dump); i++)
333 max8998_write_reg(i2c, max8998_dump[i].addr,
334 max8998_dump[i].val);
336 return 0;
339 static const struct dev_pm_ops max8998_pm = {
340 .suspend = max8998_suspend,
341 .resume = max8998_resume,
342 .freeze = max8998_freeze,
343 .restore = max8998_restore,
346 static struct i2c_driver max8998_i2c_driver = {
347 .driver = {
348 .name = "max8998",
349 .pm = &max8998_pm,
350 .suppress_bind_attrs = true,
351 .of_match_table = of_match_ptr(max8998_dt_match),
353 .probe = max8998_i2c_probe,
354 .id_table = max8998_i2c_id,
357 static int __init max8998_i2c_init(void)
359 return i2c_add_driver(&max8998_i2c_driver);
361 /* init early so consumer devices can complete system boot */
362 subsys_initcall(max8998_i2c_init);