Loading...
1/*
2 * wm831x-i2c.c -- I2C access for Wolfson WM831x PMICs
3 *
4 * Copyright 2009,2010 Wolfson Microelectronics PLC.
5 *
6 * Author: Mark Brown <broonie@opensource.wolfsonmicro.com>
7 *
8 * This program is free software; you can redistribute it and/or modify it
9 * under the terms of the GNU General Public License as published by the
10 * Free Software Foundation; either version 2 of the License, or (at your
11 * option) any later version.
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
22#include <linux/mfd/wm831x/core.h>
23#include <linux/mfd/wm831x/pdata.h>
24
25static int wm831x_i2c_read_device(struct wm831x *wm831x, unsigned short reg,
26 int bytes, void *dest)
27{
28 struct i2c_client *i2c = wm831x->control_data;
29 int ret;
30 u16 r = cpu_to_be16(reg);
31
32 ret = i2c_master_send(i2c, (unsigned char *)&r, 2);
33 if (ret < 0)
34 return ret;
35 if (ret != 2)
36 return -EIO;
37
38 ret = i2c_master_recv(i2c, dest, bytes);
39 if (ret < 0)
40 return ret;
41 if (ret != bytes)
42 return -EIO;
43 return 0;
44}
45
46/* Currently we allocate the write buffer on the stack; this is OK for
47 * small writes - if we need to do large writes this will need to be
48 * revised.
49 */
50static int wm831x_i2c_write_device(struct wm831x *wm831x, unsigned short reg,
51 int bytes, void *src)
52{
53 struct i2c_client *i2c = wm831x->control_data;
54 struct i2c_msg xfer[2];
55 int ret;
56
57 reg = cpu_to_be16(reg);
58
59 xfer[0].addr = i2c->addr;
60 xfer[0].flags = 0;
61 xfer[0].len = 2;
62 xfer[0].buf = (char *)®
63
64 xfer[1].addr = i2c->addr;
65 xfer[1].flags = I2C_M_NOSTART;
66 xfer[1].len = bytes;
67 xfer[1].buf = (char *)src;
68
69 ret = i2c_transfer(i2c->adapter, xfer, 2);
70 if (ret < 0)
71 return ret;
72 if (ret != 2)
73 return -EIO;
74
75 return 0;
76}
77
78static int wm831x_i2c_probe(struct i2c_client *i2c,
79 const struct i2c_device_id *id)
80{
81 struct wm831x *wm831x;
82
83 wm831x = kzalloc(sizeof(struct wm831x), GFP_KERNEL);
84 if (wm831x == NULL)
85 return -ENOMEM;
86
87 i2c_set_clientdata(i2c, wm831x);
88 wm831x->dev = &i2c->dev;
89 wm831x->control_data = i2c;
90 wm831x->read_dev = wm831x_i2c_read_device;
91 wm831x->write_dev = wm831x_i2c_write_device;
92
93 return wm831x_device_init(wm831x, id->driver_data, i2c->irq);
94}
95
96static int wm831x_i2c_remove(struct i2c_client *i2c)
97{
98 struct wm831x *wm831x = i2c_get_clientdata(i2c);
99
100 wm831x_device_exit(wm831x);
101
102 return 0;
103}
104
105static int wm831x_i2c_suspend(struct device *dev)
106{
107 struct wm831x *wm831x = dev_get_drvdata(dev);
108
109 return wm831x_device_suspend(wm831x);
110}
111
112static const struct i2c_device_id wm831x_i2c_id[] = {
113 { "wm8310", WM8310 },
114 { "wm8311", WM8311 },
115 { "wm8312", WM8312 },
116 { "wm8320", WM8320 },
117 { "wm8321", WM8321 },
118 { "wm8325", WM8325 },
119 { "wm8326", WM8326 },
120 { }
121};
122MODULE_DEVICE_TABLE(i2c, wm831x_i2c_id);
123
124static const struct dev_pm_ops wm831x_pm_ops = {
125 .suspend = wm831x_i2c_suspend,
126};
127
128static struct i2c_driver wm831x_i2c_driver = {
129 .driver = {
130 .name = "wm831x",
131 .owner = THIS_MODULE,
132 .pm = &wm831x_pm_ops,
133 },
134 .probe = wm831x_i2c_probe,
135 .remove = wm831x_i2c_remove,
136 .id_table = wm831x_i2c_id,
137};
138
139static int __init wm831x_i2c_init(void)
140{
141 int ret;
142
143 ret = i2c_add_driver(&wm831x_i2c_driver);
144 if (ret != 0)
145 pr_err("Failed to register wm831x I2C driver: %d\n", ret);
146
147 return ret;
148}
149subsys_initcall(wm831x_i2c_init);
150
151static void __exit wm831x_i2c_exit(void)
152{
153 i2c_del_driver(&wm831x_i2c_driver);
154}
155module_exit(wm831x_i2c_exit);
1/*
2 * wm831x-i2c.c -- I2C access for Wolfson WM831x PMICs
3 *
4 * Copyright 2009,2010 Wolfson Microelectronics PLC.
5 *
6 * Author: Mark Brown <broonie@opensource.wolfsonmicro.com>
7 *
8 * This program is free software; you can redistribute it and/or modify it
9 * under the terms of the GNU General Public License as published by the
10 * Free Software Foundation; either version 2 of the License, or (at your
11 * option) any later version.
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);