1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21#include <linux/gpio.h>
22#include <linux/i2c.h>
23#include <linux/i2c/pcf857x.h>
24#include <linux/interrupt.h>
25#include <linux/irq.h>
26#include <linux/irqdomain.h>
27#include <linux/kernel.h>
28#include <linux/module.h>
29#include <linux/of.h>
30#include <linux/of_device.h>
31#include <linux/slab.h>
32#include <linux/spinlock.h>
33
34
35static const struct i2c_device_id pcf857x_id[] = {
36 { "pcf8574", 8 },
37 { "pcf8574a", 8 },
38 { "pca8574", 8 },
39 { "pca9670", 8 },
40 { "pca9672", 8 },
41 { "pca9674", 8 },
42 { "pcf8575", 16 },
43 { "pca8575", 16 },
44 { "pca9671", 16 },
45 { "pca9673", 16 },
46 { "pca9675", 16 },
47 { "max7328", 8 },
48 { "max7329", 8 },
49 { "tca9554", 8 },
50 { }
51};
52MODULE_DEVICE_TABLE(i2c, pcf857x_id);
53
54#ifdef CONFIG_OF
55static const struct of_device_id pcf857x_of_table[] = {
56 { .compatible = "nxp,pcf8574" },
57 { .compatible = "nxp,pcf8574a" },
58 { .compatible = "nxp,pca8574" },
59 { .compatible = "nxp,pca9670" },
60 { .compatible = "nxp,pca9672" },
61 { .compatible = "nxp,pca9674" },
62 { .compatible = "nxp,pcf8575" },
63 { .compatible = "nxp,pca8575" },
64 { .compatible = "nxp,pca9671" },
65 { .compatible = "nxp,pca9673" },
66 { .compatible = "nxp,pca9675" },
67 { .compatible = "maxim,max7328" },
68 { .compatible = "maxim,max7329" },
69 { .compatible = "ti,tca9554" },
70 { }
71};
72MODULE_DEVICE_TABLE(of, pcf857x_of_table);
73#endif
74
75
76
77
78
79
80
81
82
83
84
85
86
87struct pcf857x {
88 struct gpio_chip chip;
89 struct i2c_client *client;
90 struct mutex lock;
91 struct irq_domain *irq_domain;
92 spinlock_t slock;
93 unsigned out;
94 unsigned status;
95 unsigned irq_mapped;
96
97 int (*write)(struct i2c_client *client, unsigned data);
98 int (*read)(struct i2c_client *client);
99};
100
101
102
103
104
105static int i2c_write_le8(struct i2c_client *client, unsigned data)
106{
107 return i2c_smbus_write_byte(client, data);
108}
109
110static int i2c_read_le8(struct i2c_client *client)
111{
112 return (int)i2c_smbus_read_byte(client);
113}
114
115
116
117static int i2c_write_le16(struct i2c_client *client, unsigned 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
137
138
139static int pcf857x_input(struct gpio_chip *chip, unsigned offset)
140{
141 struct pcf857x *gpio = container_of(chip, struct pcf857x, chip);
142 int status;
143
144 mutex_lock(&gpio->lock);
145 gpio->out |= (1 << offset);
146 status = gpio->write(gpio->client, gpio->out);
147 mutex_unlock(&gpio->lock);
148
149 return status;
150}
151
152static int pcf857x_get(struct gpio_chip *chip, unsigned offset)
153{
154 struct pcf857x *gpio = container_of(chip, struct pcf857x, chip);
155 int value;
156
157 value = gpio->read(gpio->client);
158 return (value < 0) ? 0 : (value & (1 << offset));
159}
160
161static int pcf857x_output(struct gpio_chip *chip, unsigned offset, int value)
162{
163 struct pcf857x *gpio = container_of(chip, struct pcf857x, chip);
164 unsigned bit = 1 << offset;
165 int status;
166
167 mutex_lock(&gpio->lock);
168 if (value)
169 gpio->out |= bit;
170 else
171 gpio->out &= ~bit;
172 status = gpio->write(gpio->client, gpio->out);
173 mutex_unlock(&gpio->lock);
174
175 return status;
176}
177
178static void pcf857x_set(struct gpio_chip *chip, unsigned offset, int value)
179{
180 pcf857x_output(chip, offset, value);
181}
182
183
184
185static int pcf857x_to_irq(struct gpio_chip *chip, unsigned offset)
186{
187 struct pcf857x *gpio = container_of(chip, struct pcf857x, chip);
188 int ret;
189
190 ret = irq_create_mapping(gpio->irq_domain, offset);
191 if (ret > 0)
192 gpio->irq_mapped |= (1 << offset);
193
194 return ret;
195}
196
197static irqreturn_t pcf857x_irq(int irq, void *data)
198{
199 struct pcf857x *gpio = data;
200 unsigned long change, i, status, flags;
201
202 status = gpio->read(gpio->client);
203
204 spin_lock_irqsave(&gpio->slock, flags);
205
206
207
208
209
210
211 change = ((gpio->status ^ status) & gpio->irq_mapped);
212 for_each_set_bit(i, &change, gpio->chip.ngpio)
213 generic_handle_irq(irq_find_mapping(gpio->irq_domain, i));
214 gpio->status = status;
215
216 spin_unlock_irqrestore(&gpio->slock, flags);
217
218 return IRQ_HANDLED;
219}
220
221static int pcf857x_irq_domain_map(struct irq_domain *domain, unsigned int irq,
222 irq_hw_number_t hw)
223{
224 struct pcf857x *gpio = domain->host_data;
225
226 irq_set_chip_and_handler(irq,
227 &dummy_irq_chip,
228 handle_level_irq);
229#ifdef CONFIG_ARM
230 set_irq_flags(irq, IRQF_VALID);
231#else
232 irq_set_noprobe(irq);
233#endif
234 gpio->irq_mapped |= (1 << hw);
235
236 return 0;
237}
238
239static struct irq_domain_ops pcf857x_irq_domain_ops = {
240 .map = pcf857x_irq_domain_map,
241};
242
243static void pcf857x_irq_domain_cleanup(struct pcf857x *gpio)
244{
245 if (gpio->irq_domain)
246 irq_domain_remove(gpio->irq_domain);
247
248}
249
250static int pcf857x_irq_domain_init(struct pcf857x *gpio,
251 struct i2c_client *client)
252{
253 int status;
254
255 gpio->irq_domain = irq_domain_add_linear(client->dev.of_node,
256 gpio->chip.ngpio,
257 &pcf857x_irq_domain_ops,
258 gpio);
259 if (!gpio->irq_domain)
260 goto fail;
261
262
263 status = devm_request_threaded_irq(&client->dev, client->irq,
264 NULL, pcf857x_irq, IRQF_ONESHOT |
265 IRQF_TRIGGER_FALLING,
266 dev_name(&client->dev), gpio);
267
268 if (status)
269 goto fail;
270
271
272 gpio->chip.to_irq = pcf857x_to_irq;
273
274 return 0;
275
276fail:
277 pcf857x_irq_domain_cleanup(gpio);
278 return -EINVAL;
279}
280
281
282
283static int pcf857x_probe(struct i2c_client *client,
284 const struct i2c_device_id *id)
285{
286 struct pcf857x_platform_data *pdata = dev_get_platdata(&client->dev);
287 struct device_node *np = client->dev.of_node;
288 struct pcf857x *gpio;
289 unsigned int n_latch = 0;
290 int status;
291
292 if (IS_ENABLED(CONFIG_OF) && np)
293 of_property_read_u32(np, "lines-initial-states", &n_latch);
294 else if (pdata)
295 n_latch = pdata->n_latch;
296 else
297 dev_dbg(&client->dev, "no platform data\n");
298
299
300 gpio = devm_kzalloc(&client->dev, sizeof(*gpio), GFP_KERNEL);
301 if (!gpio)
302 return -ENOMEM;
303
304 mutex_init(&gpio->lock);
305 spin_lock_init(&gpio->slock);
306
307 gpio->chip.base = pdata ? pdata->gpio_base : -1;
308 gpio->chip.can_sleep = true;
309 gpio->chip.dev = &client->dev;
310 gpio->chip.owner = THIS_MODULE;
311 gpio->chip.get = pcf857x_get;
312 gpio->chip.set = pcf857x_set;
313 gpio->chip.direction_input = pcf857x_input;
314 gpio->chip.direction_output = pcf857x_output;
315 gpio->chip.ngpio = id->driver_data;
316
317
318 if (client->irq) {
319 status = pcf857x_irq_domain_init(gpio, client);
320 if (status < 0) {
321 dev_err(&client->dev, "irq_domain init failed\n");
322 goto fail;
323 }
324 }
325
326
327
328
329
330
331
332
333
334
335
336
337 if (gpio->chip.ngpio == 8) {
338 gpio->write = i2c_write_le8;
339 gpio->read = i2c_read_le8;
340
341 if (!i2c_check_functionality(client->adapter,
342 I2C_FUNC_SMBUS_BYTE))
343 status = -EIO;
344
345
346 else
347 status = i2c_smbus_read_byte(client);
348
349
350
351
352
353
354
355 } else if (gpio->chip.ngpio == 16) {
356 gpio->write = i2c_write_le16;
357 gpio->read = i2c_read_le16;
358
359 if (!i2c_check_functionality(client->adapter, I2C_FUNC_I2C))
360 status = -EIO;
361
362
363 else
364 status = i2c_read_le16(client);
365
366 } else {
367 dev_dbg(&client->dev, "unsupported number of gpios\n");
368 status = -EINVAL;
369 }
370
371 if (status < 0)
372 goto fail;
373
374 gpio->chip.label = client->name;
375
376 gpio->client = client;
377 i2c_set_clientdata(client, gpio);
378
379
380
381
382
383
384
385
386
387
388
389
390
391
392
393
394 gpio->out = ~n_latch;
395 gpio->status = gpio->out;
396
397 status = gpiochip_add(&gpio->chip);
398 if (status < 0)
399 goto fail;
400
401
402
403
404 if (pdata && pdata->setup) {
405 status = pdata->setup(client,
406 gpio->chip.base, gpio->chip.ngpio,
407 pdata->context);
408 if (status < 0)
409 dev_warn(&client->dev, "setup --> %d\n", status);
410 }
411
412 dev_info(&client->dev, "probed\n");
413
414 return 0;
415
416fail:
417 dev_dbg(&client->dev, "probe error %d for '%s'\n",
418 status, client->name);
419
420 if (client->irq)
421 pcf857x_irq_domain_cleanup(gpio);
422
423 return status;
424}
425
426static int pcf857x_remove(struct i2c_client *client)
427{
428 struct pcf857x_platform_data *pdata = dev_get_platdata(&client->dev);
429 struct pcf857x *gpio = i2c_get_clientdata(client);
430 int status = 0;
431
432 if (pdata && pdata->teardown) {
433 status = pdata->teardown(client,
434 gpio->chip.base, gpio->chip.ngpio,
435 pdata->context);
436 if (status < 0) {
437 dev_err(&client->dev, "%s --> %d\n",
438 "teardown", status);
439 return status;
440 }
441 }
442
443 if (client->irq)
444 pcf857x_irq_domain_cleanup(gpio);
445
446 status = gpiochip_remove(&gpio->chip);
447 if (status)
448 dev_err(&client->dev, "%s --> %d\n", "remove", status);
449 return status;
450}
451
452static struct i2c_driver pcf857x_driver = {
453 .driver = {
454 .name = "pcf857x",
455 .owner = THIS_MODULE,
456 .of_match_table = of_match_ptr(pcf857x_of_table),
457 },
458 .probe = pcf857x_probe,
459 .remove = pcf857x_remove,
460 .id_table = pcf857x_id,
461};
462
463static int __init pcf857x_init(void)
464{
465 return i2c_add_driver(&pcf857x_driver);
466}
467
468
469
470subsys_initcall(pcf857x_init);
471
472static void __exit pcf857x_exit(void)
473{
474 i2c_del_driver(&pcf857x_driver);
475}
476module_exit(pcf857x_exit);
477
478MODULE_LICENSE("GPL");
479MODULE_AUTHOR("David Brownell");
480