1
2
3
4
5
6
7
8
9
10
11
12
13
14
15#include <linux/kernel.h>
16#include <linux/device.h>
17#include <linux/sysfs.h>
18#include <linux/module.h>
19#include <linux/types.h>
20#include <linux/interrupt.h>
21#include <linux/workqueue.h>
22#include <linux/platform_device.h>
23#include <linux/i2c.h>
24#include <linux/pm.h>
25#include <linux/slab.h>
26#include <linux/regmap.h>
27#include <linux/err.h>
28
29#include <linux/mfd/pcf50633/core.h>
30
31
32int pcf50633_read_block(struct pcf50633 *pcf, u8 reg,
33 int nr_regs, u8 *data)
34{
35 int ret;
36
37 ret = regmap_raw_read(pcf->regmap, reg, data, nr_regs);
38 if (ret != 0)
39 return ret;
40
41 return nr_regs;
42}
43EXPORT_SYMBOL_GPL(pcf50633_read_block);
44
45
46int pcf50633_write_block(struct pcf50633 *pcf , u8 reg,
47 int nr_regs, u8 *data)
48{
49 int ret;
50
51 ret = regmap_raw_write(pcf->regmap, reg, data, nr_regs);
52 if (ret != 0)
53 return ret;
54
55 return nr_regs;
56}
57EXPORT_SYMBOL_GPL(pcf50633_write_block);
58
59u8 pcf50633_reg_read(struct pcf50633 *pcf, u8 reg)
60{
61 unsigned int val;
62 int ret;
63
64 ret = regmap_read(pcf->regmap, reg, &val);
65 if (ret < 0)
66 return -1;
67
68 return val;
69}
70EXPORT_SYMBOL_GPL(pcf50633_reg_read);
71
72int pcf50633_reg_write(struct pcf50633 *pcf, u8 reg, u8 val)
73{
74 return regmap_write(pcf->regmap, reg, val);
75}
76EXPORT_SYMBOL_GPL(pcf50633_reg_write);
77
78int pcf50633_reg_set_bit_mask(struct pcf50633 *pcf, u8 reg, u8 mask, u8 val)
79{
80 return regmap_update_bits(pcf->regmap, reg, mask, val);
81}
82EXPORT_SYMBOL_GPL(pcf50633_reg_set_bit_mask);
83
84int pcf50633_reg_clear_bits(struct pcf50633 *pcf, u8 reg, u8 val)
85{
86 return regmap_update_bits(pcf->regmap, reg, val, 0);
87}
88EXPORT_SYMBOL_GPL(pcf50633_reg_clear_bits);
89
90
91static ssize_t show_dump_regs(struct device *dev, struct device_attribute *attr,
92 char *buf)
93{
94 struct pcf50633 *pcf = dev_get_drvdata(dev);
95 u8 dump[16];
96 int n, n1, idx = 0;
97 char *buf1 = buf;
98 static u8 address_no_read[] = {
99 PCF50633_REG_INT1,
100 PCF50633_REG_INT2,
101 PCF50633_REG_INT3,
102 PCF50633_REG_INT4,
103 PCF50633_REG_INT5,
104 0
105 };
106
107 for (n = 0; n < 256; n += sizeof(dump)) {
108 for (n1 = 0; n1 < sizeof(dump); n1++)
109 if (n == address_no_read[idx]) {
110 idx++;
111 dump[n1] = 0x00;
112 } else
113 dump[n1] = pcf50633_reg_read(pcf, n + n1);
114
115 hex_dump_to_buffer(dump, sizeof(dump), 16, 1, buf1, 128, 0);
116 buf1 += strlen(buf1);
117 *buf1++ = '\n';
118 *buf1 = '\0';
119 }
120
121 return buf1 - buf;
122}
123static DEVICE_ATTR(dump_regs, 0400, show_dump_regs, NULL);
124
125static ssize_t show_resume_reason(struct device *dev,
126 struct device_attribute *attr, char *buf)
127{
128 struct pcf50633 *pcf = dev_get_drvdata(dev);
129 int n;
130
131 n = sprintf(buf, "%02x%02x%02x%02x%02x\n",
132 pcf->resume_reason[0],
133 pcf->resume_reason[1],
134 pcf->resume_reason[2],
135 pcf->resume_reason[3],
136 pcf->resume_reason[4]);
137
138 return n;
139}
140static DEVICE_ATTR(resume_reason, 0400, show_resume_reason, NULL);
141
142static struct attribute *pcf_sysfs_entries[] = {
143 &dev_attr_dump_regs.attr,
144 &dev_attr_resume_reason.attr,
145 NULL,
146};
147
148static struct attribute_group pcf_attr_group = {
149 .name = NULL,
150 .attrs = pcf_sysfs_entries,
151};
152
153static void
154pcf50633_client_dev_register(struct pcf50633 *pcf, const char *name,
155 struct platform_device **pdev)
156{
157 int ret;
158
159 *pdev = platform_device_alloc(name, -1);
160 if (!*pdev) {
161 dev_err(pcf->dev, "Falied to allocate %s\n", name);
162 return;
163 }
164
165 (*pdev)->dev.parent = pcf->dev;
166
167 ret = platform_device_add(*pdev);
168 if (ret) {
169 dev_err(pcf->dev, "Failed to register %s: %d\n", name, ret);
170 platform_device_put(*pdev);
171 *pdev = NULL;
172 }
173}
174
175#ifdef CONFIG_PM_SLEEP
176static int pcf50633_suspend(struct device *dev)
177{
178 struct i2c_client *client = to_i2c_client(dev);
179 struct pcf50633 *pcf = i2c_get_clientdata(client);
180
181 return pcf50633_irq_suspend(pcf);
182}
183
184static int pcf50633_resume(struct device *dev)
185{
186 struct i2c_client *client = to_i2c_client(dev);
187 struct pcf50633 *pcf = i2c_get_clientdata(client);
188
189 return pcf50633_irq_resume(pcf);
190}
191#endif
192
193static SIMPLE_DEV_PM_OPS(pcf50633_pm, pcf50633_suspend, pcf50633_resume);
194
195static struct regmap_config pcf50633_regmap_config = {
196 .reg_bits = 8,
197 .val_bits = 8,
198};
199
200static int __devinit pcf50633_probe(struct i2c_client *client,
201 const struct i2c_device_id *ids)
202{
203 struct pcf50633 *pcf;
204 struct pcf50633_platform_data *pdata = client->dev.platform_data;
205 int i, ret;
206 int version, variant;
207
208 if (!client->irq) {
209 dev_err(&client->dev, "Missing IRQ\n");
210 return -ENOENT;
211 }
212
213 pcf = kzalloc(sizeof(*pcf), GFP_KERNEL);
214 if (!pcf)
215 return -ENOMEM;
216
217 pcf->pdata = pdata;
218
219 mutex_init(&pcf->lock);
220
221 pcf->regmap = regmap_init_i2c(client, &pcf50633_regmap_config);
222 if (IS_ERR(pcf->regmap)) {
223 ret = PTR_ERR(pcf->regmap);
224 dev_err(pcf->dev, "Failed to allocate register map: %d\n",
225 ret);
226 goto err_free;
227 }
228
229 i2c_set_clientdata(client, pcf);
230 pcf->dev = &client->dev;
231
232 version = pcf50633_reg_read(pcf, 0);
233 variant = pcf50633_reg_read(pcf, 1);
234 if (version < 0 || variant < 0) {
235 dev_err(pcf->dev, "Unable to probe pcf50633\n");
236 ret = -ENODEV;
237 goto err_regmap;
238 }
239
240 dev_info(pcf->dev, "Probed device version %d variant %d\n",
241 version, variant);
242
243 pcf50633_irq_init(pcf, client->irq);
244
245
246 pcf50633_client_dev_register(pcf, "pcf50633-input",
247 &pcf->input_pdev);
248 pcf50633_client_dev_register(pcf, "pcf50633-rtc",
249 &pcf->rtc_pdev);
250 pcf50633_client_dev_register(pcf, "pcf50633-mbc",
251 &pcf->mbc_pdev);
252 pcf50633_client_dev_register(pcf, "pcf50633-adc",
253 &pcf->adc_pdev);
254 pcf50633_client_dev_register(pcf, "pcf50633-backlight",
255 &pcf->bl_pdev);
256
257
258 for (i = 0; i < PCF50633_NUM_REGULATORS; i++) {
259 struct platform_device *pdev;
260
261 pdev = platform_device_alloc("pcf50633-regltr", i);
262 if (!pdev) {
263 dev_err(pcf->dev, "Cannot create regulator %d\n", i);
264 continue;
265 }
266
267 pdev->dev.parent = pcf->dev;
268 platform_device_add_data(pdev, &pdata->reg_init_data[i],
269 sizeof(pdata->reg_init_data[i]));
270 pcf->regulator_pdev[i] = pdev;
271
272 platform_device_add(pdev);
273 }
274
275 ret = sysfs_create_group(&client->dev.kobj, &pcf_attr_group);
276 if (ret)
277 dev_err(pcf->dev, "error creating sysfs entries\n");
278
279 if (pdata->probe_done)
280 pdata->probe_done(pcf);
281
282 return 0;
283
284err_regmap:
285 regmap_exit(pcf->regmap);
286err_free:
287 kfree(pcf);
288
289 return ret;
290}
291
292static int __devexit pcf50633_remove(struct i2c_client *client)
293{
294 struct pcf50633 *pcf = i2c_get_clientdata(client);
295 int i;
296
297 sysfs_remove_group(&client->dev.kobj, &pcf_attr_group);
298 pcf50633_irq_free(pcf);
299
300 platform_device_unregister(pcf->input_pdev);
301 platform_device_unregister(pcf->rtc_pdev);
302 platform_device_unregister(pcf->mbc_pdev);
303 platform_device_unregister(pcf->adc_pdev);
304 platform_device_unregister(pcf->bl_pdev);
305
306 for (i = 0; i < PCF50633_NUM_REGULATORS; i++)
307 platform_device_unregister(pcf->regulator_pdev[i]);
308
309 regmap_exit(pcf->regmap);
310 kfree(pcf);
311
312 return 0;
313}
314
315static const struct i2c_device_id pcf50633_id_table[] = {
316 {"pcf50633", 0x73},
317 {}
318};
319MODULE_DEVICE_TABLE(i2c, pcf50633_id_table);
320
321static struct i2c_driver pcf50633_driver = {
322 .driver = {
323 .name = "pcf50633",
324 .pm = &pcf50633_pm,
325 },
326 .id_table = pcf50633_id_table,
327 .probe = pcf50633_probe,
328 .remove = __devexit_p(pcf50633_remove),
329};
330
331static int __init pcf50633_init(void)
332{
333 return i2c_add_driver(&pcf50633_driver);
334}
335
336static void __exit pcf50633_exit(void)
337{
338 i2c_del_driver(&pcf50633_driver);
339}
340
341MODULE_DESCRIPTION("I2C chip driver for NXP PCF50633 PMU");
342MODULE_AUTHOR("Harald Welte <laforge@openmoko.org>");
343MODULE_LICENSE("GPL");
344
345subsys_initcall(pcf50633_init);
346module_exit(pcf50633_exit);
347
