mm: update get_user_pages_longterm to migrate pages allocated from CMA region
[linux-2.6-block.git] / drivers / pinctrl / pinctrl-mcp23s08.c
CommitLineData
d8f4494e 1/* MCP23S08 SPI/I2C GPIO driver */
e58b9e27
DB
2
3#include <linux/kernel.h>
4#include <linux/device.h>
e58b9e27 5#include <linux/mutex.h>
bb207ef1 6#include <linux/module.h>
1c5fb66a 7#include <linux/gpio/driver.h>
752ad5e8 8#include <linux/i2c.h>
e58b9e27
DB
9#include <linux/spi/spi.h>
10#include <linux/spi/mcp23s08.h>
5a0e3ad6 11#include <linux/slab.h>
0b7bb77f 12#include <asm/byteorder.h>
4e47f91b 13#include <linux/interrupt.h>
97ddb1c8 14#include <linux/of_device.h>
3d84fdb3 15#include <linux/regmap.h>
82039d24
SR
16#include <linux/pinctrl/pinctrl.h>
17#include <linux/pinctrl/pinconf.h>
18#include <linux/pinctrl/pinconf-generic.h>
e58b9e27 19
d8f4494e 20/*
0b7bb77f
PK
21 * MCP types supported by driver
22 */
23#define MCP_TYPE_S08 0
24#define MCP_TYPE_S17 1
752ad5e8
PK
25#define MCP_TYPE_008 2
26#define MCP_TYPE_017 3
28c5a41e 27#define MCP_TYPE_S18 4
ff0f2ce7 28#define MCP_TYPE_018 5
e58b9e27 29
ce9bd0a0
SR
30#define MCP_MAX_DEV_PER_CS 8
31
e58b9e27
DB
32/* Registers are all 8 bits wide.
33 *
34 * The mcp23s17 has twice as many bits, and can be configured to work
35 * with either 16 bit registers or with two adjacent 8 bit banks.
e58b9e27
DB
36 */
37#define MCP_IODIR 0x00 /* init/reset: all ones */
38#define MCP_IPOL 0x01
39#define MCP_GPINTEN 0x02
40#define MCP_DEFVAL 0x03
41#define MCP_INTCON 0x04
42#define MCP_IOCON 0x05
4e47f91b 43# define IOCON_MIRROR (1 << 6)
e58b9e27
DB
44# define IOCON_SEQOP (1 << 5)
45# define IOCON_HAEN (1 << 3)
46# define IOCON_ODR (1 << 2)
47# define IOCON_INTPOL (1 << 1)
3539699c 48# define IOCON_INTCC (1)
e58b9e27
DB
49#define MCP_GPPU 0x06
50#define MCP_INTF 0x07
51#define MCP_INTCAP 0x08
52#define MCP_GPIO 0x09
53#define MCP_OLAT 0x0a
54
0b7bb77f
PK
55struct mcp23s08;
56
e58b9e27 57struct mcp23s08 {
e58b9e27 58 u8 addr;
a4e63554 59 bool irq_active_high;
3d84fdb3 60 bool reg_shift;
e58b9e27 61
4e47f91b
LP
62 u16 irq_rise;
63 u16 irq_fall;
64 int irq;
65 bool irq_controller;
8f38910b
SR
66 int cached_gpio;
67 /* lock protects regmap access with bypass/cache flags */
e58b9e27 68 struct mutex lock;
e58b9e27
DB
69
70 struct gpio_chip chip;
71
3d84fdb3
SR
72 struct regmap *regmap;
73 struct device *dev;
82039d24
SR
74
75 struct pinctrl_dev *pctldev;
76 struct pinctrl_desc pinctrl_desc;
8f1cc3b1
DB
77};
78
8f38910b
SR
79static const struct reg_default mcp23x08_defaults[] = {
80 {.reg = MCP_IODIR, .def = 0xff},
81 {.reg = MCP_IPOL, .def = 0x00},
82 {.reg = MCP_GPINTEN, .def = 0x00},
83 {.reg = MCP_DEFVAL, .def = 0x00},
84 {.reg = MCP_INTCON, .def = 0x00},
85 {.reg = MCP_IOCON, .def = 0x00},
86 {.reg = MCP_GPPU, .def = 0x00},
87 {.reg = MCP_OLAT, .def = 0x00},
88};
89
90static const struct regmap_range mcp23x08_volatile_range = {
91 .range_min = MCP_INTF,
92 .range_max = MCP_GPIO,
93};
94
95static const struct regmap_access_table mcp23x08_volatile_table = {
96 .yes_ranges = &mcp23x08_volatile_range,
97 .n_yes_ranges = 1,
98};
99
100static const struct regmap_range mcp23x08_precious_range = {
101 .range_min = MCP_GPIO,
102 .range_max = MCP_GPIO,
103};
104
105static const struct regmap_access_table mcp23x08_precious_table = {
106 .yes_ranges = &mcp23x08_precious_range,
107 .n_yes_ranges = 1,
108};
109
3d84fdb3
SR
110static const struct regmap_config mcp23x08_regmap = {
111 .reg_bits = 8,
112 .val_bits = 8,
752ad5e8 113
3d84fdb3 114 .reg_stride = 1,
8f38910b
SR
115 .volatile_table = &mcp23x08_volatile_table,
116 .precious_table = &mcp23x08_precious_table,
117 .reg_defaults = mcp23x08_defaults,
118 .num_reg_defaults = ARRAY_SIZE(mcp23x08_defaults),
119 .cache_type = REGCACHE_FLAT,
3d84fdb3 120 .max_register = MCP_OLAT,
752ad5e8
PK
121};
122
8f38910b
SR
123static const struct reg_default mcp23x16_defaults[] = {
124 {.reg = MCP_IODIR << 1, .def = 0xffff},
125 {.reg = MCP_IPOL << 1, .def = 0x0000},
126 {.reg = MCP_GPINTEN << 1, .def = 0x0000},
127 {.reg = MCP_DEFVAL << 1, .def = 0x0000},
128 {.reg = MCP_INTCON << 1, .def = 0x0000},
129 {.reg = MCP_IOCON << 1, .def = 0x0000},
130 {.reg = MCP_GPPU << 1, .def = 0x0000},
131 {.reg = MCP_OLAT << 1, .def = 0x0000},
132};
133
134static const struct regmap_range mcp23x16_volatile_range = {
135 .range_min = MCP_INTF << 1,
136 .range_max = MCP_GPIO << 1,
137};
138
139static const struct regmap_access_table mcp23x16_volatile_table = {
140 .yes_ranges = &mcp23x16_volatile_range,
141 .n_yes_ranges = 1,
142};
143
144static const struct regmap_range mcp23x16_precious_range = {
145 .range_min = MCP_GPIO << 1,
146 .range_max = MCP_GPIO << 1,
147};
148
149static const struct regmap_access_table mcp23x16_precious_table = {
150 .yes_ranges = &mcp23x16_precious_range,
151 .n_yes_ranges = 1,
152};
153
3d84fdb3
SR
154static const struct regmap_config mcp23x17_regmap = {
155 .reg_bits = 8,
156 .val_bits = 16,
752ad5e8 157
3d84fdb3
SR
158 .reg_stride = 2,
159 .max_register = MCP_OLAT << 1,
8f38910b
SR
160 .volatile_table = &mcp23x16_volatile_table,
161 .precious_table = &mcp23x16_precious_table,
162 .reg_defaults = mcp23x16_defaults,
163 .num_reg_defaults = ARRAY_SIZE(mcp23x16_defaults),
164 .cache_type = REGCACHE_FLAT,
3d84fdb3
SR
165 .val_format_endian = REGMAP_ENDIAN_LITTLE,
166};
752ad5e8 167
82039d24
SR
168static int mcp_read(struct mcp23s08 *mcp, unsigned int reg, unsigned int *val)
169{
170 return regmap_read(mcp->regmap, reg << mcp->reg_shift, val);
171}
172
173static int mcp_write(struct mcp23s08 *mcp, unsigned int reg, unsigned int val)
174{
175 return regmap_write(mcp->regmap, reg << mcp->reg_shift, val);
176}
177
8f38910b
SR
178static int mcp_set_mask(struct mcp23s08 *mcp, unsigned int reg,
179 unsigned int mask, bool enabled)
82039d24
SR
180{
181 u16 val = enabled ? 0xffff : 0x0000;
82039d24
SR
182 return regmap_update_bits(mcp->regmap, reg << mcp->reg_shift,
183 mask, val);
184}
185
8f38910b
SR
186static int mcp_set_bit(struct mcp23s08 *mcp, unsigned int reg,
187 unsigned int pin, bool enabled)
82039d24 188{
8f38910b
SR
189 u16 mask = BIT(pin);
190 return mcp_set_mask(mcp, reg, mask, enabled);
82039d24
SR
191}
192
193static const struct pinctrl_pin_desc mcp23x08_pins[] = {
194 PINCTRL_PIN(0, "gpio0"),
195 PINCTRL_PIN(1, "gpio1"),
196 PINCTRL_PIN(2, "gpio2"),
197 PINCTRL_PIN(3, "gpio3"),
198 PINCTRL_PIN(4, "gpio4"),
199 PINCTRL_PIN(5, "gpio5"),
200 PINCTRL_PIN(6, "gpio6"),
201 PINCTRL_PIN(7, "gpio7"),
202};
203
204static const struct pinctrl_pin_desc mcp23x17_pins[] = {
205 PINCTRL_PIN(0, "gpio0"),
206 PINCTRL_PIN(1, "gpio1"),
207 PINCTRL_PIN(2, "gpio2"),
208 PINCTRL_PIN(3, "gpio3"),
209 PINCTRL_PIN(4, "gpio4"),
210 PINCTRL_PIN(5, "gpio5"),
211 PINCTRL_PIN(6, "gpio6"),
212 PINCTRL_PIN(7, "gpio7"),
213 PINCTRL_PIN(8, "gpio8"),
214 PINCTRL_PIN(9, "gpio9"),
215 PINCTRL_PIN(10, "gpio10"),
216 PINCTRL_PIN(11, "gpio11"),
217 PINCTRL_PIN(12, "gpio12"),
218 PINCTRL_PIN(13, "gpio13"),
219 PINCTRL_PIN(14, "gpio14"),
220 PINCTRL_PIN(15, "gpio15"),
221};
222
223static int mcp_pinctrl_get_groups_count(struct pinctrl_dev *pctldev)
224{
225 return 0;
226}
227
228static const char *mcp_pinctrl_get_group_name(struct pinctrl_dev *pctldev,
229 unsigned int group)
230{
231 return NULL;
232}
233
234static int mcp_pinctrl_get_group_pins(struct pinctrl_dev *pctldev,
235 unsigned int group,
236 const unsigned int **pins,
237 unsigned int *num_pins)
238{
239 return -ENOTSUPP;
240}
241
242static const struct pinctrl_ops mcp_pinctrl_ops = {
243 .get_groups_count = mcp_pinctrl_get_groups_count,
244 .get_group_name = mcp_pinctrl_get_group_name,
245 .get_group_pins = mcp_pinctrl_get_group_pins,
246#ifdef CONFIG_OF
247 .dt_node_to_map = pinconf_generic_dt_node_to_map_pin,
248 .dt_free_map = pinconf_generic_dt_free_map,
249#endif
250};
251
252static int mcp_pinconf_get(struct pinctrl_dev *pctldev, unsigned int pin,
253 unsigned long *config)
254{
255 struct mcp23s08 *mcp = pinctrl_dev_get_drvdata(pctldev);
256 enum pin_config_param param = pinconf_to_config_param(*config);
257 unsigned int data, status;
258 int ret;
259
260 switch (param) {
261 case PIN_CONFIG_BIAS_PULL_UP:
262 ret = mcp_read(mcp, MCP_GPPU, &data);
263 if (ret < 0)
264 return ret;
265 status = (data & BIT(pin)) ? 1 : 0;
266 break;
267 default:
268 dev_err(mcp->dev, "Invalid config param %04x\n", param);
269 return -ENOTSUPP;
270 }
271
272 *config = 0;
273
274 return status ? 0 : -EINVAL;
275}
276
277static int mcp_pinconf_set(struct pinctrl_dev *pctldev, unsigned int pin,
278 unsigned long *configs, unsigned int num_configs)
279{
280 struct mcp23s08 *mcp = pinctrl_dev_get_drvdata(pctldev);
281 enum pin_config_param param;
2a7893c8 282 u32 arg;
82039d24
SR
283 int ret = 0;
284 int i;
285
286 for (i = 0; i < num_configs; i++) {
287 param = pinconf_to_config_param(configs[i]);
288 arg = pinconf_to_config_argument(configs[i]);
289
290 switch (param) {
291 case PIN_CONFIG_BIAS_PULL_UP:
82039d24
SR
292 ret = mcp_set_bit(mcp, MCP_GPPU, pin, arg);
293 break;
294 default:
295 dev_err(mcp->dev, "Invalid config param %04x\n", param);
296 return -ENOTSUPP;
297 }
298 }
299
300 return ret;
301}
302
303static const struct pinconf_ops mcp_pinconf_ops = {
304 .pin_config_get = mcp_pinconf_get,
305 .pin_config_set = mcp_pinconf_set,
306 .is_generic = true,
307};
308
752ad5e8
PK
309/*----------------------------------------------------------------------*/
310
d62b98f3
PK
311#ifdef CONFIG_SPI_MASTER
312
3d84fdb3 313static int mcp23sxx_spi_write(void *context, const void *data, size_t count)
e58b9e27 314{
3d84fdb3
SR
315 struct mcp23s08 *mcp = context;
316 struct spi_device *spi = to_spi_device(mcp->dev);
317 struct spi_message m;
318 struct spi_transfer t[2] = { { .tx_buf = &mcp->addr, .len = 1, },
319 { .tx_buf = data, .len = count, }, };
e58b9e27 320
3d84fdb3
SR
321 spi_message_init(&m);
322 spi_message_add_tail(&t[0], &m);
323 spi_message_add_tail(&t[1], &m);
324
325 return spi_sync(spi, &m);
e58b9e27
DB
326}
327
3d84fdb3
SR
328static int mcp23sxx_spi_gather_write(void *context,
329 const void *reg, size_t reg_size,
330 const void *val, size_t val_size)
e58b9e27 331{
3d84fdb3
SR
332 struct mcp23s08 *mcp = context;
333 struct spi_device *spi = to_spi_device(mcp->dev);
334 struct spi_message m;
335 struct spi_transfer t[3] = { { .tx_buf = &mcp->addr, .len = 1, },
336 { .tx_buf = reg, .len = reg_size, },
337 { .tx_buf = val, .len = val_size, }, };
338
339 spi_message_init(&m);
340 spi_message_add_tail(&t[0], &m);
341 spi_message_add_tail(&t[1], &m);
342 spi_message_add_tail(&t[2], &m);
343
344 return spi_sync(spi, &m);
e58b9e27
DB
345}
346
3d84fdb3
SR
347static int mcp23sxx_spi_read(void *context, const void *reg, size_t reg_size,
348 void *val, size_t val_size)
e58b9e27 349{
3d84fdb3
SR
350 struct mcp23s08 *mcp = context;
351 struct spi_device *spi = to_spi_device(mcp->dev);
352 u8 tx[2];
e58b9e27 353
3d84fdb3 354 if (reg_size != 1)
e58b9e27 355 return -EINVAL;
3d84fdb3 356
e58b9e27 357 tx[0] = mcp->addr | 0x01;
3d84fdb3 358 tx[1] = *((u8 *) reg);
0b7bb77f 359
3d84fdb3 360 return spi_write_then_read(spi, tx, sizeof(tx), val, val_size);
0b7bb77f
PK
361}
362
3d84fdb3
SR
363static const struct regmap_bus mcp23sxx_spi_regmap = {
364 .write = mcp23sxx_spi_write,
365 .gather_write = mcp23sxx_spi_gather_write,
366 .read = mcp23sxx_spi_read,
367};
0b7bb77f 368
3d84fdb3 369#endif /* CONFIG_SPI_MASTER */
0b7bb77f 370
3d84fdb3 371/*----------------------------------------------------------------------*/
0b7bb77f 372
3d84fdb3
SR
373/* A given spi_device can represent up to eight mcp23sxx chips
374 * sharing the same chipselect but using different addresses
375 * (e.g. chips #0 and #3 might be populated, but not #1 or $2).
376 * Driver data holds all the per-chip data.
377 */
378struct mcp23s08_driver_data {
379 unsigned ngpio;
380 struct mcp23s08 *mcp[8];
381 struct mcp23s08 chip[];
0b7bb77f
PK
382};
383
e58b9e27
DB
384
385static int mcp23s08_direction_input(struct gpio_chip *chip, unsigned offset)
386{
9e03cf0b 387 struct mcp23s08 *mcp = gpiochip_get_data(chip);
e58b9e27
DB
388 int status;
389
390 mutex_lock(&mcp->lock);
8f38910b 391 status = mcp_set_bit(mcp, MCP_IODIR, offset, true);
e58b9e27 392 mutex_unlock(&mcp->lock);
8f38910b 393
e58b9e27
DB
394 return status;
395}
396
397static int mcp23s08_get(struct gpio_chip *chip, unsigned offset)
398{
9e03cf0b 399 struct mcp23s08 *mcp = gpiochip_get_data(chip);
3d84fdb3 400 int status, ret;
e58b9e27
DB
401
402 mutex_lock(&mcp->lock);
403
404 /* REVISIT reading this clears any IRQ ... */
3d84fdb3
SR
405 ret = mcp_read(mcp, MCP_GPIO, &status);
406 if (ret < 0)
e58b9e27 407 status = 0;
59861701
DM
408 else {
409 mcp->cached_gpio = status;
e58b9e27 410 status = !!(status & (1 << offset));
59861701 411 }
8f38910b 412
e58b9e27
DB
413 mutex_unlock(&mcp->lock);
414 return status;
415}
416
8f38910b 417static int __mcp23s08_set(struct mcp23s08 *mcp, unsigned mask, bool value)
e58b9e27 418{
8f38910b 419 return mcp_set_mask(mcp, MCP_OLAT, mask, value);
e58b9e27
DB
420}
421
422static void mcp23s08_set(struct gpio_chip *chip, unsigned offset, int value)
423{
9e03cf0b 424 struct mcp23s08 *mcp = gpiochip_get_data(chip);
8f38910b 425 unsigned mask = BIT(offset);
e58b9e27
DB
426
427 mutex_lock(&mcp->lock);
8f38910b 428 __mcp23s08_set(mcp, mask, !!value);
e58b9e27
DB
429 mutex_unlock(&mcp->lock);
430}
431
432static int
433mcp23s08_direction_output(struct gpio_chip *chip, unsigned offset, int value)
434{
9e03cf0b 435 struct mcp23s08 *mcp = gpiochip_get_data(chip);
8f38910b 436 unsigned mask = BIT(offset);
e58b9e27
DB
437 int status;
438
439 mutex_lock(&mcp->lock);
440 status = __mcp23s08_set(mcp, mask, value);
441 if (status == 0) {
8f38910b 442 status = mcp_set_mask(mcp, MCP_IODIR, mask, false);
e58b9e27
DB
443 }
444 mutex_unlock(&mcp->lock);
445 return status;
446}
447
4e47f91b
LP
448/*----------------------------------------------------------------------*/
449static irqreturn_t mcp23s08_irq(int irq, void *data)
450{
451 struct mcp23s08 *mcp = data;
8f38910b 452 int intcap, intcon, intf, i, gpio, gpio_orig, intcap_mask, defval;
4e47f91b 453 unsigned int child_irq;
2cd29f23
RM
454 bool intf_set, intcap_changed, gpio_bit_changed,
455 defval_changed, gpio_set;
4e47f91b
LP
456
457 mutex_lock(&mcp->lock);
7f6f50df
ME
458 if (mcp_read(mcp, MCP_INTF, &intf))
459 goto unlock;
4e47f91b 460
7f6f50df
ME
461 if (mcp_read(mcp, MCP_INTCAP, &intcap))
462 goto unlock;
4e47f91b 463
7f6f50df
ME
464 if (mcp_read(mcp, MCP_INTCON, &intcon))
465 goto unlock;
8f38910b 466
7f6f50df
ME
467 if (mcp_read(mcp, MCP_DEFVAL, &defval))
468 goto unlock;
2cd29f23
RM
469
470 /* This clears the interrupt(configurable on S18) */
7f6f50df
ME
471 if (mcp_read(mcp, MCP_GPIO, &gpio))
472 goto unlock;
473
8f38910b
SR
474 gpio_orig = mcp->cached_gpio;
475 mcp->cached_gpio = gpio;
4e47f91b
LP
476 mutex_unlock(&mcp->lock);
477
8f38910b 478 if (intf == 0) {
2cd29f23
RM
479 /* There is no interrupt pending */
480 return IRQ_HANDLED;
481 }
482
483 dev_dbg(mcp->chip.parent,
484 "intcap 0x%04X intf 0x%04X gpio_orig 0x%04X gpio 0x%04X\n",
485 intcap, intf, gpio_orig, gpio);
4e47f91b
LP
486
487 for (i = 0; i < mcp->chip.ngpio; i++) {
2cd29f23
RM
488 /* We must check all of the inputs on the chip,
489 * otherwise we may not notice a change on >=2 pins.
490 *
491 * On at least the mcp23s17, INTCAP is only updated
492 * one byte at a time(INTCAPA and INTCAPB are
493 * not written to at the same time - only on a per-bank
494 * basis).
495 *
496 * INTF only contains the single bit that caused the
497 * interrupt per-bank. On the mcp23s17, there is
498 * INTFA and INTFB. If two pins are changed on the A
499 * side at the same time, INTF will only have one bit
500 * set. If one pin on the A side and one pin on the B
501 * side are changed at the same time, INTF will have
502 * two bits set. Thus, INTF can't be the only check
503 * to see if the input has changed.
504 */
505
8f38910b 506 intf_set = intf & BIT(i);
2cd29f23
RM
507 if (i < 8 && intf_set)
508 intcap_mask = 0x00FF;
509 else if (i >= 8 && intf_set)
510 intcap_mask = 0xFF00;
511 else
512 intcap_mask = 0x00;
513
514 intcap_changed = (intcap_mask &
8f38910b 515 (intcap & BIT(i))) !=
2cd29f23 516 (intcap_mask & (BIT(i) & gpio_orig));
8f38910b 517 gpio_set = BIT(i) & gpio;
2cd29f23 518 gpio_bit_changed = (BIT(i) & gpio_orig) !=
8f38910b
SR
519 (BIT(i) & gpio);
520 defval_changed = (BIT(i) & intcon) &&
521 ((BIT(i) & gpio) !=
522 (BIT(i) & defval));
2cd29f23
RM
523
524 if (((gpio_bit_changed || intcap_changed) &&
525 (BIT(i) & mcp->irq_rise) && gpio_set) ||
526 ((gpio_bit_changed || intcap_changed) &&
527 (BIT(i) & mcp->irq_fall) && !gpio_set) ||
528 defval_changed) {
f0fbe7bc 529 child_irq = irq_find_mapping(mcp->chip.irq.domain, i);
4e47f91b
LP
530 handle_nested_irq(child_irq);
531 }
532 }
533
534 return IRQ_HANDLED;
7f6f50df
ME
535
536unlock:
537 mutex_unlock(&mcp->lock);
538 return IRQ_HANDLED;
4e47f91b
LP
539}
540
4e47f91b
LP
541static void mcp23s08_irq_mask(struct irq_data *data)
542{
dad3d272
PR
543 struct gpio_chip *gc = irq_data_get_irq_chip_data(data);
544 struct mcp23s08 *mcp = gpiochip_get_data(gc);
4e47f91b
LP
545 unsigned int pos = data->hwirq;
546
8f38910b 547 mcp_set_bit(mcp, MCP_GPINTEN, pos, false);
4e47f91b
LP
548}
549
550static void mcp23s08_irq_unmask(struct irq_data *data)
551{
dad3d272
PR
552 struct gpio_chip *gc = irq_data_get_irq_chip_data(data);
553 struct mcp23s08 *mcp = gpiochip_get_data(gc);
4e47f91b
LP
554 unsigned int pos = data->hwirq;
555
8f38910b 556 mcp_set_bit(mcp, MCP_GPINTEN, pos, true);
4e47f91b
LP
557}
558
559static int mcp23s08_irq_set_type(struct irq_data *data, unsigned int type)
560{
dad3d272
PR
561 struct gpio_chip *gc = irq_data_get_irq_chip_data(data);
562 struct mcp23s08 *mcp = gpiochip_get_data(gc);
4e47f91b
LP
563 unsigned int pos = data->hwirq;
564 int status = 0;
565
566 if ((type & IRQ_TYPE_EDGE_BOTH) == IRQ_TYPE_EDGE_BOTH) {
8f38910b 567 mcp_set_bit(mcp, MCP_INTCON, pos, false);
4e47f91b
LP
568 mcp->irq_rise |= BIT(pos);
569 mcp->irq_fall |= BIT(pos);
570 } else if (type & IRQ_TYPE_EDGE_RISING) {
8f38910b 571 mcp_set_bit(mcp, MCP_INTCON, pos, false);
4e47f91b
LP
572 mcp->irq_rise |= BIT(pos);
573 mcp->irq_fall &= ~BIT(pos);
574 } else if (type & IRQ_TYPE_EDGE_FALLING) {
8f38910b 575 mcp_set_bit(mcp, MCP_INTCON, pos, false);
4e47f91b
LP
576 mcp->irq_rise &= ~BIT(pos);
577 mcp->irq_fall |= BIT(pos);
16fe1ad2 578 } else if (type & IRQ_TYPE_LEVEL_HIGH) {
8f38910b
SR
579 mcp_set_bit(mcp, MCP_INTCON, pos, true);
580 mcp_set_bit(mcp, MCP_DEFVAL, pos, false);
16fe1ad2 581 } else if (type & IRQ_TYPE_LEVEL_LOW) {
8f38910b
SR
582 mcp_set_bit(mcp, MCP_INTCON, pos, true);
583 mcp_set_bit(mcp, MCP_DEFVAL, pos, true);
4e47f91b
LP
584 } else
585 return -EINVAL;
586
587 return status;
588}
589
590static void mcp23s08_irq_bus_lock(struct irq_data *data)
591{
dad3d272
PR
592 struct gpio_chip *gc = irq_data_get_irq_chip_data(data);
593 struct mcp23s08 *mcp = gpiochip_get_data(gc);
4e47f91b 594
8f38910b
SR
595 mutex_lock(&mcp->lock);
596 regcache_cache_only(mcp->regmap, true);
4e47f91b
LP
597}
598
599static void mcp23s08_irq_bus_unlock(struct irq_data *data)
600{
dad3d272
PR
601 struct gpio_chip *gc = irq_data_get_irq_chip_data(data);
602 struct mcp23s08 *mcp = gpiochip_get_data(gc);
4e47f91b 603
8f38910b
SR
604 regcache_cache_only(mcp->regmap, false);
605 regcache_sync(mcp->regmap);
606
4e47f91b 607 mutex_unlock(&mcp->lock);
4e47f91b
LP
608}
609
4e47f91b
LP
610static struct irq_chip mcp23s08_irq_chip = {
611 .name = "gpio-mcp23xxx",
612 .irq_mask = mcp23s08_irq_mask,
613 .irq_unmask = mcp23s08_irq_unmask,
614 .irq_set_type = mcp23s08_irq_set_type,
615 .irq_bus_lock = mcp23s08_irq_bus_lock,
616 .irq_bus_sync_unlock = mcp23s08_irq_bus_unlock,
4e47f91b
LP
617};
618
619static int mcp23s08_irq_setup(struct mcp23s08 *mcp)
620{
621 struct gpio_chip *chip = &mcp->chip;
dad3d272 622 int err;
a4e63554 623 unsigned long irqflags = IRQF_ONESHOT | IRQF_SHARED;
4e47f91b 624
a4e63554
AS
625 if (mcp->irq_active_high)
626 irqflags |= IRQF_TRIGGER_HIGH;
627 else
628 irqflags |= IRQF_TRIGGER_LOW;
629
58383c78
LW
630 err = devm_request_threaded_irq(chip->parent, mcp->irq, NULL,
631 mcp23s08_irq,
632 irqflags, dev_name(chip->parent), mcp);
4e47f91b 633 if (err != 0) {
58383c78 634 dev_err(chip->parent, "unable to request IRQ#%d: %d\n",
4e47f91b
LP
635 mcp->irq, err);
636 return err;
637 }
638
f259f896
MF
639 return 0;
640}
641
642static int mcp23s08_irqchip_setup(struct mcp23s08 *mcp)
643{
644 struct gpio_chip *chip = &mcp->chip;
645 int err;
646
d245b3f9
LW
647 err = gpiochip_irqchip_add_nested(chip,
648 &mcp23s08_irq_chip,
649 0,
650 handle_simple_irq,
651 IRQ_TYPE_NONE);
dad3d272
PR
652 if (err) {
653 dev_err(chip->parent,
654 "could not connect irqchip to gpiochip: %d\n", err);
655 return err;
4e47f91b 656 }
4e47f91b 657
d245b3f9
LW
658 gpiochip_set_nested_irqchip(chip,
659 &mcp23s08_irq_chip,
660 mcp->irq);
4e47f91b 661
dad3d272 662 return 0;
4e47f91b
LP
663}
664
e58b9e27
DB
665/*----------------------------------------------------------------------*/
666
667#ifdef CONFIG_DEBUG_FS
668
669#include <linux/seq_file.h>
670
8f38910b
SR
671/*
672 * This compares the chip's registers with the register
673 * cache and corrects any incorrectly set register. This
674 * can be used to fix state for MCP23xxx, that temporary
675 * lost its power supply.
676 */
7547b596 677#define MCP23S08_CONFIG_REGS 7
8f38910b
SR
678static int __check_mcp23s08_reg_cache(struct mcp23s08 *mcp)
679{
680 int cached[MCP23S08_CONFIG_REGS];
681 int err = 0, i;
682
683 /* read cached config registers */
684 for (i = 0; i < MCP23S08_CONFIG_REGS; i++) {
685 err = mcp_read(mcp, i, &cached[i]);
686 if (err)
687 goto out;
688 }
689
690 regcache_cache_bypass(mcp->regmap, true);
691
692 for (i = 0; i < MCP23S08_CONFIG_REGS; i++) {
693 int uncached;
694 err = mcp_read(mcp, i, &uncached);
695 if (err)
696 goto out;
697
698 if (uncached != cached[i]) {
699 dev_err(mcp->dev, "restoring reg 0x%02x from 0x%04x to 0x%04x (power-loss?)\n",
700 i, uncached, cached[i]);
701 mcp_write(mcp, i, cached[i]);
702 }
703 }
704
705out:
706 if (err)
707 dev_err(mcp->dev, "read error: reg=%02x, err=%d", i, err);
708 regcache_cache_bypass(mcp->regmap, false);
709 return err;
710}
711
e58b9e27
DB
712/*
713 * This shows more info than the generic gpio dump code:
714 * pullups, deglitching, open drain drive.
715 */
716static void mcp23s08_dbg_show(struct seq_file *s, struct gpio_chip *chip)
717{
718 struct mcp23s08 *mcp;
719 char bank;
1d1c1d9b 720 int t;
e58b9e27 721 unsigned mask;
8f38910b 722 int iodir, gpio, gppu;
e58b9e27 723
9e03cf0b 724 mcp = gpiochip_get_data(chip);
e58b9e27
DB
725
726 /* NOTE: we only handle one bank for now ... */
0b7bb77f 727 bank = '0' + ((mcp->addr >> 1) & 0x7);
e58b9e27
DB
728
729 mutex_lock(&mcp->lock);
8f38910b
SR
730
731 t = __check_mcp23s08_reg_cache(mcp);
732 if (t) {
733 seq_printf(s, " I/O Error\n");
734 goto done;
735 }
736 t = mcp_read(mcp, MCP_IODIR, &iodir);
737 if (t) {
738 seq_printf(s, " I/O Error\n");
739 goto done;
740 }
741 t = mcp_read(mcp, MCP_GPIO, &gpio);
742 if (t) {
743 seq_printf(s, " I/O Error\n");
744 goto done;
745 }
746 t = mcp_read(mcp, MCP_GPPU, &gppu);
747 if (t) {
748 seq_printf(s, " I/O Error\n");
e58b9e27
DB
749 goto done;
750 }
751
8f38910b
SR
752 for (t = 0, mask = BIT(0); t < chip->ngpio; t++, mask <<= 1) {
753 const char *label;
e58b9e27
DB
754
755 label = gpiochip_is_requested(chip, t);
756 if (!label)
757 continue;
758
7c3012c8
ME
759 seq_printf(s, " gpio-%-3d P%c.%d (%-12s) %s %s %s\n",
760 chip->base + t, bank, t, label,
761 (iodir & mask) ? "in " : "out",
762 (gpio & mask) ? "hi" : "lo",
763 (gppu & mask) ? "up" : " ");
e58b9e27 764 /* NOTE: ignoring the irq-related registers */
e58b9e27
DB
765 }
766done:
767 mutex_unlock(&mcp->lock);
768}
769
770#else
771#define mcp23s08_dbg_show NULL
772#endif
773
774/*----------------------------------------------------------------------*/
775
d62b98f3 776static int mcp23s08_probe_one(struct mcp23s08 *mcp, struct device *dev,
4e47f91b 777 void *data, unsigned addr, unsigned type,
5b1a7e80 778 unsigned int base, int cs)
e58b9e27 779{
3d84fdb3 780 int status, ret;
4e47f91b 781 bool mirror = false;
fa2b7fae 782 bool open_drain = false;
9b3e4207 783 struct regmap_config *one_regmap_config = NULL;
ed231751 784 int raw_chip_address = (addr & ~0x40) >> 1;
e58b9e27 785
e58b9e27
DB
786 mutex_init(&mcp->lock);
787
3d84fdb3 788 mcp->dev = dev;
d62b98f3 789 mcp->addr = addr;
a4e63554 790 mcp->irq_active_high = false;
e58b9e27 791
e58b9e27
DB
792 mcp->chip.direction_input = mcp23s08_direction_input;
793 mcp->chip.get = mcp23s08_get;
794 mcp->chip.direction_output = mcp23s08_direction_output;
795 mcp->chip.set = mcp23s08_set;
796 mcp->chip.dbg_show = mcp23s08_dbg_show;
60f749f8 797#ifdef CONFIG_OF_GPIO
97ddb1c8
LP
798 mcp->chip.of_gpio_n_cells = 2;
799 mcp->chip.of_node = dev->of_node;
800#endif
e58b9e27 801
d62b98f3
PK
802 switch (type) {
803#ifdef CONFIG_SPI_MASTER
804 case MCP_TYPE_S08:
d62b98f3 805 case MCP_TYPE_S17:
9b3e4207
JK
806 switch (type) {
807 case MCP_TYPE_S08:
808 one_regmap_config =
809 devm_kmemdup(dev, &mcp23x08_regmap,
810 sizeof(struct regmap_config), GFP_KERNEL);
811 mcp->reg_shift = 0;
812 mcp->chip.ngpio = 8;
ed231751
JK
813 mcp->chip.label = devm_kasprintf(dev, GFP_KERNEL,
814 "mcp23s08.%d", raw_chip_address);
9b3e4207
JK
815 break;
816 case MCP_TYPE_S17:
817 one_regmap_config =
818 devm_kmemdup(dev, &mcp23x17_regmap,
819 sizeof(struct regmap_config), GFP_KERNEL);
820 mcp->reg_shift = 1;
821 mcp->chip.ngpio = 16;
ed231751
JK
822 mcp->chip.label = devm_kasprintf(dev, GFP_KERNEL,
823 "mcp23s17.%d", raw_chip_address);
9b3e4207
JK
824 break;
825 }
826 if (!one_regmap_config)
827 return -ENOMEM;
828
ed231751 829 one_regmap_config->name = devm_kasprintf(dev, GFP_KERNEL, "%d", raw_chip_address);
3d84fdb3 830 mcp->regmap = devm_regmap_init(dev, &mcp23sxx_spi_regmap, mcp,
9b3e4207 831 one_regmap_config);
d62b98f3 832 break;
28c5a41e
PR
833
834 case MCP_TYPE_S18:
f165988b
JK
835 one_regmap_config =
836 devm_kmemdup(dev, &mcp23x17_regmap,
837 sizeof(struct regmap_config), GFP_KERNEL);
838 if (!one_regmap_config)
839 return -ENOMEM;
3d84fdb3 840 mcp->regmap = devm_regmap_init(dev, &mcp23sxx_spi_regmap, mcp,
f165988b 841 one_regmap_config);
3d84fdb3 842 mcp->reg_shift = 1;
28c5a41e
PR
843 mcp->chip.ngpio = 16;
844 mcp->chip.label = "mcp23s18";
845 break;
d62b98f3
PK
846#endif /* CONFIG_SPI_MASTER */
847
cbf24fad 848#if IS_ENABLED(CONFIG_I2C)
752ad5e8 849 case MCP_TYPE_008:
3d84fdb3
SR
850 mcp->regmap = devm_regmap_init_i2c(data, &mcp23x08_regmap);
851 mcp->reg_shift = 0;
752ad5e8
PK
852 mcp->chip.ngpio = 8;
853 mcp->chip.label = "mcp23008";
854 break;
855
856 case MCP_TYPE_017:
3d84fdb3
SR
857 mcp->regmap = devm_regmap_init_i2c(data, &mcp23x17_regmap);
858 mcp->reg_shift = 1;
752ad5e8
PK
859 mcp->chip.ngpio = 16;
860 mcp->chip.label = "mcp23017";
861 break;
ff0f2ce7
PR
862
863 case MCP_TYPE_018:
864 mcp->regmap = devm_regmap_init_i2c(data, &mcp23x17_regmap);
865 mcp->reg_shift = 1;
866 mcp->chip.ngpio = 16;
867 mcp->chip.label = "mcp23018";
868 break;
752ad5e8
PK
869#endif /* CONFIG_I2C */
870
d62b98f3
PK
871 default:
872 dev_err(dev, "invalid device type (%d)\n", type);
873 return -EINVAL;
0b7bb77f 874 }
d62b98f3 875
3d84fdb3
SR
876 if (IS_ERR(mcp->regmap))
877 return PTR_ERR(mcp->regmap);
878
5b1a7e80 879 mcp->chip.base = base;
9fb1f39e 880 mcp->chip.can_sleep = true;
58383c78 881 mcp->chip.parent = dev;
d72cbed0 882 mcp->chip.owner = THIS_MODULE;
e58b9e27 883
8f1cc3b1
DB
884 /* verify MCP_IOCON.SEQOP = 0, so sequential reads work,
885 * and MCP_IOCON.HAEN = 1, so we work with all chips.
886 */
4e47f91b 887
3d84fdb3
SR
888 ret = mcp_read(mcp, MCP_IOCON, &status);
889 if (ret < 0)
e58b9e27 890 goto fail;
4e47f91b 891
5b1a7e80
SR
892 mcp->irq_controller =
893 device_property_read_bool(dev, "interrupt-controller");
a4e63554 894 if (mcp->irq && mcp->irq_controller) {
170680ab 895 mcp->irq_active_high =
5b1a7e80 896 device_property_read_bool(dev,
170680ab 897 "microchip,irq-active-high");
4e47f91b 898
5b1a7e80 899 mirror = device_property_read_bool(dev, "microchip,irq-mirror");
fa2b7fae 900 open_drain = device_property_read_bool(dev, "drive-open-drain");
a4e63554
AS
901 }
902
903 if ((status & IOCON_SEQOP) || !(status & IOCON_HAEN) || mirror ||
fa2b7fae 904 mcp->irq_active_high || open_drain) {
0b7bb77f
PK
905 /* mcp23s17 has IOCON twice, make sure they are in sync */
906 status &= ~(IOCON_SEQOP | (IOCON_SEQOP << 8));
907 status |= IOCON_HAEN | (IOCON_HAEN << 8);
a4e63554
AS
908 if (mcp->irq_active_high)
909 status |= IOCON_INTPOL | (IOCON_INTPOL << 8);
910 else
911 status &= ~(IOCON_INTPOL | (IOCON_INTPOL << 8));
912
4e47f91b
LP
913 if (mirror)
914 status |= IOCON_MIRROR | (IOCON_MIRROR << 8);
915
fa2b7fae
PR
916 if (open_drain)
917 status |= IOCON_ODR | (IOCON_ODR << 8);
918
ff0f2ce7 919 if (type == MCP_TYPE_S18 || type == MCP_TYPE_018)
3539699c
PR
920 status |= IOCON_INTCC | (IOCON_INTCC << 8);
921
3d84fdb3
SR
922 ret = mcp_write(mcp, MCP_IOCON, status);
923 if (ret < 0)
e58b9e27
DB
924 goto fail;
925 }
926
4e47f91b 927 if (mcp->irq && mcp->irq_controller) {
f259f896 928 ret = mcp23s08_irqchip_setup(mcp);
3d84fdb3 929 if (ret)
4e47f91b 930 goto fail;
4e47f91b 931 }
82039d24 932
02e389e6
DM
933 ret = devm_gpiochip_add_data(dev, &mcp->chip, mcp);
934 if (ret < 0)
935 goto fail;
936
1781af56
JK
937 if (one_regmap_config) {
938 mcp->pinctrl_desc.name = devm_kasprintf(dev, GFP_KERNEL,
939 "mcp23xxx-pinctrl.%d", raw_chip_address);
940 if (!mcp->pinctrl_desc.name)
941 return -ENOMEM;
942 } else {
943 mcp->pinctrl_desc.name = "mcp23xxx-pinctrl";
944 }
82039d24
SR
945 mcp->pinctrl_desc.pctlops = &mcp_pinctrl_ops;
946 mcp->pinctrl_desc.confops = &mcp_pinconf_ops;
947 mcp->pinctrl_desc.npins = mcp->chip.ngpio;
948 if (mcp->pinctrl_desc.npins == 8)
949 mcp->pinctrl_desc.pins = mcp23x08_pins;
950 else if (mcp->pinctrl_desc.npins == 16)
951 mcp->pinctrl_desc.pins = mcp23x17_pins;
952 mcp->pinctrl_desc.owner = THIS_MODULE;
953
954 mcp->pctldev = devm_pinctrl_register(dev, &mcp->pinctrl_desc, mcp);
955 if (IS_ERR(mcp->pctldev)) {
956 ret = PTR_ERR(mcp->pctldev);
957 goto fail;
958 }
959
f259f896
MF
960 if (mcp->irq)
961 ret = mcp23s08_irq_setup(mcp);
962
8f1cc3b1 963fail:
3d84fdb3
SR
964 if (ret < 0)
965 dev_dbg(dev, "can't setup chip %d, --> %d\n", addr, ret);
966 return ret;
8f1cc3b1
DB
967}
968
752ad5e8
PK
969/*----------------------------------------------------------------------*/
970
97ddb1c8
LP
971#ifdef CONFIG_OF
972#ifdef CONFIG_SPI_MASTER
ac791804 973static const struct of_device_id mcp23s08_spi_of_match[] = {
97ddb1c8 974 {
45971686
LP
975 .compatible = "microchip,mcp23s08",
976 .data = (void *) MCP_TYPE_S08,
97ddb1c8
LP
977 },
978 {
45971686
LP
979 .compatible = "microchip,mcp23s17",
980 .data = (void *) MCP_TYPE_S17,
981 },
28c5a41e
PR
982 {
983 .compatible = "microchip,mcp23s18",
984 .data = (void *) MCP_TYPE_S18,
985 },
45971686
LP
986/* NOTE: The use of the mcp prefix is deprecated and will be removed. */
987 {
988 .compatible = "mcp,mcp23s08",
989 .data = (void *) MCP_TYPE_S08,
990 },
991 {
992 .compatible = "mcp,mcp23s17",
993 .data = (void *) MCP_TYPE_S17,
97ddb1c8
LP
994 },
995 { },
996};
997MODULE_DEVICE_TABLE(of, mcp23s08_spi_of_match);
998#endif
999
1000#if IS_ENABLED(CONFIG_I2C)
ac791804 1001static const struct of_device_id mcp23s08_i2c_of_match[] = {
97ddb1c8 1002 {
45971686
LP
1003 .compatible = "microchip,mcp23008",
1004 .data = (void *) MCP_TYPE_008,
97ddb1c8
LP
1005 },
1006 {
45971686
LP
1007 .compatible = "microchip,mcp23017",
1008 .data = (void *) MCP_TYPE_017,
1009 },
ff0f2ce7
PR
1010 {
1011 .compatible = "microchip,mcp23018",
1012 .data = (void *) MCP_TYPE_018,
1013 },
45971686
LP
1014/* NOTE: The use of the mcp prefix is deprecated and will be removed. */
1015 {
1016 .compatible = "mcp,mcp23008",
1017 .data = (void *) MCP_TYPE_008,
1018 },
1019 {
1020 .compatible = "mcp,mcp23017",
1021 .data = (void *) MCP_TYPE_017,
97ddb1c8
LP
1022 },
1023 { },
1024};
1025MODULE_DEVICE_TABLE(of, mcp23s08_i2c_of_match);
1026#endif
1027#endif /* CONFIG_OF */
1028
1029
cbf24fad 1030#if IS_ENABLED(CONFIG_I2C)
752ad5e8 1031
3836309d 1032static int mcp230xx_probe(struct i2c_client *client,
752ad5e8
PK
1033 const struct i2c_device_id *id)
1034{
3af0dbd5 1035 struct mcp23s08_platform_data *pdata, local_pdata;
752ad5e8 1036 struct mcp23s08 *mcp;
3af0dbd5 1037 int status;
97ddb1c8 1038
5f853acf
SR
1039 pdata = dev_get_platdata(&client->dev);
1040 if (!pdata) {
3af0dbd5
SZ
1041 pdata = &local_pdata;
1042 pdata->base = -1;
752ad5e8
PK
1043 }
1044
2f98e78b 1045 mcp = devm_kzalloc(&client->dev, sizeof(*mcp), GFP_KERNEL);
752ad5e8
PK
1046 if (!mcp)
1047 return -ENOMEM;
1048
4e47f91b 1049 mcp->irq = client->irq;
752ad5e8 1050 status = mcp23s08_probe_one(mcp, &client->dev, client, client->addr,
5b1a7e80 1051 id->driver_data, pdata->base, 0);
752ad5e8 1052 if (status)
2f98e78b 1053 return status;
752ad5e8
PK
1054
1055 i2c_set_clientdata(client, mcp);
1056
1057 return 0;
752ad5e8
PK
1058}
1059
752ad5e8
PK
1060static const struct i2c_device_id mcp230xx_id[] = {
1061 { "mcp23008", MCP_TYPE_008 },
1062 { "mcp23017", MCP_TYPE_017 },
ff0f2ce7 1063 { "mcp23018", MCP_TYPE_018 },
752ad5e8
PK
1064 { },
1065};
1066MODULE_DEVICE_TABLE(i2c, mcp230xx_id);
1067
1068static struct i2c_driver mcp230xx_driver = {
1069 .driver = {
1070 .name = "mcp230xx",
97ddb1c8 1071 .of_match_table = of_match_ptr(mcp23s08_i2c_of_match),
752ad5e8
PK
1072 },
1073 .probe = mcp230xx_probe,
752ad5e8
PK
1074 .id_table = mcp230xx_id,
1075};
1076
1077static int __init mcp23s08_i2c_init(void)
1078{
1079 return i2c_add_driver(&mcp230xx_driver);
1080}
1081
1082static void mcp23s08_i2c_exit(void)
1083{
1084 i2c_del_driver(&mcp230xx_driver);
1085}
1086
1087#else
1088
1089static int __init mcp23s08_i2c_init(void) { return 0; }
1090static void mcp23s08_i2c_exit(void) { }
1091
1092#endif /* CONFIG_I2C */
1093
1094/*----------------------------------------------------------------------*/
1095
d62b98f3
PK
1096#ifdef CONFIG_SPI_MASTER
1097
8f1cc3b1
DB
1098static int mcp23s08_probe(struct spi_device *spi)
1099{
3af0dbd5 1100 struct mcp23s08_platform_data *pdata, local_pdata;
8f1cc3b1 1101 unsigned addr;
596a1c5f 1102 int chips = 0;
8f1cc3b1 1103 struct mcp23s08_driver_data *data;
0b7bb77f 1104 int status, type;
3af0dbd5 1105 unsigned ngpio = 0;
97ddb1c8 1106 const struct of_device_id *match;
97ddb1c8
LP
1107
1108 match = of_match_device(of_match_ptr(mcp23s08_spi_of_match), &spi->dev);
0d7fcd50 1109 if (match)
de755c33 1110 type = (int)(uintptr_t)match->data;
0d7fcd50
SR
1111 else
1112 type = spi_get_device_id(spi)->driver_data;
1113
1114 pdata = dev_get_platdata(&spi->dev);
1115 if (!pdata) {
1116 pdata = &local_pdata;
1117 pdata->base = -1;
1118
0d7fcd50 1119 status = device_property_read_u32(&spi->dev,
ce9bd0a0 1120 "microchip,spi-present-mask", &pdata->spi_present_mask);
97ddb1c8 1121 if (status) {
0d7fcd50 1122 status = device_property_read_u32(&spi->dev,
ce9bd0a0
SR
1123 "mcp,spi-present-mask",
1124 &pdata->spi_present_mask);
0d7fcd50 1125
45971686 1126 if (status) {
0d7fcd50 1127 dev_err(&spi->dev, "missing spi-present-mask");
45971686
LP
1128 return -ENODEV;
1129 }
97ddb1c8 1130 }
8f1cc3b1 1131 }
8f1cc3b1 1132
ce9bd0a0 1133 if (!pdata->spi_present_mask || pdata->spi_present_mask > 0xff) {
0d7fcd50
SR
1134 dev_err(&spi->dev, "invalid spi-present-mask");
1135 return -ENODEV;
1136 }
1137
ce9bd0a0
SR
1138 for (addr = 0; addr < MCP_MAX_DEV_PER_CS; addr++) {
1139 if (pdata->spi_present_mask & BIT(addr))
0d7fcd50
SR
1140 chips++;
1141 }
1142
99e4b98d
MW
1143 if (!chips)
1144 return -ENODEV;
1145
7898b31e
VB
1146 data = devm_kzalloc(&spi->dev,
1147 sizeof(*data) + chips * sizeof(struct mcp23s08),
1148 GFP_KERNEL);
8f1cc3b1
DB
1149 if (!data)
1150 return -ENOMEM;
7898b31e 1151
8f1cc3b1
DB
1152 spi_set_drvdata(spi, data);
1153
ce9bd0a0
SR
1154 for (addr = 0; addr < MCP_MAX_DEV_PER_CS; addr++) {
1155 if (!(pdata->spi_present_mask & BIT(addr)))
8f1cc3b1
DB
1156 continue;
1157 chips--;
1158 data->mcp[addr] = &data->chip[chips];
a231b88c 1159 data->mcp[addr]->irq = spi->irq;
d62b98f3 1160 status = mcp23s08_probe_one(data->mcp[addr], &spi->dev, spi,
5b1a7e80
SR
1161 0x40 | (addr << 1), type,
1162 pdata->base, addr);
8f1cc3b1 1163 if (status < 0)
d0e49dab 1164 return status;
0b7bb77f 1165
3af0dbd5 1166 if (pdata->base != -1)
28c5a41e
PR
1167 pdata->base += data->mcp[addr]->chip.ngpio;
1168 ngpio += data->mcp[addr]->chip.ngpio;
8f1cc3b1 1169 }
97ddb1c8 1170 data->ngpio = ngpio;
e58b9e27 1171
e58b9e27 1172 return 0;
e58b9e27
DB
1173}
1174
0b7bb77f
PK
1175static const struct spi_device_id mcp23s08_ids[] = {
1176 { "mcp23s08", MCP_TYPE_S08 },
1177 { "mcp23s17", MCP_TYPE_S17 },
28c5a41e 1178 { "mcp23s18", MCP_TYPE_S18 },
0b7bb77f
PK
1179 { },
1180};
1181MODULE_DEVICE_TABLE(spi, mcp23s08_ids);
1182
e58b9e27
DB
1183static struct spi_driver mcp23s08_driver = {
1184 .probe = mcp23s08_probe,
0b7bb77f 1185 .id_table = mcp23s08_ids,
e58b9e27
DB
1186 .driver = {
1187 .name = "mcp23s08",
97ddb1c8 1188 .of_match_table = of_match_ptr(mcp23s08_spi_of_match),
e58b9e27
DB
1189 },
1190};
1191
d62b98f3
PK
1192static int __init mcp23s08_spi_init(void)
1193{
1194 return spi_register_driver(&mcp23s08_driver);
1195}
1196
1197static void mcp23s08_spi_exit(void)
1198{
1199 spi_unregister_driver(&mcp23s08_driver);
1200}
1201
1202#else
1203
1204static int __init mcp23s08_spi_init(void) { return 0; }
1205static void mcp23s08_spi_exit(void) { }
1206
1207#endif /* CONFIG_SPI_MASTER */
1208
e58b9e27
DB
1209/*----------------------------------------------------------------------*/
1210
1211static int __init mcp23s08_init(void)
1212{
752ad5e8
PK
1213 int ret;
1214
1215 ret = mcp23s08_spi_init();
1216 if (ret)
1217 goto spi_fail;
1218
1219 ret = mcp23s08_i2c_init();
1220 if (ret)
1221 goto i2c_fail;
1222
1223 return 0;
1224
1225 i2c_fail:
1226 mcp23s08_spi_exit();
1227 spi_fail:
1228 return ret;
e58b9e27 1229}
752ad5e8 1230/* register after spi/i2c postcore initcall and before
673c0c00
DB
1231 * subsys initcalls that may rely on these GPIOs
1232 */
1233subsys_initcall(mcp23s08_init);
e58b9e27
DB
1234
1235static void __exit mcp23s08_exit(void)
1236{
d62b98f3 1237 mcp23s08_spi_exit();
752ad5e8 1238 mcp23s08_i2c_exit();
e58b9e27
DB
1239}
1240module_exit(mcp23s08_exit);
1241
1242MODULE_LICENSE("GPL");