1
2
3
4
5
6
7
8
9
10
11
12#include <linux/device.h>
13#include <linux/err.h>
14#include <linux/i2c.h>
15#include <linux/module.h>
16#include <linux/of.h>
17#include <linux/of_device.h>
18#include <linux/regmap.h>
19
20#include <linux/mfd/madera/core.h>
21
22#include "madera.h"
23
24static int madera_i2c_probe(struct i2c_client *i2c,
25 const struct i2c_device_id *id)
26{
27 struct madera *madera;
28 const struct regmap_config *regmap_16bit_config = NULL;
29 const struct regmap_config *regmap_32bit_config = NULL;
30 const void *of_data;
31 unsigned long type;
32 const char *name;
33 int ret;
34
35 of_data = of_device_get_match_data(&i2c->dev);
36 if (of_data)
37 type = (unsigned long)of_data;
38 else
39 type = id->driver_data;
40
41 switch (type) {
42 case CS47L35:
43 if (IS_ENABLED(CONFIG_MFD_CS47L35)) {
44 regmap_16bit_config = &cs47l35_16bit_i2c_regmap;
45 regmap_32bit_config = &cs47l35_32bit_i2c_regmap;
46 }
47 break;
48 case CS47L85:
49 case WM1840:
50 if (IS_ENABLED(CONFIG_MFD_CS47L85)) {
51 regmap_16bit_config = &cs47l85_16bit_i2c_regmap;
52 regmap_32bit_config = &cs47l85_32bit_i2c_regmap;
53 }
54 break;
55 case CS47L90:
56 case CS47L91:
57 if (IS_ENABLED(CONFIG_MFD_CS47L90)) {
58 regmap_16bit_config = &cs47l90_16bit_i2c_regmap;
59 regmap_32bit_config = &cs47l90_32bit_i2c_regmap;
60 }
61 break;
62 default:
63 dev_err(&i2c->dev,
64 "Unknown Madera I2C device type %ld\n", type);
65 return -EINVAL;
66 }
67
68 name = madera_name_from_type(type);
69
70 if (!regmap_16bit_config) {
71
72 dev_err(&i2c->dev,
73 "Kernel does not include support for %s\n", name);
74 return -EINVAL;
75 }
76
77 madera = devm_kzalloc(&i2c->dev, sizeof(*madera), GFP_KERNEL);
78 if (!madera)
79 return -ENOMEM;
80
81
82 madera->regmap = devm_regmap_init_i2c(i2c, regmap_16bit_config);
83 if (IS_ERR(madera->regmap)) {
84 ret = PTR_ERR(madera->regmap);
85 dev_err(&i2c->dev,
86 "Failed to allocate 16-bit register map: %d\n", ret);
87 return ret;
88 }
89
90 madera->regmap_32bit = devm_regmap_init_i2c(i2c, regmap_32bit_config);
91 if (IS_ERR(madera->regmap_32bit)) {
92 ret = PTR_ERR(madera->regmap_32bit);
93 dev_err(&i2c->dev,
94 "Failed to allocate 32-bit register map: %d\n", ret);
95 return ret;
96 }
97
98 madera->type = type;
99 madera->type_name = name;
100 madera->dev = &i2c->dev;
101 madera->irq = i2c->irq;
102
103 return madera_dev_init(madera);
104}
105
106static int madera_i2c_remove(struct i2c_client *i2c)
107{
108 struct madera *madera = dev_get_drvdata(&i2c->dev);
109
110 madera_dev_exit(madera);
111
112 return 0;
113}
114
115static const struct i2c_device_id madera_i2c_id[] = {
116 { "cs47l35", CS47L35 },
117 { "cs47l85", CS47L85 },
118 { "cs47l90", CS47L90 },
119 { "cs47l91", CS47L91 },
120 { "wm1840", WM1840 },
121 { }
122};
123MODULE_DEVICE_TABLE(i2c, madera_i2c_id);
124
125static struct i2c_driver madera_i2c_driver = {
126 .driver = {
127 .name = "madera",
128 .pm = &madera_pm_ops,
129 .of_match_table = of_match_ptr(madera_of_match),
130 },
131 .probe = madera_i2c_probe,
132 .remove = madera_i2c_remove,
133 .id_table = madera_i2c_id,
134};
135
136module_i2c_driver(madera_i2c_driver);
137
138MODULE_DESCRIPTION("Madera I2C bus interface");
139MODULE_AUTHOR("Richard Fitzgerald <rf@opensource.cirrus.com>");
140MODULE_LICENSE("GPL v2");
141