mfd: max8997: Fix possible NULL pointer dereference on i2c_new_dummy error
[pandora-kernel.git] / drivers / mfd / max8997.c
1 /*
2  * max8997.c - mfd core driver for the Maxim 8966 and 8997
3  *
4  * Copyright (C) 2011 Samsung Electronics
5  * MyungJoo Ham <myungjoo.ham@smasung.com>
6  *
7  * This program is free software; you can redistribute it and/or modify
8  * it under the terms of the GNU General Public License as published by
9  * the Free Software Foundation; either version 2 of the License, or
10  * (at your option) any later version.
11  *
12  * This program is distributed in the hope that it will be useful,
13  * but WITHOUT ANY WARRANTY; without even the implied warranty of
14  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
15  * GNU General Public License for more details.
16  *
17  * You should have received a copy of the GNU General Public License
18  * along with this program; if not, write to the Free Software
19  * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
20  *
21  * This driver is based on max8998.c
22  */
23
24 #include <linux/slab.h>
25 #include <linux/i2c.h>
26 #include <linux/interrupt.h>
27 #include <linux/pm_runtime.h>
28 #include <linux/module.h>
29 #include <linux/mutex.h>
30 #include <linux/mfd/core.h>
31 #include <linux/mfd/max8997.h>
32 #include <linux/mfd/max8997-private.h>
33
34 #define I2C_ADDR_PMIC   (0xCC >> 1)
35 #define I2C_ADDR_MUIC   (0x4A >> 1)
36 #define I2C_ADDR_BATTERY        (0x6C >> 1)
37 #define I2C_ADDR_RTC    (0x0C >> 1)
38 #define I2C_ADDR_HAPTIC (0x90 >> 1)
39
40 static struct mfd_cell max8997_devs[] = {
41         { .name = "max8997-pmic", },
42         { .name = "max8997-rtc", },
43         { .name = "max8997-battery", },
44         { .name = "max8997-haptic", },
45         { .name = "max8997-muic", },
46         { .name = "max8997-flash", },
47 };
48
49 int max8997_read_reg(struct i2c_client *i2c, u8 reg, u8 *dest)
50 {
51         struct max8997_dev *max8997 = i2c_get_clientdata(i2c);
52         int ret;
53
54         mutex_lock(&max8997->iolock);
55         ret = i2c_smbus_read_byte_data(i2c, reg);
56         mutex_unlock(&max8997->iolock);
57         if (ret < 0)
58                 return ret;
59
60         ret &= 0xff;
61         *dest = ret;
62         return 0;
63 }
64 EXPORT_SYMBOL_GPL(max8997_read_reg);
65
66 int max8997_bulk_read(struct i2c_client *i2c, u8 reg, int count, u8 *buf)
67 {
68         struct max8997_dev *max8997 = i2c_get_clientdata(i2c);
69         int ret;
70
71         mutex_lock(&max8997->iolock);
72         ret = i2c_smbus_read_i2c_block_data(i2c, reg, count, buf);
73         mutex_unlock(&max8997->iolock);
74         if (ret < 0)
75                 return ret;
76
77         return 0;
78 }
79 EXPORT_SYMBOL_GPL(max8997_bulk_read);
80
81 int max8997_write_reg(struct i2c_client *i2c, u8 reg, u8 value)
82 {
83         struct max8997_dev *max8997 = i2c_get_clientdata(i2c);
84         int ret;
85
86         mutex_lock(&max8997->iolock);
87         ret = i2c_smbus_write_byte_data(i2c, reg, value);
88         mutex_unlock(&max8997->iolock);
89         return ret;
90 }
91 EXPORT_SYMBOL_GPL(max8997_write_reg);
92
93 int max8997_bulk_write(struct i2c_client *i2c, u8 reg, int count, u8 *buf)
94 {
95         struct max8997_dev *max8997 = i2c_get_clientdata(i2c);
96         int ret;
97
98         mutex_lock(&max8997->iolock);
99         ret = i2c_smbus_write_i2c_block_data(i2c, reg, count, buf);
100         mutex_unlock(&max8997->iolock);
101         if (ret < 0)
102                 return ret;
103
104         return 0;
105 }
106 EXPORT_SYMBOL_GPL(max8997_bulk_write);
107
108 int max8997_update_reg(struct i2c_client *i2c, u8 reg, u8 val, u8 mask)
109 {
110         struct max8997_dev *max8997 = i2c_get_clientdata(i2c);
111         int ret;
112
113         mutex_lock(&max8997->iolock);
114         ret = i2c_smbus_read_byte_data(i2c, reg);
115         if (ret >= 0) {
116                 u8 old_val = ret & 0xff;
117                 u8 new_val = (val & mask) | (old_val & (~mask));
118                 ret = i2c_smbus_write_byte_data(i2c, reg, new_val);
119         }
120         mutex_unlock(&max8997->iolock);
121         return ret;
122 }
123 EXPORT_SYMBOL_GPL(max8997_update_reg);
124
125 static int max8997_i2c_probe(struct i2c_client *i2c,
126                             const struct i2c_device_id *id)
127 {
128         struct max8997_dev *max8997;
129         struct max8997_platform_data *pdata = i2c->dev.platform_data;
130         int ret = 0;
131
132         max8997 = kzalloc(sizeof(struct max8997_dev), GFP_KERNEL);
133         if (max8997 == NULL)
134                 return -ENOMEM;
135
136         i2c_set_clientdata(i2c, max8997);
137         max8997->dev = &i2c->dev;
138         max8997->i2c = i2c;
139         max8997->type = id->driver_data;
140         max8997->irq = i2c->irq;
141
142         if (!pdata)
143                 goto err;
144
145         max8997->irq_base = pdata->irq_base;
146         max8997->ono = pdata->ono;
147
148         mutex_init(&max8997->iolock);
149
150         max8997->rtc = i2c_new_dummy(i2c->adapter, I2C_ADDR_RTC);
151         if (!max8997->rtc) {
152                 dev_err(max8997->dev, "Failed to allocate I2C device for RTC\n");
153                 return -ENODEV;
154         }
155         i2c_set_clientdata(max8997->rtc, max8997);
156
157         max8997->haptic = i2c_new_dummy(i2c->adapter, I2C_ADDR_HAPTIC);
158         if (!max8997->haptic) {
159                 dev_err(max8997->dev, "Failed to allocate I2C device for Haptic\n");
160                 ret = -ENODEV;
161                 goto err_i2c_haptic;
162         }
163         i2c_set_clientdata(max8997->haptic, max8997);
164
165         max8997->muic = i2c_new_dummy(i2c->adapter, I2C_ADDR_MUIC);
166         if (!max8997->muic) {
167                 dev_err(max8997->dev, "Failed to allocate I2C device for MUIC\n");
168                 ret = -ENODEV;
169                 goto err_i2c_muic;
170         }
171         i2c_set_clientdata(max8997->muic, max8997);
172
173         pm_runtime_set_active(max8997->dev);
174
175         max8997_irq_init(max8997);
176
177         mfd_add_devices(max8997->dev, -1, max8997_devs,
178                         ARRAY_SIZE(max8997_devs),
179                         NULL, 0);
180
181         /*
182          * TODO: enable others (flash, muic, rtc, battery, ...) and
183          * check the return value
184          */
185
186         if (ret < 0)
187                 goto err_mfd;
188
189         /* MAX8997 has a power button input. */
190         device_init_wakeup(max8997->dev, pdata->wakeup);
191
192         return ret;
193
194 err_mfd:
195         mfd_remove_devices(max8997->dev);
196         i2c_unregister_device(max8997->muic);
197 err_i2c_muic:
198         i2c_unregister_device(max8997->haptic);
199 err_i2c_haptic:
200         i2c_unregister_device(max8997->rtc);
201 err:
202         kfree(max8997);
203         return ret;
204 }
205
206 static int max8997_i2c_remove(struct i2c_client *i2c)
207 {
208         struct max8997_dev *max8997 = i2c_get_clientdata(i2c);
209
210         mfd_remove_devices(max8997->dev);
211         i2c_unregister_device(max8997->muic);
212         i2c_unregister_device(max8997->haptic);
213         i2c_unregister_device(max8997->rtc);
214         kfree(max8997);
215
216         return 0;
217 }
218
219 static const struct i2c_device_id max8997_i2c_id[] = {
220         { "max8997", TYPE_MAX8997 },
221         { "max8966", TYPE_MAX8966 },
222         { }
223 };
224 MODULE_DEVICE_TABLE(i2c, max8998_i2c_id);
225
226 u8 max8997_dumpaddr_pmic[] = {
227         MAX8997_REG_INT1MSK,
228         MAX8997_REG_INT2MSK,
229         MAX8997_REG_INT3MSK,
230         MAX8997_REG_INT4MSK,
231         MAX8997_REG_MAINCON1,
232         MAX8997_REG_MAINCON2,
233         MAX8997_REG_BUCKRAMP,
234         MAX8997_REG_BUCK1CTRL,
235         MAX8997_REG_BUCK1DVS1,
236         MAX8997_REG_BUCK1DVS2,
237         MAX8997_REG_BUCK1DVS3,
238         MAX8997_REG_BUCK1DVS4,
239         MAX8997_REG_BUCK1DVS5,
240         MAX8997_REG_BUCK1DVS6,
241         MAX8997_REG_BUCK1DVS7,
242         MAX8997_REG_BUCK1DVS8,
243         MAX8997_REG_BUCK2CTRL,
244         MAX8997_REG_BUCK2DVS1,
245         MAX8997_REG_BUCK2DVS2,
246         MAX8997_REG_BUCK2DVS3,
247         MAX8997_REG_BUCK2DVS4,
248         MAX8997_REG_BUCK2DVS5,
249         MAX8997_REG_BUCK2DVS6,
250         MAX8997_REG_BUCK2DVS7,
251         MAX8997_REG_BUCK2DVS8,
252         MAX8997_REG_BUCK3CTRL,
253         MAX8997_REG_BUCK3DVS,
254         MAX8997_REG_BUCK4CTRL,
255         MAX8997_REG_BUCK4DVS,
256         MAX8997_REG_BUCK5CTRL,
257         MAX8997_REG_BUCK5DVS1,
258         MAX8997_REG_BUCK5DVS2,
259         MAX8997_REG_BUCK5DVS3,
260         MAX8997_REG_BUCK5DVS4,
261         MAX8997_REG_BUCK5DVS5,
262         MAX8997_REG_BUCK5DVS6,
263         MAX8997_REG_BUCK5DVS7,
264         MAX8997_REG_BUCK5DVS8,
265         MAX8997_REG_BUCK6CTRL,
266         MAX8997_REG_BUCK6BPSKIPCTRL,
267         MAX8997_REG_BUCK7CTRL,
268         MAX8997_REG_BUCK7DVS,
269         MAX8997_REG_LDO1CTRL,
270         MAX8997_REG_LDO2CTRL,
271         MAX8997_REG_LDO3CTRL,
272         MAX8997_REG_LDO4CTRL,
273         MAX8997_REG_LDO5CTRL,
274         MAX8997_REG_LDO6CTRL,
275         MAX8997_REG_LDO7CTRL,
276         MAX8997_REG_LDO8CTRL,
277         MAX8997_REG_LDO9CTRL,
278         MAX8997_REG_LDO10CTRL,
279         MAX8997_REG_LDO11CTRL,
280         MAX8997_REG_LDO12CTRL,
281         MAX8997_REG_LDO13CTRL,
282         MAX8997_REG_LDO14CTRL,
283         MAX8997_REG_LDO15CTRL,
284         MAX8997_REG_LDO16CTRL,
285         MAX8997_REG_LDO17CTRL,
286         MAX8997_REG_LDO18CTRL,
287         MAX8997_REG_LDO21CTRL,
288         MAX8997_REG_MBCCTRL1,
289         MAX8997_REG_MBCCTRL2,
290         MAX8997_REG_MBCCTRL3,
291         MAX8997_REG_MBCCTRL4,
292         MAX8997_REG_MBCCTRL5,
293         MAX8997_REG_MBCCTRL6,
294         MAX8997_REG_OTPCGHCVS,
295         MAX8997_REG_SAFEOUTCTRL,
296         MAX8997_REG_LBCNFG1,
297         MAX8997_REG_LBCNFG2,
298         MAX8997_REG_BBCCTRL,
299
300         MAX8997_REG_FLASH1_CUR,
301         MAX8997_REG_FLASH2_CUR,
302         MAX8997_REG_MOVIE_CUR,
303         MAX8997_REG_GSMB_CUR,
304         MAX8997_REG_BOOST_CNTL,
305         MAX8997_REG_LEN_CNTL,
306         MAX8997_REG_FLASH_CNTL,
307         MAX8997_REG_WDT_CNTL,
308         MAX8997_REG_MAXFLASH1,
309         MAX8997_REG_MAXFLASH2,
310         MAX8997_REG_FLASHSTATUSMASK,
311
312         MAX8997_REG_GPIOCNTL1,
313         MAX8997_REG_GPIOCNTL2,
314         MAX8997_REG_GPIOCNTL3,
315         MAX8997_REG_GPIOCNTL4,
316         MAX8997_REG_GPIOCNTL5,
317         MAX8997_REG_GPIOCNTL6,
318         MAX8997_REG_GPIOCNTL7,
319         MAX8997_REG_GPIOCNTL8,
320         MAX8997_REG_GPIOCNTL9,
321         MAX8997_REG_GPIOCNTL10,
322         MAX8997_REG_GPIOCNTL11,
323         MAX8997_REG_GPIOCNTL12,
324
325         MAX8997_REG_LDO1CONFIG,
326         MAX8997_REG_LDO2CONFIG,
327         MAX8997_REG_LDO3CONFIG,
328         MAX8997_REG_LDO4CONFIG,
329         MAX8997_REG_LDO5CONFIG,
330         MAX8997_REG_LDO6CONFIG,
331         MAX8997_REG_LDO7CONFIG,
332         MAX8997_REG_LDO8CONFIG,
333         MAX8997_REG_LDO9CONFIG,
334         MAX8997_REG_LDO10CONFIG,
335         MAX8997_REG_LDO11CONFIG,
336         MAX8997_REG_LDO12CONFIG,
337         MAX8997_REG_LDO13CONFIG,
338         MAX8997_REG_LDO14CONFIG,
339         MAX8997_REG_LDO15CONFIG,
340         MAX8997_REG_LDO16CONFIG,
341         MAX8997_REG_LDO17CONFIG,
342         MAX8997_REG_LDO18CONFIG,
343         MAX8997_REG_LDO21CONFIG,
344
345         MAX8997_REG_DVSOKTIMER1,
346         MAX8997_REG_DVSOKTIMER2,
347         MAX8997_REG_DVSOKTIMER4,
348         MAX8997_REG_DVSOKTIMER5,
349 };
350
351 u8 max8997_dumpaddr_muic[] = {
352         MAX8997_MUIC_REG_INTMASK1,
353         MAX8997_MUIC_REG_INTMASK2,
354         MAX8997_MUIC_REG_INTMASK3,
355         MAX8997_MUIC_REG_CDETCTRL,
356         MAX8997_MUIC_REG_CONTROL1,
357         MAX8997_MUIC_REG_CONTROL2,
358         MAX8997_MUIC_REG_CONTROL3,
359 };
360
361 u8 max8997_dumpaddr_haptic[] = {
362         MAX8997_HAPTIC_REG_CONF1,
363         MAX8997_HAPTIC_REG_CONF2,
364         MAX8997_HAPTIC_REG_DRVCONF,
365         MAX8997_HAPTIC_REG_CYCLECONF1,
366         MAX8997_HAPTIC_REG_CYCLECONF2,
367         MAX8997_HAPTIC_REG_SIGCONF1,
368         MAX8997_HAPTIC_REG_SIGCONF2,
369         MAX8997_HAPTIC_REG_SIGCONF3,
370         MAX8997_HAPTIC_REG_SIGCONF4,
371         MAX8997_HAPTIC_REG_SIGDC1,
372         MAX8997_HAPTIC_REG_SIGDC2,
373         MAX8997_HAPTIC_REG_SIGPWMDC1,
374         MAX8997_HAPTIC_REG_SIGPWMDC2,
375         MAX8997_HAPTIC_REG_SIGPWMDC3,
376         MAX8997_HAPTIC_REG_SIGPWMDC4,
377 };
378
379 static int max8997_freeze(struct device *dev)
380 {
381         struct i2c_client *i2c = container_of(dev, struct i2c_client, dev);
382         struct max8997_dev *max8997 = i2c_get_clientdata(i2c);
383         int i;
384
385         for (i = 0; i < ARRAY_SIZE(max8997_dumpaddr_pmic); i++)
386                 max8997_read_reg(i2c, max8997_dumpaddr_pmic[i],
387                                 &max8997->reg_dump[i]);
388
389         for (i = 0; i < ARRAY_SIZE(max8997_dumpaddr_muic); i++)
390                 max8997_read_reg(i2c, max8997_dumpaddr_muic[i],
391                                 &max8997->reg_dump[i + MAX8997_REG_PMIC_END]);
392
393         for (i = 0; i < ARRAY_SIZE(max8997_dumpaddr_haptic); i++)
394                 max8997_read_reg(i2c, max8997_dumpaddr_haptic[i],
395                                 &max8997->reg_dump[i + MAX8997_REG_PMIC_END +
396                                 MAX8997_MUIC_REG_END]);
397
398         return 0;
399 }
400
401 static int max8997_restore(struct device *dev)
402 {
403         struct i2c_client *i2c = container_of(dev, struct i2c_client, dev);
404         struct max8997_dev *max8997 = i2c_get_clientdata(i2c);
405         int i;
406
407         for (i = 0; i < ARRAY_SIZE(max8997_dumpaddr_pmic); i++)
408                 max8997_write_reg(i2c, max8997_dumpaddr_pmic[i],
409                                 max8997->reg_dump[i]);
410
411         for (i = 0; i < ARRAY_SIZE(max8997_dumpaddr_muic); i++)
412                 max8997_write_reg(i2c, max8997_dumpaddr_muic[i],
413                                 max8997->reg_dump[i + MAX8997_REG_PMIC_END]);
414
415         for (i = 0; i < ARRAY_SIZE(max8997_dumpaddr_haptic); i++)
416                 max8997_write_reg(i2c, max8997_dumpaddr_haptic[i],
417                                 max8997->reg_dump[i + MAX8997_REG_PMIC_END +
418                                 MAX8997_MUIC_REG_END]);
419
420         return 0;
421 }
422
423 static int max8997_suspend(struct device *dev)
424 {
425         struct i2c_client *i2c = container_of(dev, struct i2c_client, dev);
426         struct max8997_dev *max8997 = i2c_get_clientdata(i2c);
427
428         if (device_may_wakeup(dev))
429                 irq_set_irq_wake(max8997->irq, 1);
430         return 0;
431 }
432
433 static int max8997_resume(struct device *dev)
434 {
435         struct i2c_client *i2c = container_of(dev, struct i2c_client, dev);
436         struct max8997_dev *max8997 = i2c_get_clientdata(i2c);
437
438         if (device_may_wakeup(dev))
439                 irq_set_irq_wake(max8997->irq, 0);
440         return max8997_irq_resume(max8997);
441 }
442
443 const struct dev_pm_ops max8997_pm = {
444         .suspend = max8997_suspend,
445         .resume = max8997_resume,
446         .freeze = max8997_freeze,
447         .restore = max8997_restore,
448 };
449
450 static struct i2c_driver max8997_i2c_driver = {
451         .driver = {
452                    .name = "max8997",
453                    .owner = THIS_MODULE,
454                    .pm = &max8997_pm,
455         },
456         .probe = max8997_i2c_probe,
457         .remove = max8997_i2c_remove,
458         .id_table = max8997_i2c_id,
459 };
460
461 static int __init max8997_i2c_init(void)
462 {
463         return i2c_add_driver(&max8997_i2c_driver);
464 }
465 /* init early so consumer devices can complete system boot */
466 subsys_initcall(max8997_i2c_init);
467
468 static void __exit max8997_i2c_exit(void)
469 {
470         i2c_del_driver(&max8997_i2c_driver);
471 }
472 module_exit(max8997_i2c_exit);
473
474 MODULE_DESCRIPTION("MAXIM 8997 multi-function core driver");
475 MODULE_AUTHOR("MyungJoo Ham <myungjoo.ham@samsung.com>");
476 MODULE_LICENSE("GPL");