1
2
3
4
5
6
7
8
9#include <linux/kernel.h>
10#include <linux/module.h>
11#include <linux/init.h>
12#include <linux/err.h>
13#include <linux/slab.h>
14#include <linux/i2c.h>
15#include <linux/regmap.h>
16#include <linux/mfd/core.h>
17#include <linux/mfd/sky81452.h>
18
19static const struct regmap_config sky81452_config = {
20 .reg_bits = 8,
21 .val_bits = 8,
22};
23
24static int sky81452_probe(struct i2c_client *client,
25 const struct i2c_device_id *id)
26{
27 struct device *dev = &client->dev;
28 const struct sky81452_platform_data *pdata = dev_get_platdata(dev);
29 struct mfd_cell cells[2];
30 struct regmap *regmap;
31 int ret;
32
33 if (!pdata) {
34 pdata = devm_kzalloc(dev, sizeof(*pdata), GFP_KERNEL);
35 if (!pdata)
36 return -ENOMEM;
37 }
38
39 regmap = devm_regmap_init_i2c(client, &sky81452_config);
40 if (IS_ERR(regmap)) {
41 dev_err(dev, "failed to initialize.err=%ld\n", PTR_ERR(regmap));
42 return PTR_ERR(regmap);
43 }
44
45 i2c_set_clientdata(client, regmap);
46
47 memset(cells, 0, sizeof(cells));
48 cells[0].name = "sky81452-backlight";
49 cells[0].of_compatible = "skyworks,sky81452-backlight";
50 cells[1].name = "sky81452-regulator";
51 cells[1].platform_data = pdata->regulator_init_data;
52 cells[1].pdata_size = sizeof(*pdata->regulator_init_data);
53
54 ret = devm_mfd_add_devices(dev, -1, cells, ARRAY_SIZE(cells),
55 NULL, 0, NULL);
56 if (ret)
57 dev_err(dev, "failed to add child devices. err=%d\n", ret);
58
59 return ret;
60}
61
62static const struct i2c_device_id sky81452_ids[] = {
63 { "sky81452" },
64 { }
65};
66MODULE_DEVICE_TABLE(i2c, sky81452_ids);
67
68#ifdef CONFIG_OF
69static const struct of_device_id sky81452_of_match[] = {
70 { .compatible = "skyworks,sky81452", },
71 { }
72};
73MODULE_DEVICE_TABLE(of, sky81452_of_match);
74#endif
75
76static struct i2c_driver sky81452_driver = {
77 .driver = {
78 .name = "sky81452",
79 .of_match_table = of_match_ptr(sky81452_of_match),
80 },
81 .probe = sky81452_probe,
82 .id_table = sky81452_ids,
83};
84
85module_i2c_driver(sky81452_driver);
86
87MODULE_DESCRIPTION("Skyworks SKY81452 MFD driver");
88MODULE_AUTHOR("Gyungoh Yoo <jack.yoo@skyworksinc.com>");
89MODULE_LICENSE("GPL v2");
90