1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21#include <linux/kernel.h>
22#include <linux/slab.h>
23#include <linux/i2c.h>
24#include <linux/i2c/pcf857x.h>
25
26#include <asm/gpio.h>
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41struct pcf857x {
42 struct gpio_chip chip;
43 struct i2c_client *client;
44 unsigned out;
45};
46
47
48
49
50
51static int pcf857x_input8(struct gpio_chip *chip, unsigned offset)
52{
53 struct pcf857x *gpio = container_of(chip, struct pcf857x, chip);
54
55 gpio->out |= (1 << offset);
56 return i2c_smbus_write_byte(gpio->client, gpio->out);
57}
58
59static int pcf857x_get8(struct gpio_chip *chip, unsigned offset)
60{
61 struct pcf857x *gpio = container_of(chip, struct pcf857x, chip);
62 s32 value;
63
64 value = i2c_smbus_read_byte(gpio->client);
65 return (value < 0) ? 0 : (value & (1 << offset));
66}
67
68static int pcf857x_output8(struct gpio_chip *chip, unsigned offset, int value)
69{
70 struct pcf857x *gpio = container_of(chip, struct pcf857x, chip);
71 unsigned bit = 1 << offset;
72
73 if (value)
74 gpio->out |= bit;
75 else
76 gpio->out &= ~bit;
77 return i2c_smbus_write_byte(gpio->client, gpio->out);
78}
79
80static void pcf857x_set8(struct gpio_chip *chip, unsigned offset, int value)
81{
82 pcf857x_output8(chip, offset, value);
83}
84
85
86
87
88
89static int i2c_write_le16(struct i2c_client *client, u16 word)
90{
91 u8 buf[2] = { word & 0xff, word >> 8, };
92 int status;
93
94 status = i2c_master_send(client, buf, 2);
95 return (status < 0) ? status : 0;
96}
97
98static int i2c_read_le16(struct i2c_client *client)
99{
100 u8 buf[2];
101 int status;
102
103 status = i2c_master_recv(client, buf, 2);
104 if (status < 0)
105 return status;
106 return (buf[1] << 8) | buf[0];
107}
108
109static int pcf857x_input16(struct gpio_chip *chip, unsigned offset)
110{
111 struct pcf857x *gpio = container_of(chip, struct pcf857x, chip);
112
113 gpio->out |= (1 << offset);
114 return i2c_write_le16(gpio->client, gpio->out);
115}
116
117static int pcf857x_get16(struct gpio_chip *chip, unsigned offset)
118{
119 struct pcf857x *gpio = container_of(chip, struct pcf857x, chip);
120 int value;
121
122 value = i2c_read_le16(gpio->client);
123 return (value < 0) ? 0 : (value & (1 << offset));
124}
125
126static int pcf857x_output16(struct gpio_chip *chip, unsigned offset, int value)
127{
128 struct pcf857x *gpio = container_of(chip, struct pcf857x, chip);
129 unsigned bit = 1 << offset;
130
131 if (value)
132 gpio->out |= bit;
133 else
134 gpio->out &= ~bit;
135 return i2c_write_le16(gpio->client, gpio->out);
136}
137
138static void pcf857x_set16(struct gpio_chip *chip, unsigned offset, int value)
139{
140 pcf857x_output16(chip, offset, value);
141}
142
143
144
145static int pcf857x_probe(struct i2c_client *client)
146{
147 struct pcf857x_platform_data *pdata;
148 struct pcf857x *gpio;
149 int status;
150
151 pdata = client->dev.platform_data;
152 if (!pdata)
153 return -ENODEV;
154
155
156 gpio = kzalloc(sizeof *gpio, GFP_KERNEL);
157 if (!gpio)
158 return -ENOMEM;
159
160 gpio->chip.base = pdata->gpio_base;
161 gpio->chip.can_sleep = 1;
162
163
164
165
166
167
168
169
170
171
172
173
174 if (strcmp(client->name, "pcf8574") == 0
175 || strcmp(client->name, "pca8574") == 0
176 || strcmp(client->name, "pca9670") == 0
177 || strcmp(client->name, "pca9672") == 0
178 || strcmp(client->name, "pca9674") == 0
179 ) {
180 gpio->chip.ngpio = 8;
181 gpio->chip.direction_input = pcf857x_input8;
182 gpio->chip.get = pcf857x_get8;
183 gpio->chip.direction_output = pcf857x_output8;
184 gpio->chip.set = pcf857x_set8;
185
186 if (!i2c_check_functionality(client->adapter,
187 I2C_FUNC_SMBUS_BYTE))
188 status = -EIO;
189
190
191 else
192 status = i2c_smbus_read_byte(client);
193
194
195
196
197
198
199
200 } else if (strcmp(client->name, "pcf8575") == 0
201 || strcmp(client->name, "pca8575") == 0
202 || strcmp(client->name, "pca9671") == 0
203 || strcmp(client->name, "pca9673") == 0
204 || strcmp(client->name, "pca9675") == 0
205 ) {
206 gpio->chip.ngpio = 16;
207 gpio->chip.direction_input = pcf857x_input16;
208 gpio->chip.get = pcf857x_get16;
209 gpio->chip.direction_output = pcf857x_output16;
210 gpio->chip.set = pcf857x_set16;
211
212 if (!i2c_check_functionality(client->adapter, I2C_FUNC_I2C))
213 status = -EIO;
214
215
216 else
217 status = i2c_read_le16(client);
218
219 } else
220 status = -ENODEV;
221
222 if (status < 0)
223 goto fail;
224
225 gpio->chip.label = client->name;
226
227 gpio->client = client;
228 i2c_set_clientdata(client, gpio);
229
230
231
232
233
234
235
236
237
238
239
240
241
242
243
244
245 gpio->out = ~pdata->n_latch;
246
247 status = gpiochip_add(&gpio->chip);
248 if (status < 0)
249 goto fail;
250
251
252
253
254
255
256
257 dev_info(&client->dev, "gpios %d..%d on a %s%s\n",
258 gpio->chip.base,
259 gpio->chip.base + gpio->chip.ngpio - 1,
260 client->name,
261 client->irq ? " (irq ignored)" : "");
262
263
264
265
266 if (pdata->setup) {
267 status = pdata->setup(client,
268 gpio->chip.base, gpio->chip.ngpio,
269 pdata->context);
270 if (status < 0)
271 dev_warn(&client->dev, "setup --> %d\n", status);
272 }
273
274 return 0;
275
276fail:
277 dev_dbg(&client->dev, "probe error %d for '%s'\n",
278 status, client->name);
279 kfree(gpio);
280 return status;
281}
282
283static int pcf857x_remove(struct i2c_client *client)
284{
285 struct pcf857x_platform_data *pdata = client->dev.platform_data;
286 struct pcf857x *gpio = i2c_get_clientdata(client);
287 int status = 0;
288
289 if (pdata->teardown) {
290 status = pdata->teardown(client,
291 gpio->chip.base, gpio->chip.ngpio,
292 pdata->context);
293 if (status < 0) {
294 dev_err(&client->dev, "%s --> %d\n",
295 "teardown", status);
296 return status;
297 }
298 }
299
300 status = gpiochip_remove(&gpio->chip);
301 if (status == 0)
302 kfree(gpio);
303 else
304 dev_err(&client->dev, "%s --> %d\n", "remove", status);
305 return status;
306}
307
308static struct i2c_driver pcf857x_driver = {
309 .driver = {
310 .name = "pcf857x",
311 .owner = THIS_MODULE,
312 },
313 .probe = pcf857x_probe,
314 .remove = pcf857x_remove,
315};
316
317static int __init pcf857x_init(void)
318{
319 return i2c_add_driver(&pcf857x_driver);
320}
321module_init(pcf857x_init);
322
323static void __exit pcf857x_exit(void)
324{
325 i2c_del_driver(&pcf857x_driver);
326}
327module_exit(pcf857x_exit);
328
329MODULE_LICENSE("GPL");
330MODULE_AUTHOR("David Brownell");
331