]> git.proxmox.com Git - mirror_ubuntu-zesty-kernel.git/blame - drivers/mfd/sec-core.c
mfd: sec-core: Fix I2C dummy device resource leak on probe failure
[mirror_ubuntu-zesty-kernel.git] / drivers / mfd / sec-core.c
CommitLineData
0f5f7078 1/*
63063bfb 2 * sec-core.c
0f5f7078 3 *
63063bfb 4 * Copyright (c) 2012 Samsung Electronics Co., Ltd
0f5f7078
SK
5 * http://www.samsung.com
6 *
7 * This program is free software; you can redistribute it and/or modify it
8 * under the terms of the GNU General Public License as published by the
9 * Free Software Foundation; either version 2 of the License, or (at your
10 * option) any later version.
11 *
12 */
13
14#include <linux/module.h>
15#include <linux/moduleparam.h>
16#include <linux/init.h>
17#include <linux/err.h>
18#include <linux/slab.h>
19#include <linux/i2c.h>
1c5a099b 20#include <linux/of.h>
26aec009 21#include <linux/of_irq.h>
0f5f7078
SK
22#include <linux/interrupt.h>
23#include <linux/pm_runtime.h>
24#include <linux/mutex.h>
25#include <linux/mfd/core.h>
54227bcf
SK
26#include <linux/mfd/samsung/core.h>
27#include <linux/mfd/samsung/irq.h>
28#include <linux/mfd/samsung/rtc.h>
ce24991e 29#include <linux/mfd/samsung/s2mpa01.h>
25f311fa 30#include <linux/mfd/samsung/s2mps11.h>
dc691966 31#include <linux/mfd/samsung/s2mps14.h>
25f311fa
MB
32#include <linux/mfd/samsung/s5m8763.h>
33#include <linux/mfd/samsung/s5m8767.h>
0f5f7078
SK
34#include <linux/regmap.h>
35
5ac98553 36static const struct mfd_cell s5m8751_devs[] = {
88a1cfd6
SK
37 {
38 .name = "s5m8751-pmic",
39 }, {
40 .name = "s5m-charger",
41 }, {
42 .name = "s5m8751-codec",
43 },
44};
45
5ac98553 46static const struct mfd_cell s5m8763_devs[] = {
88a1cfd6
SK
47 {
48 .name = "s5m8763-pmic",
49 }, {
50 .name = "s5m-rtc",
51 }, {
52 .name = "s5m-charger",
53 },
54};
55
5ac98553 56static const struct mfd_cell s5m8767_devs[] = {
0f5f7078
SK
57 {
58 .name = "s5m8767-pmic",
59 }, {
60 .name = "s5m-rtc",
39fed00f
TB
61 }, {
62 .name = "s5m8767-clk",
53c31b34 63 .of_compatible = "samsung,s5m8767-clk",
39fed00f 64 }
0f5f7078
SK
65};
66
5ac98553 67static const struct mfd_cell s2mps11_devs[] = {
9b6d1343
SK
68 {
69 .name = "s2mps11-pmic",
3134bcae
YSB
70 }, {
71 .name = "s2mps11-clk",
53c31b34 72 .of_compatible = "samsung,s2mps11-clk",
3134bcae 73 }
9b6d1343
SK
74};
75
dc691966
KK
76static const struct mfd_cell s2mps14_devs[] = {
77 {
78 .name = "s2mps14-pmic",
79 }, {
80 .name = "s2mps14-rtc",
81 }, {
82 .name = "s2mps14-clk",
53c31b34 83 .of_compatible = "samsung,s2mps14-clk",
dc691966
KK
84 }
85};
86
ce24991e
SK
87static const struct mfd_cell s2mpa01_devs[] = {
88 {
89 .name = "s2mpa01-pmic",
90 },
91};
92
26aec009
ADK
93#ifdef CONFIG_OF
94static struct of_device_id sec_dt_match[] = {
95 { .compatible = "samsung,s5m8767-pmic",
96 .data = (void *)S5M8767X,
ce24991e
SK
97 }, {
98 .compatible = "samsung,s2mps11-pmic",
aa32acad 99 .data = (void *)S2MPS11X,
ce24991e
SK
100 }, {
101 .compatible = "samsung,s2mps14-pmic",
dc691966 102 .data = (void *)S2MPS14X,
ce24991e
SK
103 }, {
104 .compatible = "samsung,s2mpa01-pmic",
105 .data = (void *)S2MPA01,
106 }, {
107 /* Sentinel */
dc691966 108 },
26aec009
ADK
109};
110#endif
111
ce24991e
SK
112static bool s2mpa01_volatile(struct device *dev, unsigned int reg)
113{
114 switch (reg) {
115 case S2MPA01_REG_INT1M:
116 case S2MPA01_REG_INT2M:
117 case S2MPA01_REG_INT3M:
118 return false;
119 default:
120 return true;
121 }
122}
123
6b845ba9
MB
124static bool s2mps11_volatile(struct device *dev, unsigned int reg)
125{
126 switch (reg) {
127 case S2MPS11_REG_INT1M:
128 case S2MPS11_REG_INT2M:
129 case S2MPS11_REG_INT3M:
130 return false;
131 default:
132 return true;
133 }
134}
135
136static bool s5m8763_volatile(struct device *dev, unsigned int reg)
137{
138 switch (reg) {
139 case S5M8763_REG_IRQM1:
140 case S5M8763_REG_IRQM2:
141 case S5M8763_REG_IRQM3:
142 case S5M8763_REG_IRQM4:
143 return false;
144 default:
145 return true;
146 }
147}
148
a30fffb0 149static const struct regmap_config sec_regmap_config = {
0f5f7078
SK
150 .reg_bits = 8,
151 .val_bits = 8,
152};
153
ce24991e
SK
154static const struct regmap_config s2mpa01_regmap_config = {
155 .reg_bits = 8,
156 .val_bits = 8,
157
158 .max_register = S2MPA01_REG_LDO_OVCB4,
159 .volatile_reg = s2mpa01_volatile,
160 .cache_type = REGCACHE_FLAT,
161};
162
a30fffb0 163static const struct regmap_config s2mps11_regmap_config = {
25f311fa
MB
164 .reg_bits = 8,
165 .val_bits = 8,
166
167 .max_register = S2MPS11_REG_L38CTRL,
6b845ba9
MB
168 .volatile_reg = s2mps11_volatile,
169 .cache_type = REGCACHE_FLAT,
25f311fa
MB
170};
171
dc691966
KK
172static const struct regmap_config s2mps14_regmap_config = {
173 .reg_bits = 8,
174 .val_bits = 8,
175
176 .max_register = S2MPS14_REG_LDODSCH3,
177 .volatile_reg = s2mps11_volatile,
178 .cache_type = REGCACHE_FLAT,
179};
180
a30fffb0 181static const struct regmap_config s5m8763_regmap_config = {
25f311fa
MB
182 .reg_bits = 8,
183 .val_bits = 8,
184
185 .max_register = S5M8763_REG_LBCNFG2,
6b845ba9
MB
186 .volatile_reg = s5m8763_volatile,
187 .cache_type = REGCACHE_FLAT,
25f311fa
MB
188};
189
a30fffb0 190static const struct regmap_config s5m8767_regmap_config = {
25f311fa
MB
191 .reg_bits = 8,
192 .val_bits = 8,
193
194 .max_register = S5M8767_REG_LDO28CTRL,
6b845ba9
MB
195 .volatile_reg = s2mps11_volatile,
196 .cache_type = REGCACHE_FLAT,
25f311fa 197};
26aec009 198
dc691966 199static const struct regmap_config s5m_rtc_regmap_config = {
3e1e4a5f
KK
200 .reg_bits = 8,
201 .val_bits = 8,
b07e2b70
KK
202
203 .max_register = SEC_RTC_REG_MAX,
3e1e4a5f
KK
204};
205
dc691966
KK
206static const struct regmap_config s2mps14_rtc_regmap_config = {
207 .reg_bits = 8,
208 .val_bits = 8,
209
210 .max_register = S2MPS_RTC_REG_MAX,
211};
212
26aec009
ADK
213#ifdef CONFIG_OF
214/*
215 * Only the common platform data elements for s5m8767 are parsed here from the
216 * device tree. Other sub-modules of s5m8767 such as pmic, rtc , charger and
217 * others have to parse their own platform data elements from device tree.
218 *
219 * The s5m8767 platform data structure is instantiated here and the drivers for
220 * the sub-modules need not instantiate another instance while parsing their
221 * platform data.
222 */
223static struct sec_platform_data *sec_pmic_i2c_parse_dt_pdata(
224 struct device *dev)
225{
226 struct sec_platform_data *pd;
227
228 pd = devm_kzalloc(dev, sizeof(*pd), GFP_KERNEL);
229 if (!pd) {
230 dev_err(dev, "could not allocate memory for pdata\n");
231 return ERR_PTR(-ENOMEM);
232 }
233
234 /*
235 * ToDo: the 'wakeup' member in the platform data is more of a linux
236 * specfic information. Hence, there is no binding for that yet and
237 * not parsed here.
238 */
239
240 return pd;
241}
242#else
197bf856 243static struct sec_platform_data *sec_pmic_i2c_parse_dt_pdata(
26aec009
ADK
244 struct device *dev)
245{
005718c0 246 return NULL;
26aec009
ADK
247}
248#endif
249
8f695de5 250static inline unsigned long sec_i2c_get_driver_data(struct i2c_client *i2c,
26aec009
ADK
251 const struct i2c_device_id *id)
252{
253#ifdef CONFIG_OF
254 if (i2c->dev.of_node) {
255 const struct of_device_id *match;
256 match = of_match_node(sec_dt_match, i2c->dev.of_node);
8f695de5 257 return (unsigned long)match->data;
26aec009
ADK
258 }
259#endif
8f695de5 260 return id->driver_data;
26aec009
ADK
261}
262
63063bfb 263static int sec_pmic_probe(struct i2c_client *i2c,
0f5f7078
SK
264 const struct i2c_device_id *id)
265{
334a41ce 266 struct sec_platform_data *pdata = dev_get_platdata(&i2c->dev);
3e5a45f7 267 const struct regmap_config *regmap, *regmap_rtc;
63063bfb 268 struct sec_pmic_dev *sec_pmic;
61a2af30 269 int ret;
0f5f7078 270
63063bfb 271 sec_pmic = devm_kzalloc(&i2c->dev, sizeof(struct sec_pmic_dev),
621210e2 272 GFP_KERNEL);
63063bfb 273 if (sec_pmic == NULL)
0f5f7078
SK
274 return -ENOMEM;
275
63063bfb
SK
276 i2c_set_clientdata(i2c, sec_pmic);
277 sec_pmic->dev = &i2c->dev;
278 sec_pmic->i2c = i2c;
279 sec_pmic->irq = i2c->irq;
26aec009
ADK
280 sec_pmic->type = sec_i2c_get_driver_data(i2c, id);
281
282 if (sec_pmic->dev->of_node) {
283 pdata = sec_pmic_i2c_parse_dt_pdata(sec_pmic->dev);
284 if (IS_ERR(pdata)) {
285 ret = PTR_ERR(pdata);
286 return ret;
287 }
288 pdata->device_type = sec_pmic->type;
289 }
0f5f7078 290 if (pdata) {
63063bfb
SK
291 sec_pmic->device_type = pdata->device_type;
292 sec_pmic->ono = pdata->ono;
293 sec_pmic->irq_base = pdata->irq_base;
294 sec_pmic->wakeup = pdata->wakeup;
26aec009 295 sec_pmic->pdata = pdata;
0f5f7078
SK
296 }
297
25f311fa 298 switch (sec_pmic->device_type) {
ce24991e
SK
299 case S2MPA01:
300 regmap = &s2mpa01_regmap_config;
301 break;
25f311fa
MB
302 case S2MPS11X:
303 regmap = &s2mps11_regmap_config;
3e5a45f7
KK
304 /*
305 * The rtc-s5m driver does not support S2MPS11 and there
306 * is no mfd_cell for S2MPS11 RTC device.
307 * However we must pass something to devm_regmap_init_i2c()
308 * so use S5M-like regmap config even though it wouldn't work.
309 */
dc691966
KK
310 regmap_rtc = &s5m_rtc_regmap_config;
311 break;
312 case S2MPS14X:
313 regmap = &s2mps14_regmap_config;
314 regmap_rtc = &s2mps14_rtc_regmap_config;
25f311fa
MB
315 break;
316 case S5M8763X:
317 regmap = &s5m8763_regmap_config;
dc691966 318 regmap_rtc = &s5m_rtc_regmap_config;
25f311fa
MB
319 break;
320 case S5M8767X:
321 regmap = &s5m8767_regmap_config;
dc691966 322 regmap_rtc = &s5m_rtc_regmap_config;
25f311fa
MB
323 break;
324 default:
325 regmap = &sec_regmap_config;
dc691966 326 regmap_rtc = &s5m_rtc_regmap_config;
25f311fa
MB
327 break;
328 }
329
3e1e4a5f
KK
330 sec_pmic->regmap_pmic = devm_regmap_init_i2c(i2c, regmap);
331 if (IS_ERR(sec_pmic->regmap_pmic)) {
332 ret = PTR_ERR(sec_pmic->regmap_pmic);
0f5f7078 333 dev_err(&i2c->dev, "Failed to allocate register map: %d\n",
61a2af30 334 ret);
1092e1c7 335 return ret;
0f5f7078
SK
336 }
337
63063bfb 338 sec_pmic->rtc = i2c_new_dummy(i2c->adapter, RTC_I2C_ADDR);
65aba1e0
KK
339 if (!sec_pmic->rtc) {
340 dev_err(&i2c->dev, "Failed to allocate I2C for RTC\n");
341 return -ENODEV;
342 }
63063bfb 343 i2c_set_clientdata(sec_pmic->rtc, sec_pmic);
0f5f7078 344
3e5a45f7 345 sec_pmic->regmap_rtc = devm_regmap_init_i2c(sec_pmic->rtc, regmap_rtc);
3e1e4a5f
KK
346 if (IS_ERR(sec_pmic->regmap_rtc)) {
347 ret = PTR_ERR(sec_pmic->regmap_rtc);
348 dev_err(&i2c->dev, "Failed to allocate RTC register map: %d\n",
349 ret);
8c66eece 350 goto err_regmap_rtc;
3e1e4a5f
KK
351 }
352
c3ebb30a 353 if (pdata && pdata->cfg_pmic_irq)
0f5f7078
SK
354 pdata->cfg_pmic_irq();
355
63063bfb 356 sec_irq_init(sec_pmic);
0f5f7078 357
63063bfb 358 pm_runtime_set_active(sec_pmic->dev);
0f5f7078 359
63063bfb 360 switch (sec_pmic->device_type) {
88a1cfd6 361 case S5M8751X:
63063bfb 362 ret = mfd_add_devices(sec_pmic->dev, -1, s5m8751_devs,
0848c94f 363 ARRAY_SIZE(s5m8751_devs), NULL, 0, NULL);
88a1cfd6
SK
364 break;
365 case S5M8763X:
63063bfb 366 ret = mfd_add_devices(sec_pmic->dev, -1, s5m8763_devs,
0848c94f 367 ARRAY_SIZE(s5m8763_devs), NULL, 0, NULL);
88a1cfd6
SK
368 break;
369 case S5M8767X:
63063bfb 370 ret = mfd_add_devices(sec_pmic->dev, -1, s5m8767_devs,
0848c94f 371 ARRAY_SIZE(s5m8767_devs), NULL, 0, NULL);
88a1cfd6 372 break;
ce24991e
SK
373 case S2MPA01:
374 ret = mfd_add_devices(sec_pmic->dev, -1, s2mpa01_devs,
375 ARRAY_SIZE(s2mpa01_devs), NULL, 0, NULL);
376 break;
9b6d1343
SK
377 case S2MPS11X:
378 ret = mfd_add_devices(sec_pmic->dev, -1, s2mps11_devs,
0848c94f 379 ARRAY_SIZE(s2mps11_devs), NULL, 0, NULL);
9b6d1343 380 break;
dc691966
KK
381 case S2MPS14X:
382 ret = mfd_add_devices(sec_pmic->dev, -1, s2mps14_devs,
383 ARRAY_SIZE(s2mps14_devs), NULL, 0, NULL);
384 break;
88a1cfd6
SK
385 default:
386 /* If this happens the probe function is problem */
387 BUG();
388 }
0f5f7078 389
15447a46 390 if (ret)
8c66eece 391 goto err_mfd;
0f5f7078 392
f6d6daaf
KK
393 device_init_wakeup(sec_pmic->dev, sec_pmic->wakeup);
394
0f5f7078
SK
395 return ret;
396
8c66eece 397err_mfd:
63063bfb 398 sec_irq_exit(sec_pmic);
8c66eece 399err_regmap_rtc:
63063bfb 400 i2c_unregister_device(sec_pmic->rtc);
0f5f7078
SK
401 return ret;
402}
403
63063bfb 404static int sec_pmic_remove(struct i2c_client *i2c)
0f5f7078 405{
63063bfb 406 struct sec_pmic_dev *sec_pmic = i2c_get_clientdata(i2c);
0f5f7078 407
63063bfb
SK
408 mfd_remove_devices(sec_pmic->dev);
409 sec_irq_exit(sec_pmic);
410 i2c_unregister_device(sec_pmic->rtc);
0f5f7078
SK
411 return 0;
412}
413
8321bbf8 414#ifdef CONFIG_PM_SLEEP
f6d6daaf
KK
415static int sec_pmic_suspend(struct device *dev)
416{
417 struct i2c_client *i2c = container_of(dev, struct i2c_client, dev);
418 struct sec_pmic_dev *sec_pmic = i2c_get_clientdata(i2c);
419
420 if (device_may_wakeup(dev)) {
421 enable_irq_wake(sec_pmic->irq);
422 /*
423 * PMIC IRQ must be disabled during suspend for RTC alarm
424 * to work properly.
425 * When device is woken up from suspend by RTC Alarm, an
426 * interrupt occurs before resuming I2C bus controller.
427 * The interrupt is handled by regmap_irq_thread which tries
428 * to read RTC registers. This read fails (I2C is still
429 * suspended) and RTC Alarm interrupt is disabled.
430 */
431 disable_irq(sec_pmic->irq);
432 }
433
434 return 0;
435}
436
437static int sec_pmic_resume(struct device *dev)
438{
439 struct i2c_client *i2c = container_of(dev, struct i2c_client, dev);
440 struct sec_pmic_dev *sec_pmic = i2c_get_clientdata(i2c);
441
442 if (device_may_wakeup(dev)) {
443 disable_irq_wake(sec_pmic->irq);
444 enable_irq(sec_pmic->irq);
445 }
446
447 return 0;
448}
8321bbf8 449#endif /* CONFIG_PM_SLEEP */
f6d6daaf
KK
450
451static SIMPLE_DEV_PM_OPS(sec_pmic_pm_ops, sec_pmic_suspend, sec_pmic_resume);
452
63063bfb
SK
453static const struct i2c_device_id sec_pmic_id[] = {
454 { "sec_pmic", 0 },
0f5f7078
SK
455 { }
456};
63063bfb 457MODULE_DEVICE_TABLE(i2c, sec_pmic_id);
0f5f7078 458
63063bfb 459static struct i2c_driver sec_pmic_driver = {
0f5f7078 460 .driver = {
63063bfb 461 .name = "sec_pmic",
0f5f7078 462 .owner = THIS_MODULE,
f6d6daaf 463 .pm = &sec_pmic_pm_ops,
26aec009 464 .of_match_table = of_match_ptr(sec_dt_match),
0f5f7078 465 },
63063bfb
SK
466 .probe = sec_pmic_probe,
467 .remove = sec_pmic_remove,
468 .id_table = sec_pmic_id,
0f5f7078
SK
469};
470
63063bfb 471static int __init sec_pmic_init(void)
0f5f7078 472{
63063bfb 473 return i2c_add_driver(&sec_pmic_driver);
0f5f7078
SK
474}
475
63063bfb 476subsys_initcall(sec_pmic_init);
0f5f7078 477
63063bfb 478static void __exit sec_pmic_exit(void)
0f5f7078 479{
63063bfb 480 i2c_del_driver(&sec_pmic_driver);
0f5f7078 481}
63063bfb 482module_exit(sec_pmic_exit);
0f5f7078
SK
483
484MODULE_AUTHOR("Sangbeom Kim <sbkim73@samsung.com>");
485MODULE_DESCRIPTION("Core support for the S5M MFD");
486MODULE_LICENSE("GPL");