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