1
2
3
4
5
6
7
8
9
10
11
12
13
14
15#include <linux/kernel.h>
16#include <linux/module.h>
17#include <linux/i2c.h>
18#include <linux/delay.h>
19#include <linux/mfd/core.h>
20#include <linux/slab.h>
21#include <linux/err.h>
22#include <linux/regmap.h>
23
24#include <linux/mfd/wm831x/core.h>
25#include <linux/mfd/wm831x/pdata.h>
26
27static int wm831x_i2c_probe(struct i2c_client *i2c,
28 const struct i2c_device_id *id)
29{
30 struct wm831x *wm831x;
31 int ret;
32
33 wm831x = devm_kzalloc(&i2c->dev, sizeof(struct wm831x), GFP_KERNEL);
34 if (wm831x == NULL)
35 return -ENOMEM;
36
37 i2c_set_clientdata(i2c, wm831x);
38 wm831x->dev = &i2c->dev;
39
40 wm831x->regmap = devm_regmap_init_i2c(i2c, &wm831x_regmap_config);
41 if (IS_ERR(wm831x->regmap)) {
42 ret = PTR_ERR(wm831x->regmap);
43 dev_err(wm831x->dev, "Failed to allocate register map: %d\n",
44 ret);
45 return ret;
46 }
47
48 return wm831x_device_init(wm831x, id->driver_data, i2c->irq);
49}
50
51static int wm831x_i2c_remove(struct i2c_client *i2c)
52{
53 struct wm831x *wm831x = i2c_get_clientdata(i2c);
54
55 wm831x_device_exit(wm831x);
56
57 return 0;
58}
59
60static int wm831x_i2c_suspend(struct device *dev)
61{
62 struct wm831x *wm831x = dev_get_drvdata(dev);
63
64 return wm831x_device_suspend(wm831x);
65}
66
67static int wm831x_i2c_poweroff(struct device *dev)
68{
69 struct wm831x *wm831x = dev_get_drvdata(dev);
70
71 wm831x_device_shutdown(wm831x);
72
73 return 0;
74}
75
76static const struct i2c_device_id wm831x_i2c_id[] = {
77 { "wm8310", WM8310 },
78 { "wm8311", WM8311 },
79 { "wm8312", WM8312 },
80 { "wm8320", WM8320 },
81 { "wm8321", WM8321 },
82 { "wm8325", WM8325 },
83 { "wm8326", WM8326 },
84 { }
85};
86MODULE_DEVICE_TABLE(i2c, wm831x_i2c_id);
87
88static const struct dev_pm_ops wm831x_pm_ops = {
89 .suspend = wm831x_i2c_suspend,
90 .poweroff = wm831x_i2c_poweroff,
91};
92
93static struct i2c_driver wm831x_i2c_driver = {
94 .driver = {
95 .name = "wm831x",
96 .pm = &wm831x_pm_ops,
97 },
98 .probe = wm831x_i2c_probe,
99 .remove = wm831x_i2c_remove,
100 .id_table = wm831x_i2c_id,
101};
102
103static int __init wm831x_i2c_init(void)
104{
105 int ret;
106
107 ret = i2c_add_driver(&wm831x_i2c_driver);
108 if (ret != 0)
109 pr_err("Failed to register wm831x I2C driver: %d\n", ret);
110
111 return ret;
112}
113subsys_initcall(wm831x_i2c_init);
114
115static void __exit wm831x_i2c_exit(void)
116{
117 i2c_del_driver(&wm831x_i2c_driver);
118}
119module_exit(wm831x_i2c_exit);
120