Linux Audio

Check our new training course

Loading...
v4.6
   1/*
   2 * MCP23S08 SPI/I2C GPIO gpio expander driver
   3 *
   4 * The inputs and outputs of the mcp23s08, mcp23s17, mcp23008 and mcp23017 are
   5 * supported.
   6 * For the I2C versions of the chips (mcp23008 and mcp23017) generation of
   7 * interrupts is also supported.
   8 * The hardware of the SPI versions of the chips (mcp23s08 and mcp23s17) is
   9 * also capable of generating interrupts, but the linux driver does not
  10 * support that yet.
  11 */
  12
  13#include <linux/kernel.h>
  14#include <linux/device.h>
  15#include <linux/mutex.h>
  16#include <linux/module.h>
  17#include <linux/gpio.h>
  18#include <linux/i2c.h>
  19#include <linux/spi/spi.h>
  20#include <linux/spi/mcp23s08.h>
  21#include <linux/slab.h>
  22#include <asm/byteorder.h>
  23#include <linux/interrupt.h>
  24#include <linux/of_irq.h>
  25#include <linux/of_device.h>
  26
  27/**
  28 * MCP types supported by driver
  29 */
  30#define MCP_TYPE_S08	0
  31#define MCP_TYPE_S17	1
  32#define MCP_TYPE_008	2
  33#define MCP_TYPE_017	3
  34#define MCP_TYPE_S18    4
  35
  36/* Registers are all 8 bits wide.
  37 *
  38 * The mcp23s17 has twice as many bits, and can be configured to work
  39 * with either 16 bit registers or with two adjacent 8 bit banks.
  40 */
  41#define MCP_IODIR	0x00		/* init/reset:  all ones */
  42#define MCP_IPOL	0x01
  43#define MCP_GPINTEN	0x02
  44#define MCP_DEFVAL	0x03
  45#define MCP_INTCON	0x04
  46#define MCP_IOCON	0x05
  47#	define IOCON_MIRROR	(1 << 6)
  48#	define IOCON_SEQOP	(1 << 5)
  49#	define IOCON_HAEN	(1 << 3)
  50#	define IOCON_ODR	(1 << 2)
  51#	define IOCON_INTPOL	(1 << 1)
  52#	define IOCON_INTCC	(1)
  53#define MCP_GPPU	0x06
  54#define MCP_INTF	0x07
  55#define MCP_INTCAP	0x08
  56#define MCP_GPIO	0x09
  57#define MCP_OLAT	0x0a
  58
  59struct mcp23s08;
  60
  61struct mcp23s08_ops {
  62	int	(*read)(struct mcp23s08 *mcp, unsigned reg);
  63	int	(*write)(struct mcp23s08 *mcp, unsigned reg, unsigned val);
  64	int	(*read_regs)(struct mcp23s08 *mcp, unsigned reg,
  65			     u16 *vals, unsigned n);
  66};
  67
  68struct mcp23s08 {
  69	u8			addr;
  70	bool			irq_active_high;
  71
  72	u16			cache[11];
  73	u16			irq_rise;
  74	u16			irq_fall;
  75	int			irq;
  76	bool			irq_controller;
  77	/* lock protects the cached values */
  78	struct mutex		lock;
  79	struct mutex		irq_lock;
  80	struct irq_domain	*irq_domain;
  81
  82	struct gpio_chip	chip;
  83
  84	const struct mcp23s08_ops	*ops;
  85	void			*data; /* ops specific data */
  86};
  87
  88/* A given spi_device can represent up to eight mcp23sxx chips
  89 * sharing the same chipselect but using different addresses
  90 * (e.g. chips #0 and #3 might be populated, but not #1 or $2).
  91 * Driver data holds all the per-chip data.
  92 */
  93struct mcp23s08_driver_data {
  94	unsigned		ngpio;
  95	struct mcp23s08		*mcp[8];
  96	struct mcp23s08		chip[];
  97};
  98
  99/* This lock class tells lockdep that GPIO irqs are in a different
 100 * category than their parents, so it won't report false recursion.
 101 */
 102static struct lock_class_key gpio_lock_class;
 103
 104/*----------------------------------------------------------------------*/
 105
 106#if IS_ENABLED(CONFIG_I2C)
 107
 108static int mcp23008_read(struct mcp23s08 *mcp, unsigned reg)
 109{
 110	return i2c_smbus_read_byte_data(mcp->data, reg);
 111}
 112
 113static int mcp23008_write(struct mcp23s08 *mcp, unsigned reg, unsigned val)
 114{
 115	return i2c_smbus_write_byte_data(mcp->data, reg, val);
 116}
 117
 118static int
 119mcp23008_read_regs(struct mcp23s08 *mcp, unsigned reg, u16 *vals, unsigned n)
 120{
 121	while (n--) {
 122		int ret = mcp23008_read(mcp, reg++);
 123		if (ret < 0)
 124			return ret;
 125		*vals++ = ret;
 126	}
 127
 128	return 0;
 129}
 130
 131static int mcp23017_read(struct mcp23s08 *mcp, unsigned reg)
 132{
 133	return i2c_smbus_read_word_data(mcp->data, reg << 1);
 134}
 135
 136static int mcp23017_write(struct mcp23s08 *mcp, unsigned reg, unsigned val)
 137{
 138	return i2c_smbus_write_word_data(mcp->data, reg << 1, val);
 139}
 140
 141static int
 142mcp23017_read_regs(struct mcp23s08 *mcp, unsigned reg, u16 *vals, unsigned n)
 143{
 144	while (n--) {
 145		int ret = mcp23017_read(mcp, reg++);
 146		if (ret < 0)
 147			return ret;
 148		*vals++ = ret;
 149	}
 150
 151	return 0;
 152}
 153
 154static const struct mcp23s08_ops mcp23008_ops = {
 155	.read		= mcp23008_read,
 156	.write		= mcp23008_write,
 157	.read_regs	= mcp23008_read_regs,
 158};
 159
 160static const struct mcp23s08_ops mcp23017_ops = {
 161	.read		= mcp23017_read,
 162	.write		= mcp23017_write,
 163	.read_regs	= mcp23017_read_regs,
 164};
 165
 166#endif /* CONFIG_I2C */
 167
 168/*----------------------------------------------------------------------*/
 169
 170#ifdef CONFIG_SPI_MASTER
 171
 172static int mcp23s08_read(struct mcp23s08 *mcp, unsigned reg)
 173{
 174	u8	tx[2], rx[1];
 175	int	status;
 176
 177	tx[0] = mcp->addr | 0x01;
 178	tx[1] = reg;
 179	status = spi_write_then_read(mcp->data, tx, sizeof(tx), rx, sizeof(rx));
 180	return (status < 0) ? status : rx[0];
 181}
 182
 183static int mcp23s08_write(struct mcp23s08 *mcp, unsigned reg, unsigned val)
 184{
 185	u8	tx[3];
 186
 187	tx[0] = mcp->addr;
 188	tx[1] = reg;
 189	tx[2] = val;
 190	return spi_write_then_read(mcp->data, tx, sizeof(tx), NULL, 0);
 191}
 192
 193static int
 194mcp23s08_read_regs(struct mcp23s08 *mcp, unsigned reg, u16 *vals, unsigned n)
 195{
 196	u8	tx[2], *tmp;
 197	int	status;
 198
 199	if ((n + reg) > sizeof(mcp->cache))
 200		return -EINVAL;
 201	tx[0] = mcp->addr | 0x01;
 202	tx[1] = reg;
 203
 204	tmp = (u8 *)vals;
 205	status = spi_write_then_read(mcp->data, tx, sizeof(tx), tmp, n);
 206	if (status >= 0) {
 207		while (n--)
 208			vals[n] = tmp[n]; /* expand to 16bit */
 209	}
 210	return status;
 211}
 212
 213static int mcp23s17_read(struct mcp23s08 *mcp, unsigned reg)
 214{
 215	u8	tx[2], rx[2];
 216	int	status;
 217
 218	tx[0] = mcp->addr | 0x01;
 219	tx[1] = reg << 1;
 220	status = spi_write_then_read(mcp->data, tx, sizeof(tx), rx, sizeof(rx));
 221	return (status < 0) ? status : (rx[0] | (rx[1] << 8));
 222}
 223
 224static int mcp23s17_write(struct mcp23s08 *mcp, unsigned reg, unsigned val)
 225{
 226	u8	tx[4];
 227
 228	tx[0] = mcp->addr;
 229	tx[1] = reg << 1;
 230	tx[2] = val;
 231	tx[3] = val >> 8;
 232	return spi_write_then_read(mcp->data, tx, sizeof(tx), NULL, 0);
 233}
 234
 235static int
 236mcp23s17_read_regs(struct mcp23s08 *mcp, unsigned reg, u16 *vals, unsigned n)
 237{
 238	u8	tx[2];
 239	int	status;
 240
 241	if ((n + reg) > sizeof(mcp->cache))
 242		return -EINVAL;
 243	tx[0] = mcp->addr | 0x01;
 244	tx[1] = reg << 1;
 245
 246	status = spi_write_then_read(mcp->data, tx, sizeof(tx),
 247				     (u8 *)vals, n * 2);
 248	if (status >= 0) {
 249		while (n--)
 250			vals[n] = __le16_to_cpu((__le16)vals[n]);
 251	}
 252
 253	return status;
 254}
 255
 256static const struct mcp23s08_ops mcp23s08_ops = {
 257	.read		= mcp23s08_read,
 258	.write		= mcp23s08_write,
 259	.read_regs	= mcp23s08_read_regs,
 260};
 261
 262static const struct mcp23s08_ops mcp23s17_ops = {
 263	.read		= mcp23s17_read,
 264	.write		= mcp23s17_write,
 265	.read_regs	= mcp23s17_read_regs,
 266};
 267
 268#endif /* CONFIG_SPI_MASTER */
 269
 270/*----------------------------------------------------------------------*/
 271
 272static int mcp23s08_direction_input(struct gpio_chip *chip, unsigned offset)
 273{
 274	struct mcp23s08	*mcp = gpiochip_get_data(chip);
 275	int status;
 276
 277	mutex_lock(&mcp->lock);
 278	mcp->cache[MCP_IODIR] |= (1 << offset);
 279	status = mcp->ops->write(mcp, MCP_IODIR, mcp->cache[MCP_IODIR]);
 280	mutex_unlock(&mcp->lock);
 281	return status;
 282}
 283
 284static int mcp23s08_get(struct gpio_chip *chip, unsigned offset)
 285{
 286	struct mcp23s08	*mcp = gpiochip_get_data(chip);
 287	int status;
 288
 289	mutex_lock(&mcp->lock);
 290
 291	/* REVISIT reading this clears any IRQ ... */
 292	status = mcp->ops->read(mcp, MCP_GPIO);
 293	if (status < 0)
 294		status = 0;
 295	else {
 296		mcp->cache[MCP_GPIO] = status;
 297		status = !!(status & (1 << offset));
 298	}
 299	mutex_unlock(&mcp->lock);
 300	return status;
 301}
 302
 303static int __mcp23s08_set(struct mcp23s08 *mcp, unsigned mask, int value)
 304{
 305	unsigned olat = mcp->cache[MCP_OLAT];
 306
 307	if (value)
 308		olat |= mask;
 309	else
 310		olat &= ~mask;
 311	mcp->cache[MCP_OLAT] = olat;
 312	return mcp->ops->write(mcp, MCP_OLAT, olat);
 313}
 314
 315static void mcp23s08_set(struct gpio_chip *chip, unsigned offset, int value)
 316{
 317	struct mcp23s08	*mcp = gpiochip_get_data(chip);
 318	unsigned mask = 1 << offset;
 319
 320	mutex_lock(&mcp->lock);
 321	__mcp23s08_set(mcp, mask, value);
 322	mutex_unlock(&mcp->lock);
 323}
 324
 325static int
 326mcp23s08_direction_output(struct gpio_chip *chip, unsigned offset, int value)
 327{
 328	struct mcp23s08	*mcp = gpiochip_get_data(chip);
 329	unsigned mask = 1 << offset;
 330	int status;
 331
 332	mutex_lock(&mcp->lock);
 333	status = __mcp23s08_set(mcp, mask, value);
 334	if (status == 0) {
 335		mcp->cache[MCP_IODIR] &= ~mask;
 336		status = mcp->ops->write(mcp, MCP_IODIR, mcp->cache[MCP_IODIR]);
 337	}
 338	mutex_unlock(&mcp->lock);
 339	return status;
 340}
 341
 342/*----------------------------------------------------------------------*/
 343static irqreturn_t mcp23s08_irq(int irq, void *data)
 344{
 345	struct mcp23s08 *mcp = data;
 346	int intcap, intf, i;
 347	unsigned int child_irq;
 348
 349	mutex_lock(&mcp->lock);
 350	intf = mcp->ops->read(mcp, MCP_INTF);
 351	if (intf < 0) {
 352		mutex_unlock(&mcp->lock);
 353		return IRQ_HANDLED;
 354	}
 355
 356	mcp->cache[MCP_INTF] = intf;
 357
 358	intcap = mcp->ops->read(mcp, MCP_INTCAP);
 359	if (intcap < 0) {
 360		mutex_unlock(&mcp->lock);
 361		return IRQ_HANDLED;
 362	}
 363
 364	mcp->cache[MCP_INTCAP] = intcap;
 365	mutex_unlock(&mcp->lock);
 366
 367
 368	for (i = 0; i < mcp->chip.ngpio; i++) {
 369		if ((BIT(i) & mcp->cache[MCP_INTF]) &&
 370		    ((BIT(i) & intcap & mcp->irq_rise) ||
 371		     (mcp->irq_fall & ~intcap & BIT(i)))) {
 372			child_irq = irq_find_mapping(mcp->irq_domain, i);
 373			handle_nested_irq(child_irq);
 374		}
 375	}
 376
 377	return IRQ_HANDLED;
 378}
 379
 380static int mcp23s08_gpio_to_irq(struct gpio_chip *chip, unsigned offset)
 381{
 382	struct mcp23s08 *mcp = gpiochip_get_data(chip);
 383
 384	return irq_find_mapping(mcp->irq_domain, offset);
 385}
 386
 387static void mcp23s08_irq_mask(struct irq_data *data)
 388{
 389	struct mcp23s08 *mcp = irq_data_get_irq_chip_data(data);
 390	unsigned int pos = data->hwirq;
 391
 392	mcp->cache[MCP_GPINTEN] &= ~BIT(pos);
 393}
 394
 395static void mcp23s08_irq_unmask(struct irq_data *data)
 396{
 397	struct mcp23s08 *mcp = irq_data_get_irq_chip_data(data);
 398	unsigned int pos = data->hwirq;
 399
 400	mcp->cache[MCP_GPINTEN] |= BIT(pos);
 401}
 402
 403static int mcp23s08_irq_set_type(struct irq_data *data, unsigned int type)
 404{
 405	struct mcp23s08 *mcp = irq_data_get_irq_chip_data(data);
 406	unsigned int pos = data->hwirq;
 407	int status = 0;
 408
 409	if ((type & IRQ_TYPE_EDGE_BOTH) == IRQ_TYPE_EDGE_BOTH) {
 410		mcp->cache[MCP_INTCON] &= ~BIT(pos);
 411		mcp->irq_rise |= BIT(pos);
 412		mcp->irq_fall |= BIT(pos);
 413	} else if (type & IRQ_TYPE_EDGE_RISING) {
 414		mcp->cache[MCP_INTCON] &= ~BIT(pos);
 415		mcp->irq_rise |= BIT(pos);
 416		mcp->irq_fall &= ~BIT(pos);
 417	} else if (type & IRQ_TYPE_EDGE_FALLING) {
 418		mcp->cache[MCP_INTCON] &= ~BIT(pos);
 419		mcp->irq_rise &= ~BIT(pos);
 420		mcp->irq_fall |= BIT(pos);
 421	} else
 422		return -EINVAL;
 423
 424	return status;
 425}
 426
 427static void mcp23s08_irq_bus_lock(struct irq_data *data)
 428{
 429	struct mcp23s08 *mcp = irq_data_get_irq_chip_data(data);
 430
 431	mutex_lock(&mcp->irq_lock);
 432}
 433
 434static void mcp23s08_irq_bus_unlock(struct irq_data *data)
 435{
 436	struct mcp23s08 *mcp = irq_data_get_irq_chip_data(data);
 437
 438	mutex_lock(&mcp->lock);
 439	mcp->ops->write(mcp, MCP_GPINTEN, mcp->cache[MCP_GPINTEN]);
 440	mcp->ops->write(mcp, MCP_DEFVAL, mcp->cache[MCP_DEFVAL]);
 441	mcp->ops->write(mcp, MCP_INTCON, mcp->cache[MCP_INTCON]);
 442	mutex_unlock(&mcp->lock);
 443	mutex_unlock(&mcp->irq_lock);
 444}
 445
 446static int mcp23s08_irq_reqres(struct irq_data *data)
 447{
 448	struct mcp23s08 *mcp = irq_data_get_irq_chip_data(data);
 449
 450	if (gpiochip_lock_as_irq(&mcp->chip, data->hwirq)) {
 451		dev_err(mcp->chip.parent,
 452			"unable to lock HW IRQ %lu for IRQ usage\n",
 453			data->hwirq);
 454		return -EINVAL;
 455	}
 456
 457	return 0;
 458}
 459
 460static void mcp23s08_irq_relres(struct irq_data *data)
 461{
 462	struct mcp23s08 *mcp = irq_data_get_irq_chip_data(data);
 463
 464	gpiochip_unlock_as_irq(&mcp->chip, data->hwirq);
 465}
 466
 467static struct irq_chip mcp23s08_irq_chip = {
 468	.name = "gpio-mcp23xxx",
 469	.irq_mask = mcp23s08_irq_mask,
 470	.irq_unmask = mcp23s08_irq_unmask,
 471	.irq_set_type = mcp23s08_irq_set_type,
 472	.irq_bus_lock = mcp23s08_irq_bus_lock,
 473	.irq_bus_sync_unlock = mcp23s08_irq_bus_unlock,
 474	.irq_request_resources = mcp23s08_irq_reqres,
 475	.irq_release_resources = mcp23s08_irq_relres,
 476};
 477
 478static int mcp23s08_irq_setup(struct mcp23s08 *mcp)
 479{
 480	struct gpio_chip *chip = &mcp->chip;
 481	int err, irq, j;
 482	unsigned long irqflags = IRQF_ONESHOT | IRQF_SHARED;
 483
 484	mutex_init(&mcp->irq_lock);
 485
 486	mcp->irq_domain = irq_domain_add_linear(chip->parent->of_node,
 487						chip->ngpio,
 488						&irq_domain_simple_ops, mcp);
 489	if (!mcp->irq_domain)
 490		return -ENODEV;
 491
 492	if (mcp->irq_active_high)
 493		irqflags |= IRQF_TRIGGER_HIGH;
 494	else
 495		irqflags |= IRQF_TRIGGER_LOW;
 496
 497	err = devm_request_threaded_irq(chip->parent, mcp->irq, NULL,
 498					mcp23s08_irq,
 499					irqflags, dev_name(chip->parent), mcp);
 500	if (err != 0) {
 501		dev_err(chip->parent, "unable to request IRQ#%d: %d\n",
 502			mcp->irq, err);
 503		return err;
 504	}
 505
 506	chip->to_irq = mcp23s08_gpio_to_irq;
 507
 508	for (j = 0; j < mcp->chip.ngpio; j++) {
 509		irq = irq_create_mapping(mcp->irq_domain, j);
 510		irq_set_lockdep_class(irq, &gpio_lock_class);
 511		irq_set_chip_data(irq, mcp);
 512		irq_set_chip(irq, &mcp23s08_irq_chip);
 513		irq_set_nested_thread(irq, true);
 
 
 
 514		irq_set_noprobe(irq);
 
 515	}
 516	return 0;
 517}
 518
 519static void mcp23s08_irq_teardown(struct mcp23s08 *mcp)
 520{
 521	unsigned int irq, i;
 522
 
 
 523	for (i = 0; i < mcp->chip.ngpio; i++) {
 524		irq = irq_find_mapping(mcp->irq_domain, i);
 525		if (irq > 0)
 526			irq_dispose_mapping(irq);
 527	}
 528
 529	irq_domain_remove(mcp->irq_domain);
 530}
 531
 532/*----------------------------------------------------------------------*/
 533
 534#ifdef CONFIG_DEBUG_FS
 535
 536#include <linux/seq_file.h>
 537
 538/*
 539 * This shows more info than the generic gpio dump code:
 540 * pullups, deglitching, open drain drive.
 541 */
 542static void mcp23s08_dbg_show(struct seq_file *s, struct gpio_chip *chip)
 543{
 544	struct mcp23s08	*mcp;
 545	char		bank;
 546	int		t;
 547	unsigned	mask;
 548
 549	mcp = gpiochip_get_data(chip);
 550
 551	/* NOTE: we only handle one bank for now ... */
 552	bank = '0' + ((mcp->addr >> 1) & 0x7);
 553
 554	mutex_lock(&mcp->lock);
 555	t = mcp->ops->read_regs(mcp, 0, mcp->cache, ARRAY_SIZE(mcp->cache));
 556	if (t < 0) {
 557		seq_printf(s, " I/O ERROR %d\n", t);
 558		goto done;
 559	}
 560
 561	for (t = 0, mask = 1; t < chip->ngpio; t++, mask <<= 1) {
 562		const char	*label;
 563
 564		label = gpiochip_is_requested(chip, t);
 565		if (!label)
 566			continue;
 567
 568		seq_printf(s, " gpio-%-3d P%c.%d (%-12s) %s %s %s",
 569			chip->base + t, bank, t, label,
 570			(mcp->cache[MCP_IODIR] & mask) ? "in " : "out",
 571			(mcp->cache[MCP_GPIO] & mask) ? "hi" : "lo",
 572			(mcp->cache[MCP_GPPU] & mask) ? "up" : "  ");
 573		/* NOTE:  ignoring the irq-related registers */
 574		seq_puts(s, "\n");
 575	}
 576done:
 577	mutex_unlock(&mcp->lock);
 578}
 579
 580#else
 581#define mcp23s08_dbg_show	NULL
 582#endif
 583
 584/*----------------------------------------------------------------------*/
 585
 586static int mcp23s08_probe_one(struct mcp23s08 *mcp, struct device *dev,
 587			      void *data, unsigned addr, unsigned type,
 588			      struct mcp23s08_platform_data *pdata, int cs)
 589{
 590	int status;
 591	bool mirror = false;
 592
 593	mutex_init(&mcp->lock);
 594
 595	mcp->data = data;
 596	mcp->addr = addr;
 597	mcp->irq_active_high = false;
 598
 599	mcp->chip.direction_input = mcp23s08_direction_input;
 600	mcp->chip.get = mcp23s08_get;
 601	mcp->chip.direction_output = mcp23s08_direction_output;
 602	mcp->chip.set = mcp23s08_set;
 603	mcp->chip.dbg_show = mcp23s08_dbg_show;
 604#ifdef CONFIG_OF
 605	mcp->chip.of_gpio_n_cells = 2;
 606	mcp->chip.of_node = dev->of_node;
 607#endif
 608
 609	switch (type) {
 610#ifdef CONFIG_SPI_MASTER
 611	case MCP_TYPE_S08:
 612		mcp->ops = &mcp23s08_ops;
 613		mcp->chip.ngpio = 8;
 614		mcp->chip.label = "mcp23s08";
 615		break;
 616
 617	case MCP_TYPE_S17:
 618		mcp->ops = &mcp23s17_ops;
 619		mcp->chip.ngpio = 16;
 620		mcp->chip.label = "mcp23s17";
 621		break;
 622
 623	case MCP_TYPE_S18:
 624		mcp->ops = &mcp23s17_ops;
 625		mcp->chip.ngpio = 16;
 626		mcp->chip.label = "mcp23s18";
 627		break;
 628#endif /* CONFIG_SPI_MASTER */
 629
 630#if IS_ENABLED(CONFIG_I2C)
 631	case MCP_TYPE_008:
 632		mcp->ops = &mcp23008_ops;
 633		mcp->chip.ngpio = 8;
 634		mcp->chip.label = "mcp23008";
 635		break;
 636
 637	case MCP_TYPE_017:
 638		mcp->ops = &mcp23017_ops;
 639		mcp->chip.ngpio = 16;
 640		mcp->chip.label = "mcp23017";
 641		break;
 642#endif /* CONFIG_I2C */
 643
 644	default:
 645		dev_err(dev, "invalid device type (%d)\n", type);
 646		return -EINVAL;
 647	}
 648
 649	mcp->chip.base = pdata->base;
 650	mcp->chip.can_sleep = true;
 651	mcp->chip.parent = dev;
 652	mcp->chip.owner = THIS_MODULE;
 653
 654	/* verify MCP_IOCON.SEQOP = 0, so sequential reads work,
 655	 * and MCP_IOCON.HAEN = 1, so we work with all chips.
 656	 */
 657
 658	status = mcp->ops->read(mcp, MCP_IOCON);
 659	if (status < 0)
 660		goto fail;
 661
 662	mcp->irq_controller = pdata->irq_controller;
 663	if (mcp->irq && mcp->irq_controller) {
 664		mcp->irq_active_high =
 665			of_property_read_bool(mcp->chip.parent->of_node,
 666					      "microchip,irq-active-high");
 667
 668		mirror = pdata->mirror;
 669	}
 670
 671	if ((status & IOCON_SEQOP) || !(status & IOCON_HAEN) || mirror ||
 672	     mcp->irq_active_high) {
 673		/* mcp23s17 has IOCON twice, make sure they are in sync */
 674		status &= ~(IOCON_SEQOP | (IOCON_SEQOP << 8));
 675		status |= IOCON_HAEN | (IOCON_HAEN << 8);
 676		if (mcp->irq_active_high)
 677			status |= IOCON_INTPOL | (IOCON_INTPOL << 8);
 678		else
 679			status &= ~(IOCON_INTPOL | (IOCON_INTPOL << 8));
 680
 681		if (mirror)
 682			status |= IOCON_MIRROR | (IOCON_MIRROR << 8);
 683
 684		if (type == MCP_TYPE_S18)
 685			status |= IOCON_INTCC | (IOCON_INTCC << 8);
 686
 687		status = mcp->ops->write(mcp, MCP_IOCON, status);
 688		if (status < 0)
 689			goto fail;
 690	}
 691
 692	/* configure ~100K pullups */
 693	status = mcp->ops->write(mcp, MCP_GPPU, pdata->chip[cs].pullups);
 694	if (status < 0)
 695		goto fail;
 696
 697	status = mcp->ops->read_regs(mcp, 0, mcp->cache, ARRAY_SIZE(mcp->cache));
 698	if (status < 0)
 699		goto fail;
 700
 701	/* disable inverter on input */
 702	if (mcp->cache[MCP_IPOL] != 0) {
 703		mcp->cache[MCP_IPOL] = 0;
 704		status = mcp->ops->write(mcp, MCP_IPOL, 0);
 705		if (status < 0)
 706			goto fail;
 707	}
 708
 709	/* disable irqs */
 710	if (mcp->cache[MCP_GPINTEN] != 0) {
 711		mcp->cache[MCP_GPINTEN] = 0;
 712		status = mcp->ops->write(mcp, MCP_GPINTEN, 0);
 713		if (status < 0)
 714			goto fail;
 715	}
 716
 717	status = gpiochip_add_data(&mcp->chip, mcp);
 718	if (status < 0)
 719		goto fail;
 720
 721	if (mcp->irq && mcp->irq_controller) {
 722		status = mcp23s08_irq_setup(mcp);
 723		if (status) {
 724			mcp23s08_irq_teardown(mcp);
 725			goto fail;
 726		}
 727	}
 728fail:
 729	if (status < 0)
 730		dev_dbg(dev, "can't setup chip %d, --> %d\n",
 731			addr, status);
 732	return status;
 733}
 734
 735/*----------------------------------------------------------------------*/
 736
 737#ifdef CONFIG_OF
 738#ifdef CONFIG_SPI_MASTER
 739static const struct of_device_id mcp23s08_spi_of_match[] = {
 740	{
 741		.compatible = "microchip,mcp23s08",
 742		.data = (void *) MCP_TYPE_S08,
 743	},
 744	{
 745		.compatible = "microchip,mcp23s17",
 746		.data = (void *) MCP_TYPE_S17,
 747	},
 748	{
 749		.compatible = "microchip,mcp23s18",
 750		.data = (void *) MCP_TYPE_S18,
 751	},
 752/* NOTE: The use of the mcp prefix is deprecated and will be removed. */
 753	{
 754		.compatible = "mcp,mcp23s08",
 755		.data = (void *) MCP_TYPE_S08,
 756	},
 757	{
 758		.compatible = "mcp,mcp23s17",
 759		.data = (void *) MCP_TYPE_S17,
 760	},
 761	{ },
 762};
 763MODULE_DEVICE_TABLE(of, mcp23s08_spi_of_match);
 764#endif
 765
 766#if IS_ENABLED(CONFIG_I2C)
 767static const struct of_device_id mcp23s08_i2c_of_match[] = {
 768	{
 769		.compatible = "microchip,mcp23008",
 770		.data = (void *) MCP_TYPE_008,
 771	},
 772	{
 773		.compatible = "microchip,mcp23017",
 774		.data = (void *) MCP_TYPE_017,
 775	},
 776/* NOTE: The use of the mcp prefix is deprecated and will be removed. */
 777	{
 778		.compatible = "mcp,mcp23008",
 779		.data = (void *) MCP_TYPE_008,
 780	},
 781	{
 782		.compatible = "mcp,mcp23017",
 783		.data = (void *) MCP_TYPE_017,
 784	},
 785	{ },
 786};
 787MODULE_DEVICE_TABLE(of, mcp23s08_i2c_of_match);
 788#endif
 789#endif /* CONFIG_OF */
 790
 791
 792#if IS_ENABLED(CONFIG_I2C)
 793
 794static int mcp230xx_probe(struct i2c_client *client,
 795				    const struct i2c_device_id *id)
 796{
 797	struct mcp23s08_platform_data *pdata, local_pdata;
 798	struct mcp23s08 *mcp;
 799	int status;
 800	const struct of_device_id *match;
 801
 802	match = of_match_device(of_match_ptr(mcp23s08_i2c_of_match),
 803					&client->dev);
 804	if (match) {
 805		pdata = &local_pdata;
 806		pdata->base = -1;
 807		pdata->chip[0].pullups = 0;
 808		pdata->irq_controller =	of_property_read_bool(
 809					client->dev.of_node,
 810					"interrupt-controller");
 811		pdata->mirror = of_property_read_bool(client->dev.of_node,
 812						      "microchip,irq-mirror");
 813		client->irq = irq_of_parse_and_map(client->dev.of_node, 0);
 814	} else {
 815		pdata = dev_get_platdata(&client->dev);
 816		if (!pdata) {
 817			pdata = devm_kzalloc(&client->dev,
 818					sizeof(struct mcp23s08_platform_data),
 819					GFP_KERNEL);
 820			if (!pdata)
 821				return -ENOMEM;
 822			pdata->base = -1;
 823		}
 
 
 824	}
 825
 826	mcp = kzalloc(sizeof(*mcp), GFP_KERNEL);
 827	if (!mcp)
 828		return -ENOMEM;
 829
 830	mcp->irq = client->irq;
 831	status = mcp23s08_probe_one(mcp, &client->dev, client, client->addr,
 832				    id->driver_data, pdata, 0);
 833	if (status)
 834		goto fail;
 835
 836	i2c_set_clientdata(client, mcp);
 837
 838	return 0;
 839
 840fail:
 841	kfree(mcp);
 842
 843	return status;
 844}
 845
 846static int mcp230xx_remove(struct i2c_client *client)
 847{
 848	struct mcp23s08 *mcp = i2c_get_clientdata(client);
 
 849
 850	if (client->irq && mcp->irq_controller)
 851		mcp23s08_irq_teardown(mcp);
 852
 853	gpiochip_remove(&mcp->chip);
 854	kfree(mcp);
 
 855
 856	return 0;
 857}
 858
 859static const struct i2c_device_id mcp230xx_id[] = {
 860	{ "mcp23008", MCP_TYPE_008 },
 861	{ "mcp23017", MCP_TYPE_017 },
 862	{ },
 863};
 864MODULE_DEVICE_TABLE(i2c, mcp230xx_id);
 865
 866static struct i2c_driver mcp230xx_driver = {
 867	.driver = {
 868		.name	= "mcp230xx",
 
 869		.of_match_table = of_match_ptr(mcp23s08_i2c_of_match),
 870	},
 871	.probe		= mcp230xx_probe,
 872	.remove		= mcp230xx_remove,
 873	.id_table	= mcp230xx_id,
 874};
 875
 876static int __init mcp23s08_i2c_init(void)
 877{
 878	return i2c_add_driver(&mcp230xx_driver);
 879}
 880
 881static void mcp23s08_i2c_exit(void)
 882{
 883	i2c_del_driver(&mcp230xx_driver);
 884}
 885
 886#else
 887
 888static int __init mcp23s08_i2c_init(void) { return 0; }
 889static void mcp23s08_i2c_exit(void) { }
 890
 891#endif /* CONFIG_I2C */
 892
 893/*----------------------------------------------------------------------*/
 894
 895#ifdef CONFIG_SPI_MASTER
 896
 897static int mcp23s08_probe(struct spi_device *spi)
 898{
 899	struct mcp23s08_platform_data	*pdata, local_pdata;
 900	unsigned			addr;
 901	int				chips = 0;
 902	struct mcp23s08_driver_data	*data;
 903	int				status, type;
 904	unsigned			ngpio = 0;
 
 
 905	const struct			of_device_id *match;
 906	u32				spi_present_mask = 0;
 907
 908	match = of_match_device(of_match_ptr(mcp23s08_spi_of_match), &spi->dev);
 909	if (match) {
 910		type = (int)(uintptr_t)match->data;
 911		status = of_property_read_u32(spi->dev.of_node,
 912			    "microchip,spi-present-mask", &spi_present_mask);
 913		if (status) {
 914			status = of_property_read_u32(spi->dev.of_node,
 915				    "mcp,spi-present-mask", &spi_present_mask);
 916			if (status) {
 917				dev_err(&spi->dev,
 918					"DT has no spi-present-mask\n");
 919				return -ENODEV;
 920			}
 921		}
 922		if ((spi_present_mask <= 0) || (spi_present_mask >= 256)) {
 923			dev_err(&spi->dev, "invalid spi-present-mask\n");
 924			return -ENODEV;
 925		}
 926
 927		pdata = &local_pdata;
 928		pdata->base = -1;
 929		for (addr = 0; addr < ARRAY_SIZE(pdata->chip); addr++) {
 930			pdata->chip[addr].pullups = 0;
 931			if (spi_present_mask & (1 << addr))
 932				chips++;
 
 933		}
 934		pdata->irq_controller =	of_property_read_bool(
 935					spi->dev.of_node,
 936					"interrupt-controller");
 937		pdata->mirror = of_property_read_bool(spi->dev.of_node,
 938						      "microchip,irq-mirror");
 939	} else {
 940		type = spi_get_device_id(spi)->driver_data;
 941		pdata = dev_get_platdata(&spi->dev);
 942		if (!pdata) {
 943			pdata = devm_kzalloc(&spi->dev,
 944					sizeof(struct mcp23s08_platform_data),
 945					GFP_KERNEL);
 946			pdata->base = -1;
 947		}
 948
 949		for (addr = 0; addr < ARRAY_SIZE(pdata->chip); addr++) {
 950			if (!pdata->chip[addr].is_present)
 951				continue;
 952			chips++;
 953			if ((type == MCP_TYPE_S08) && (addr > 3)) {
 954				dev_err(&spi->dev,
 955					"mcp23s08 only supports address 0..3\n");
 956				return -EINVAL;
 957			}
 958			spi_present_mask |= 1 << addr;
 
 959		}
 
 
 960	}
 961
 962	if (!chips)
 963		return -ENODEV;
 964
 965	data = devm_kzalloc(&spi->dev,
 966			    sizeof(*data) + chips * sizeof(struct mcp23s08),
 967			    GFP_KERNEL);
 968	if (!data)
 969		return -ENOMEM;
 970
 971	spi_set_drvdata(spi, data);
 972
 973	spi->irq = irq_of_parse_and_map(spi->dev.of_node, 0);
 974
 975	for (addr = 0; addr < ARRAY_SIZE(pdata->chip); addr++) {
 976		if (!(spi_present_mask & (1 << addr)))
 977			continue;
 978		chips--;
 979		data->mcp[addr] = &data->chip[chips];
 980		data->mcp[addr]->irq = spi->irq;
 981		status = mcp23s08_probe_one(data->mcp[addr], &spi->dev, spi,
 982					    0x40 | (addr << 1), type, pdata,
 983					    addr);
 984		if (status < 0)
 985			goto fail;
 986
 987		if (pdata->base != -1)
 988			pdata->base += data->mcp[addr]->chip.ngpio;
 989		ngpio += data->mcp[addr]->chip.ngpio;
 990	}
 991	data->ngpio = ngpio;
 992
 993	/* NOTE:  these chips have a relatively sane IRQ framework, with
 994	 * per-signal masking and level/edge triggering.  It's not yet
 995	 * handled here...
 996	 */
 997
 998	return 0;
 999
1000fail:
1001	for (addr = 0; addr < ARRAY_SIZE(data->mcp); addr++) {
 
1002
1003		if (!data->mcp[addr])
1004			continue;
1005		gpiochip_remove(&data->mcp[addr]->chip);
 
 
1006	}
 
1007	return status;
1008}
1009
1010static int mcp23s08_remove(struct spi_device *spi)
1011{
1012	struct mcp23s08_driver_data	*data = spi_get_drvdata(spi);
1013	unsigned			addr;
 
1014
1015	for (addr = 0; addr < ARRAY_SIZE(data->mcp); addr++) {
 
1016
1017		if (!data->mcp[addr])
1018			continue;
1019
1020		if (spi->irq && data->mcp[addr]->irq_controller)
1021			mcp23s08_irq_teardown(data->mcp[addr]);
1022		gpiochip_remove(&data->mcp[addr]->chip);
 
 
1023	}
1024
1025	return 0;
 
1026}
1027
1028static const struct spi_device_id mcp23s08_ids[] = {
1029	{ "mcp23s08", MCP_TYPE_S08 },
1030	{ "mcp23s17", MCP_TYPE_S17 },
1031	{ "mcp23s18", MCP_TYPE_S18 },
1032	{ },
1033};
1034MODULE_DEVICE_TABLE(spi, mcp23s08_ids);
1035
1036static struct spi_driver mcp23s08_driver = {
1037	.probe		= mcp23s08_probe,
1038	.remove		= mcp23s08_remove,
1039	.id_table	= mcp23s08_ids,
1040	.driver = {
1041		.name	= "mcp23s08",
 
1042		.of_match_table = of_match_ptr(mcp23s08_spi_of_match),
1043	},
1044};
1045
1046static int __init mcp23s08_spi_init(void)
1047{
1048	return spi_register_driver(&mcp23s08_driver);
1049}
1050
1051static void mcp23s08_spi_exit(void)
1052{
1053	spi_unregister_driver(&mcp23s08_driver);
1054}
1055
1056#else
1057
1058static int __init mcp23s08_spi_init(void) { return 0; }
1059static void mcp23s08_spi_exit(void) { }
1060
1061#endif /* CONFIG_SPI_MASTER */
1062
1063/*----------------------------------------------------------------------*/
1064
1065static int __init mcp23s08_init(void)
1066{
1067	int ret;
1068
1069	ret = mcp23s08_spi_init();
1070	if (ret)
1071		goto spi_fail;
1072
1073	ret = mcp23s08_i2c_init();
1074	if (ret)
1075		goto i2c_fail;
1076
1077	return 0;
1078
1079 i2c_fail:
1080	mcp23s08_spi_exit();
1081 spi_fail:
1082	return ret;
1083}
1084/* register after spi/i2c postcore initcall and before
1085 * subsys initcalls that may rely on these GPIOs
1086 */
1087subsys_initcall(mcp23s08_init);
1088
1089static void __exit mcp23s08_exit(void)
1090{
1091	mcp23s08_spi_exit();
1092	mcp23s08_i2c_exit();
1093}
1094module_exit(mcp23s08_exit);
1095
1096MODULE_LICENSE("GPL");
v3.15
   1/*
   2 * MCP23S08 SPI/I2C GPIO gpio expander driver
   3 *
   4 * The inputs and outputs of the mcp23s08, mcp23s17, mcp23008 and mcp23017 are
   5 * supported.
   6 * For the I2C versions of the chips (mcp23008 and mcp23017) generation of
   7 * interrupts is also supported.
   8 * The hardware of the SPI versions of the chips (mcp23s08 and mcp23s17) is
   9 * also capable of generating interrupts, but the linux driver does not
  10 * support that yet.
  11 */
  12
  13#include <linux/kernel.h>
  14#include <linux/device.h>
  15#include <linux/mutex.h>
  16#include <linux/module.h>
  17#include <linux/gpio.h>
  18#include <linux/i2c.h>
  19#include <linux/spi/spi.h>
  20#include <linux/spi/mcp23s08.h>
  21#include <linux/slab.h>
  22#include <asm/byteorder.h>
  23#include <linux/interrupt.h>
  24#include <linux/of_irq.h>
  25#include <linux/of_device.h>
  26
  27/**
  28 * MCP types supported by driver
  29 */
  30#define MCP_TYPE_S08	0
  31#define MCP_TYPE_S17	1
  32#define MCP_TYPE_008	2
  33#define MCP_TYPE_017	3
 
  34
  35/* Registers are all 8 bits wide.
  36 *
  37 * The mcp23s17 has twice as many bits, and can be configured to work
  38 * with either 16 bit registers or with two adjacent 8 bit banks.
  39 */
  40#define MCP_IODIR	0x00		/* init/reset:  all ones */
  41#define MCP_IPOL	0x01
  42#define MCP_GPINTEN	0x02
  43#define MCP_DEFVAL	0x03
  44#define MCP_INTCON	0x04
  45#define MCP_IOCON	0x05
  46#	define IOCON_MIRROR	(1 << 6)
  47#	define IOCON_SEQOP	(1 << 5)
  48#	define IOCON_HAEN	(1 << 3)
  49#	define IOCON_ODR	(1 << 2)
  50#	define IOCON_INTPOL	(1 << 1)
 
  51#define MCP_GPPU	0x06
  52#define MCP_INTF	0x07
  53#define MCP_INTCAP	0x08
  54#define MCP_GPIO	0x09
  55#define MCP_OLAT	0x0a
  56
  57struct mcp23s08;
  58
  59struct mcp23s08_ops {
  60	int	(*read)(struct mcp23s08 *mcp, unsigned reg);
  61	int	(*write)(struct mcp23s08 *mcp, unsigned reg, unsigned val);
  62	int	(*read_regs)(struct mcp23s08 *mcp, unsigned reg,
  63			     u16 *vals, unsigned n);
  64};
  65
  66struct mcp23s08 {
  67	u8			addr;
 
  68
  69	u16			cache[11];
  70	u16			irq_rise;
  71	u16			irq_fall;
  72	int			irq;
  73	bool			irq_controller;
  74	/* lock protects the cached values */
  75	struct mutex		lock;
  76	struct mutex		irq_lock;
  77	struct irq_domain	*irq_domain;
  78
  79	struct gpio_chip	chip;
  80
  81	const struct mcp23s08_ops	*ops;
  82	void			*data; /* ops specific data */
  83};
  84
  85/* A given spi_device can represent up to eight mcp23sxx chips
  86 * sharing the same chipselect but using different addresses
  87 * (e.g. chips #0 and #3 might be populated, but not #1 or $2).
  88 * Driver data holds all the per-chip data.
  89 */
  90struct mcp23s08_driver_data {
  91	unsigned		ngpio;
  92	struct mcp23s08		*mcp[8];
  93	struct mcp23s08		chip[];
  94};
  95
  96/* This lock class tells lockdep that GPIO irqs are in a different
  97 * category than their parents, so it won't report false recursion.
  98 */
  99static struct lock_class_key gpio_lock_class;
 100
 101/*----------------------------------------------------------------------*/
 102
 103#if IS_ENABLED(CONFIG_I2C)
 104
 105static int mcp23008_read(struct mcp23s08 *mcp, unsigned reg)
 106{
 107	return i2c_smbus_read_byte_data(mcp->data, reg);
 108}
 109
 110static int mcp23008_write(struct mcp23s08 *mcp, unsigned reg, unsigned val)
 111{
 112	return i2c_smbus_write_byte_data(mcp->data, reg, val);
 113}
 114
 115static int
 116mcp23008_read_regs(struct mcp23s08 *mcp, unsigned reg, u16 *vals, unsigned n)
 117{
 118	while (n--) {
 119		int ret = mcp23008_read(mcp, reg++);
 120		if (ret < 0)
 121			return ret;
 122		*vals++ = ret;
 123	}
 124
 125	return 0;
 126}
 127
 128static int mcp23017_read(struct mcp23s08 *mcp, unsigned reg)
 129{
 130	return i2c_smbus_read_word_data(mcp->data, reg << 1);
 131}
 132
 133static int mcp23017_write(struct mcp23s08 *mcp, unsigned reg, unsigned val)
 134{
 135	return i2c_smbus_write_word_data(mcp->data, reg << 1, val);
 136}
 137
 138static int
 139mcp23017_read_regs(struct mcp23s08 *mcp, unsigned reg, u16 *vals, unsigned n)
 140{
 141	while (n--) {
 142		int ret = mcp23017_read(mcp, reg++);
 143		if (ret < 0)
 144			return ret;
 145		*vals++ = ret;
 146	}
 147
 148	return 0;
 149}
 150
 151static const struct mcp23s08_ops mcp23008_ops = {
 152	.read		= mcp23008_read,
 153	.write		= mcp23008_write,
 154	.read_regs	= mcp23008_read_regs,
 155};
 156
 157static const struct mcp23s08_ops mcp23017_ops = {
 158	.read		= mcp23017_read,
 159	.write		= mcp23017_write,
 160	.read_regs	= mcp23017_read_regs,
 161};
 162
 163#endif /* CONFIG_I2C */
 164
 165/*----------------------------------------------------------------------*/
 166
 167#ifdef CONFIG_SPI_MASTER
 168
 169static int mcp23s08_read(struct mcp23s08 *mcp, unsigned reg)
 170{
 171	u8	tx[2], rx[1];
 172	int	status;
 173
 174	tx[0] = mcp->addr | 0x01;
 175	tx[1] = reg;
 176	status = spi_write_then_read(mcp->data, tx, sizeof(tx), rx, sizeof(rx));
 177	return (status < 0) ? status : rx[0];
 178}
 179
 180static int mcp23s08_write(struct mcp23s08 *mcp, unsigned reg, unsigned val)
 181{
 182	u8	tx[3];
 183
 184	tx[0] = mcp->addr;
 185	tx[1] = reg;
 186	tx[2] = val;
 187	return spi_write_then_read(mcp->data, tx, sizeof(tx), NULL, 0);
 188}
 189
 190static int
 191mcp23s08_read_regs(struct mcp23s08 *mcp, unsigned reg, u16 *vals, unsigned n)
 192{
 193	u8	tx[2], *tmp;
 194	int	status;
 195
 196	if ((n + reg) > sizeof(mcp->cache))
 197		return -EINVAL;
 198	tx[0] = mcp->addr | 0x01;
 199	tx[1] = reg;
 200
 201	tmp = (u8 *)vals;
 202	status = spi_write_then_read(mcp->data, tx, sizeof(tx), tmp, n);
 203	if (status >= 0) {
 204		while (n--)
 205			vals[n] = tmp[n]; /* expand to 16bit */
 206	}
 207	return status;
 208}
 209
 210static int mcp23s17_read(struct mcp23s08 *mcp, unsigned reg)
 211{
 212	u8	tx[2], rx[2];
 213	int	status;
 214
 215	tx[0] = mcp->addr | 0x01;
 216	tx[1] = reg << 1;
 217	status = spi_write_then_read(mcp->data, tx, sizeof(tx), rx, sizeof(rx));
 218	return (status < 0) ? status : (rx[0] | (rx[1] << 8));
 219}
 220
 221static int mcp23s17_write(struct mcp23s08 *mcp, unsigned reg, unsigned val)
 222{
 223	u8	tx[4];
 224
 225	tx[0] = mcp->addr;
 226	tx[1] = reg << 1;
 227	tx[2] = val;
 228	tx[3] = val >> 8;
 229	return spi_write_then_read(mcp->data, tx, sizeof(tx), NULL, 0);
 230}
 231
 232static int
 233mcp23s17_read_regs(struct mcp23s08 *mcp, unsigned reg, u16 *vals, unsigned n)
 234{
 235	u8	tx[2];
 236	int	status;
 237
 238	if ((n + reg) > sizeof(mcp->cache))
 239		return -EINVAL;
 240	tx[0] = mcp->addr | 0x01;
 241	tx[1] = reg << 1;
 242
 243	status = spi_write_then_read(mcp->data, tx, sizeof(tx),
 244				     (u8 *)vals, n * 2);
 245	if (status >= 0) {
 246		while (n--)
 247			vals[n] = __le16_to_cpu((__le16)vals[n]);
 248	}
 249
 250	return status;
 251}
 252
 253static const struct mcp23s08_ops mcp23s08_ops = {
 254	.read		= mcp23s08_read,
 255	.write		= mcp23s08_write,
 256	.read_regs	= mcp23s08_read_regs,
 257};
 258
 259static const struct mcp23s08_ops mcp23s17_ops = {
 260	.read		= mcp23s17_read,
 261	.write		= mcp23s17_write,
 262	.read_regs	= mcp23s17_read_regs,
 263};
 264
 265#endif /* CONFIG_SPI_MASTER */
 266
 267/*----------------------------------------------------------------------*/
 268
 269static int mcp23s08_direction_input(struct gpio_chip *chip, unsigned offset)
 270{
 271	struct mcp23s08	*mcp = container_of(chip, struct mcp23s08, chip);
 272	int status;
 273
 274	mutex_lock(&mcp->lock);
 275	mcp->cache[MCP_IODIR] |= (1 << offset);
 276	status = mcp->ops->write(mcp, MCP_IODIR, mcp->cache[MCP_IODIR]);
 277	mutex_unlock(&mcp->lock);
 278	return status;
 279}
 280
 281static int mcp23s08_get(struct gpio_chip *chip, unsigned offset)
 282{
 283	struct mcp23s08	*mcp = container_of(chip, struct mcp23s08, chip);
 284	int status;
 285
 286	mutex_lock(&mcp->lock);
 287
 288	/* REVISIT reading this clears any IRQ ... */
 289	status = mcp->ops->read(mcp, MCP_GPIO);
 290	if (status < 0)
 291		status = 0;
 292	else {
 293		mcp->cache[MCP_GPIO] = status;
 294		status = !!(status & (1 << offset));
 295	}
 296	mutex_unlock(&mcp->lock);
 297	return status;
 298}
 299
 300static int __mcp23s08_set(struct mcp23s08 *mcp, unsigned mask, int value)
 301{
 302	unsigned olat = mcp->cache[MCP_OLAT];
 303
 304	if (value)
 305		olat |= mask;
 306	else
 307		olat &= ~mask;
 308	mcp->cache[MCP_OLAT] = olat;
 309	return mcp->ops->write(mcp, MCP_OLAT, olat);
 310}
 311
 312static void mcp23s08_set(struct gpio_chip *chip, unsigned offset, int value)
 313{
 314	struct mcp23s08	*mcp = container_of(chip, struct mcp23s08, chip);
 315	unsigned mask = 1 << offset;
 316
 317	mutex_lock(&mcp->lock);
 318	__mcp23s08_set(mcp, mask, value);
 319	mutex_unlock(&mcp->lock);
 320}
 321
 322static int
 323mcp23s08_direction_output(struct gpio_chip *chip, unsigned offset, int value)
 324{
 325	struct mcp23s08	*mcp = container_of(chip, struct mcp23s08, chip);
 326	unsigned mask = 1 << offset;
 327	int status;
 328
 329	mutex_lock(&mcp->lock);
 330	status = __mcp23s08_set(mcp, mask, value);
 331	if (status == 0) {
 332		mcp->cache[MCP_IODIR] &= ~mask;
 333		status = mcp->ops->write(mcp, MCP_IODIR, mcp->cache[MCP_IODIR]);
 334	}
 335	mutex_unlock(&mcp->lock);
 336	return status;
 337}
 338
 339/*----------------------------------------------------------------------*/
 340static irqreturn_t mcp23s08_irq(int irq, void *data)
 341{
 342	struct mcp23s08 *mcp = data;
 343	int intcap, intf, i;
 344	unsigned int child_irq;
 345
 346	mutex_lock(&mcp->lock);
 347	intf = mcp->ops->read(mcp, MCP_INTF);
 348	if (intf < 0) {
 349		mutex_unlock(&mcp->lock);
 350		return IRQ_HANDLED;
 351	}
 352
 353	mcp->cache[MCP_INTF] = intf;
 354
 355	intcap = mcp->ops->read(mcp, MCP_INTCAP);
 356	if (intcap < 0) {
 357		mutex_unlock(&mcp->lock);
 358		return IRQ_HANDLED;
 359	}
 360
 361	mcp->cache[MCP_INTCAP] = intcap;
 362	mutex_unlock(&mcp->lock);
 363
 364
 365	for (i = 0; i < mcp->chip.ngpio; i++) {
 366		if ((BIT(i) & mcp->cache[MCP_INTF]) &&
 367		    ((BIT(i) & intcap & mcp->irq_rise) ||
 368		     (mcp->irq_fall & ~intcap & BIT(i)))) {
 369			child_irq = irq_find_mapping(mcp->irq_domain, i);
 370			handle_nested_irq(child_irq);
 371		}
 372	}
 373
 374	return IRQ_HANDLED;
 375}
 376
 377static int mcp23s08_gpio_to_irq(struct gpio_chip *chip, unsigned offset)
 378{
 379	struct mcp23s08 *mcp = container_of(chip, struct mcp23s08, chip);
 380
 381	return irq_find_mapping(mcp->irq_domain, offset);
 382}
 383
 384static void mcp23s08_irq_mask(struct irq_data *data)
 385{
 386	struct mcp23s08 *mcp = irq_data_get_irq_chip_data(data);
 387	unsigned int pos = data->hwirq;
 388
 389	mcp->cache[MCP_GPINTEN] &= ~BIT(pos);
 390}
 391
 392static void mcp23s08_irq_unmask(struct irq_data *data)
 393{
 394	struct mcp23s08 *mcp = irq_data_get_irq_chip_data(data);
 395	unsigned int pos = data->hwirq;
 396
 397	mcp->cache[MCP_GPINTEN] |= BIT(pos);
 398}
 399
 400static int mcp23s08_irq_set_type(struct irq_data *data, unsigned int type)
 401{
 402	struct mcp23s08 *mcp = irq_data_get_irq_chip_data(data);
 403	unsigned int pos = data->hwirq;
 404	int status = 0;
 405
 406	if ((type & IRQ_TYPE_EDGE_BOTH) == IRQ_TYPE_EDGE_BOTH) {
 407		mcp->cache[MCP_INTCON] &= ~BIT(pos);
 408		mcp->irq_rise |= BIT(pos);
 409		mcp->irq_fall |= BIT(pos);
 410	} else if (type & IRQ_TYPE_EDGE_RISING) {
 411		mcp->cache[MCP_INTCON] &= ~BIT(pos);
 412		mcp->irq_rise |= BIT(pos);
 413		mcp->irq_fall &= ~BIT(pos);
 414	} else if (type & IRQ_TYPE_EDGE_FALLING) {
 415		mcp->cache[MCP_INTCON] &= ~BIT(pos);
 416		mcp->irq_rise &= ~BIT(pos);
 417		mcp->irq_fall |= BIT(pos);
 418	} else
 419		return -EINVAL;
 420
 421	return status;
 422}
 423
 424static void mcp23s08_irq_bus_lock(struct irq_data *data)
 425{
 426	struct mcp23s08 *mcp = irq_data_get_irq_chip_data(data);
 427
 428	mutex_lock(&mcp->irq_lock);
 429}
 430
 431static void mcp23s08_irq_bus_unlock(struct irq_data *data)
 432{
 433	struct mcp23s08 *mcp = irq_data_get_irq_chip_data(data);
 434
 435	mutex_lock(&mcp->lock);
 436	mcp->ops->write(mcp, MCP_GPINTEN, mcp->cache[MCP_GPINTEN]);
 437	mcp->ops->write(mcp, MCP_DEFVAL, mcp->cache[MCP_DEFVAL]);
 438	mcp->ops->write(mcp, MCP_INTCON, mcp->cache[MCP_INTCON]);
 439	mutex_unlock(&mcp->lock);
 440	mutex_unlock(&mcp->irq_lock);
 441}
 442
 443static int mcp23s08_irq_reqres(struct irq_data *data)
 444{
 445	struct mcp23s08 *mcp = irq_data_get_irq_chip_data(data);
 446
 447	if (gpio_lock_as_irq(&mcp->chip, data->hwirq)) {
 448		dev_err(mcp->chip.dev,
 449			"unable to lock HW IRQ %lu for IRQ usage\n",
 450			data->hwirq);
 451		return -EINVAL;
 452	}
 453
 454	return 0;
 455}
 456
 457static void mcp23s08_irq_relres(struct irq_data *data)
 458{
 459	struct mcp23s08 *mcp = irq_data_get_irq_chip_data(data);
 460
 461	gpio_unlock_as_irq(&mcp->chip, data->hwirq);
 462}
 463
 464static struct irq_chip mcp23s08_irq_chip = {
 465	.name = "gpio-mcp23xxx",
 466	.irq_mask = mcp23s08_irq_mask,
 467	.irq_unmask = mcp23s08_irq_unmask,
 468	.irq_set_type = mcp23s08_irq_set_type,
 469	.irq_bus_lock = mcp23s08_irq_bus_lock,
 470	.irq_bus_sync_unlock = mcp23s08_irq_bus_unlock,
 471	.irq_request_resources = mcp23s08_irq_reqres,
 472	.irq_release_resources = mcp23s08_irq_relres,
 473};
 474
 475static int mcp23s08_irq_setup(struct mcp23s08 *mcp)
 476{
 477	struct gpio_chip *chip = &mcp->chip;
 478	int err, irq, j;
 
 479
 480	mutex_init(&mcp->irq_lock);
 481
 482	mcp->irq_domain = irq_domain_add_linear(chip->of_node, chip->ngpio,
 
 483						&irq_domain_simple_ops, mcp);
 484	if (!mcp->irq_domain)
 485		return -ENODEV;
 486
 487	err = devm_request_threaded_irq(chip->dev, mcp->irq, NULL, mcp23s08_irq,
 488					IRQF_TRIGGER_LOW | IRQF_ONESHOT,
 489					dev_name(chip->dev), mcp);
 
 
 
 
 
 490	if (err != 0) {
 491		dev_err(chip->dev, "unable to request IRQ#%d: %d\n",
 492			mcp->irq, err);
 493		return err;
 494	}
 495
 496	chip->to_irq = mcp23s08_gpio_to_irq;
 497
 498	for (j = 0; j < mcp->chip.ngpio; j++) {
 499		irq = irq_create_mapping(mcp->irq_domain, j);
 500		irq_set_lockdep_class(irq, &gpio_lock_class);
 501		irq_set_chip_data(irq, mcp);
 502		irq_set_chip(irq, &mcp23s08_irq_chip);
 503		irq_set_nested_thread(irq, true);
 504#ifdef CONFIG_ARM
 505		set_irq_flags(irq, IRQF_VALID);
 506#else
 507		irq_set_noprobe(irq);
 508#endif
 509	}
 510	return 0;
 511}
 512
 513static void mcp23s08_irq_teardown(struct mcp23s08 *mcp)
 514{
 515	unsigned int irq, i;
 516
 517	free_irq(mcp->irq, mcp);
 518
 519	for (i = 0; i < mcp->chip.ngpio; i++) {
 520		irq = irq_find_mapping(mcp->irq_domain, i);
 521		if (irq > 0)
 522			irq_dispose_mapping(irq);
 523	}
 524
 525	irq_domain_remove(mcp->irq_domain);
 526}
 527
 528/*----------------------------------------------------------------------*/
 529
 530#ifdef CONFIG_DEBUG_FS
 531
 532#include <linux/seq_file.h>
 533
 534/*
 535 * This shows more info than the generic gpio dump code:
 536 * pullups, deglitching, open drain drive.
 537 */
 538static void mcp23s08_dbg_show(struct seq_file *s, struct gpio_chip *chip)
 539{
 540	struct mcp23s08	*mcp;
 541	char		bank;
 542	int		t;
 543	unsigned	mask;
 544
 545	mcp = container_of(chip, struct mcp23s08, chip);
 546
 547	/* NOTE: we only handle one bank for now ... */
 548	bank = '0' + ((mcp->addr >> 1) & 0x7);
 549
 550	mutex_lock(&mcp->lock);
 551	t = mcp->ops->read_regs(mcp, 0, mcp->cache, ARRAY_SIZE(mcp->cache));
 552	if (t < 0) {
 553		seq_printf(s, " I/O ERROR %d\n", t);
 554		goto done;
 555	}
 556
 557	for (t = 0, mask = 1; t < chip->ngpio; t++, mask <<= 1) {
 558		const char	*label;
 559
 560		label = gpiochip_is_requested(chip, t);
 561		if (!label)
 562			continue;
 563
 564		seq_printf(s, " gpio-%-3d P%c.%d (%-12s) %s %s %s",
 565			chip->base + t, bank, t, label,
 566			(mcp->cache[MCP_IODIR] & mask) ? "in " : "out",
 567			(mcp->cache[MCP_GPIO] & mask) ? "hi" : "lo",
 568			(mcp->cache[MCP_GPPU] & mask) ? "up" : "  ");
 569		/* NOTE:  ignoring the irq-related registers */
 570		seq_puts(s, "\n");
 571	}
 572done:
 573	mutex_unlock(&mcp->lock);
 574}
 575
 576#else
 577#define mcp23s08_dbg_show	NULL
 578#endif
 579
 580/*----------------------------------------------------------------------*/
 581
 582static int mcp23s08_probe_one(struct mcp23s08 *mcp, struct device *dev,
 583			      void *data, unsigned addr, unsigned type,
 584			      unsigned base, unsigned pullups)
 585{
 586	int status;
 587	bool mirror = false;
 588
 589	mutex_init(&mcp->lock);
 590
 591	mcp->data = data;
 592	mcp->addr = addr;
 
 593
 594	mcp->chip.direction_input = mcp23s08_direction_input;
 595	mcp->chip.get = mcp23s08_get;
 596	mcp->chip.direction_output = mcp23s08_direction_output;
 597	mcp->chip.set = mcp23s08_set;
 598	mcp->chip.dbg_show = mcp23s08_dbg_show;
 599#ifdef CONFIG_OF
 600	mcp->chip.of_gpio_n_cells = 2;
 601	mcp->chip.of_node = dev->of_node;
 602#endif
 603
 604	switch (type) {
 605#ifdef CONFIG_SPI_MASTER
 606	case MCP_TYPE_S08:
 607		mcp->ops = &mcp23s08_ops;
 608		mcp->chip.ngpio = 8;
 609		mcp->chip.label = "mcp23s08";
 610		break;
 611
 612	case MCP_TYPE_S17:
 613		mcp->ops = &mcp23s17_ops;
 614		mcp->chip.ngpio = 16;
 615		mcp->chip.label = "mcp23s17";
 616		break;
 
 
 
 
 
 
 617#endif /* CONFIG_SPI_MASTER */
 618
 619#if IS_ENABLED(CONFIG_I2C)
 620	case MCP_TYPE_008:
 621		mcp->ops = &mcp23008_ops;
 622		mcp->chip.ngpio = 8;
 623		mcp->chip.label = "mcp23008";
 624		break;
 625
 626	case MCP_TYPE_017:
 627		mcp->ops = &mcp23017_ops;
 628		mcp->chip.ngpio = 16;
 629		mcp->chip.label = "mcp23017";
 630		break;
 631#endif /* CONFIG_I2C */
 632
 633	default:
 634		dev_err(dev, "invalid device type (%d)\n", type);
 635		return -EINVAL;
 636	}
 637
 638	mcp->chip.base = base;
 639	mcp->chip.can_sleep = true;
 640	mcp->chip.dev = dev;
 641	mcp->chip.owner = THIS_MODULE;
 642
 643	/* verify MCP_IOCON.SEQOP = 0, so sequential reads work,
 644	 * and MCP_IOCON.HAEN = 1, so we work with all chips.
 645	 */
 646
 647	status = mcp->ops->read(mcp, MCP_IOCON);
 648	if (status < 0)
 649		goto fail;
 650
 651	mcp->irq_controller = of_property_read_bool(mcp->chip.of_node,
 652						"interrupt-controller");
 653	if (mcp->irq && mcp->irq_controller && (type == MCP_TYPE_017))
 654		mirror = of_property_read_bool(mcp->chip.of_node,
 655						"microchip,irq-mirror");
 
 
 
 656
 657	if ((status & IOCON_SEQOP) || !(status & IOCON_HAEN) || mirror) {
 
 658		/* mcp23s17 has IOCON twice, make sure they are in sync */
 659		status &= ~(IOCON_SEQOP | (IOCON_SEQOP << 8));
 660		status |= IOCON_HAEN | (IOCON_HAEN << 8);
 661		status &= ~(IOCON_INTPOL | (IOCON_INTPOL << 8));
 
 
 
 
 662		if (mirror)
 663			status |= IOCON_MIRROR | (IOCON_MIRROR << 8);
 664
 
 
 
 665		status = mcp->ops->write(mcp, MCP_IOCON, status);
 666		if (status < 0)
 667			goto fail;
 668	}
 669
 670	/* configure ~100K pullups */
 671	status = mcp->ops->write(mcp, MCP_GPPU, pullups);
 672	if (status < 0)
 673		goto fail;
 674
 675	status = mcp->ops->read_regs(mcp, 0, mcp->cache, ARRAY_SIZE(mcp->cache));
 676	if (status < 0)
 677		goto fail;
 678
 679	/* disable inverter on input */
 680	if (mcp->cache[MCP_IPOL] != 0) {
 681		mcp->cache[MCP_IPOL] = 0;
 682		status = mcp->ops->write(mcp, MCP_IPOL, 0);
 683		if (status < 0)
 684			goto fail;
 685	}
 686
 687	/* disable irqs */
 688	if (mcp->cache[MCP_GPINTEN] != 0) {
 689		mcp->cache[MCP_GPINTEN] = 0;
 690		status = mcp->ops->write(mcp, MCP_GPINTEN, 0);
 691		if (status < 0)
 692			goto fail;
 693	}
 694
 695	status = gpiochip_add(&mcp->chip);
 696	if (status < 0)
 697		goto fail;
 698
 699	if (mcp->irq && mcp->irq_controller) {
 700		status = mcp23s08_irq_setup(mcp);
 701		if (status) {
 702			mcp23s08_irq_teardown(mcp);
 703			goto fail;
 704		}
 705	}
 706fail:
 707	if (status < 0)
 708		dev_dbg(dev, "can't setup chip %d, --> %d\n",
 709			addr, status);
 710	return status;
 711}
 712
 713/*----------------------------------------------------------------------*/
 714
 715#ifdef CONFIG_OF
 716#ifdef CONFIG_SPI_MASTER
 717static struct of_device_id mcp23s08_spi_of_match[] = {
 718	{
 719		.compatible = "microchip,mcp23s08",
 720		.data = (void *) MCP_TYPE_S08,
 721	},
 722	{
 723		.compatible = "microchip,mcp23s17",
 724		.data = (void *) MCP_TYPE_S17,
 725	},
 
 
 
 
 726/* NOTE: The use of the mcp prefix is deprecated and will be removed. */
 727	{
 728		.compatible = "mcp,mcp23s08",
 729		.data = (void *) MCP_TYPE_S08,
 730	},
 731	{
 732		.compatible = "mcp,mcp23s17",
 733		.data = (void *) MCP_TYPE_S17,
 734	},
 735	{ },
 736};
 737MODULE_DEVICE_TABLE(of, mcp23s08_spi_of_match);
 738#endif
 739
 740#if IS_ENABLED(CONFIG_I2C)
 741static struct of_device_id mcp23s08_i2c_of_match[] = {
 742	{
 743		.compatible = "microchip,mcp23008",
 744		.data = (void *) MCP_TYPE_008,
 745	},
 746	{
 747		.compatible = "microchip,mcp23017",
 748		.data = (void *) MCP_TYPE_017,
 749	},
 750/* NOTE: The use of the mcp prefix is deprecated and will be removed. */
 751	{
 752		.compatible = "mcp,mcp23008",
 753		.data = (void *) MCP_TYPE_008,
 754	},
 755	{
 756		.compatible = "mcp,mcp23017",
 757		.data = (void *) MCP_TYPE_017,
 758	},
 759	{ },
 760};
 761MODULE_DEVICE_TABLE(of, mcp23s08_i2c_of_match);
 762#endif
 763#endif /* CONFIG_OF */
 764
 765
 766#if IS_ENABLED(CONFIG_I2C)
 767
 768static int mcp230xx_probe(struct i2c_client *client,
 769				    const struct i2c_device_id *id)
 770{
 771	struct mcp23s08_platform_data *pdata;
 772	struct mcp23s08 *mcp;
 773	int status, base, pullups;
 774	const struct of_device_id *match;
 775
 776	match = of_match_device(of_match_ptr(mcp23s08_i2c_of_match),
 777					&client->dev);
 778	pdata = dev_get_platdata(&client->dev);
 779	if (match || !pdata) {
 780		base = -1;
 781		pullups = 0;
 
 
 
 
 
 782		client->irq = irq_of_parse_and_map(client->dev.of_node, 0);
 783	} else {
 784		if (!gpio_is_valid(pdata->base)) {
 785			dev_dbg(&client->dev, "invalid platform data\n");
 786			return -EINVAL;
 
 
 
 
 
 787		}
 788		base = pdata->base;
 789		pullups = pdata->chip[0].pullups;
 790	}
 791
 792	mcp = kzalloc(sizeof(*mcp), GFP_KERNEL);
 793	if (!mcp)
 794		return -ENOMEM;
 795
 796	mcp->irq = client->irq;
 797	status = mcp23s08_probe_one(mcp, &client->dev, client, client->addr,
 798				    id->driver_data, base, pullups);
 799	if (status)
 800		goto fail;
 801
 802	i2c_set_clientdata(client, mcp);
 803
 804	return 0;
 805
 806fail:
 807	kfree(mcp);
 808
 809	return status;
 810}
 811
 812static int mcp230xx_remove(struct i2c_client *client)
 813{
 814	struct mcp23s08 *mcp = i2c_get_clientdata(client);
 815	int status;
 816
 817	if (client->irq && mcp->irq_controller)
 818		mcp23s08_irq_teardown(mcp);
 819
 820	status = gpiochip_remove(&mcp->chip);
 821	if (status == 0)
 822		kfree(mcp);
 823
 824	return status;
 825}
 826
 827static const struct i2c_device_id mcp230xx_id[] = {
 828	{ "mcp23008", MCP_TYPE_008 },
 829	{ "mcp23017", MCP_TYPE_017 },
 830	{ },
 831};
 832MODULE_DEVICE_TABLE(i2c, mcp230xx_id);
 833
 834static struct i2c_driver mcp230xx_driver = {
 835	.driver = {
 836		.name	= "mcp230xx",
 837		.owner	= THIS_MODULE,
 838		.of_match_table = of_match_ptr(mcp23s08_i2c_of_match),
 839	},
 840	.probe		= mcp230xx_probe,
 841	.remove		= mcp230xx_remove,
 842	.id_table	= mcp230xx_id,
 843};
 844
 845static int __init mcp23s08_i2c_init(void)
 846{
 847	return i2c_add_driver(&mcp230xx_driver);
 848}
 849
 850static void mcp23s08_i2c_exit(void)
 851{
 852	i2c_del_driver(&mcp230xx_driver);
 853}
 854
 855#else
 856
 857static int __init mcp23s08_i2c_init(void) { return 0; }
 858static void mcp23s08_i2c_exit(void) { }
 859
 860#endif /* CONFIG_I2C */
 861
 862/*----------------------------------------------------------------------*/
 863
 864#ifdef CONFIG_SPI_MASTER
 865
 866static int mcp23s08_probe(struct spi_device *spi)
 867{
 868	struct mcp23s08_platform_data	*pdata;
 869	unsigned			addr;
 870	unsigned			chips = 0;
 871	struct mcp23s08_driver_data	*data;
 872	int				status, type;
 873	unsigned			base = -1,
 874					ngpio = 0,
 875					pullups[ARRAY_SIZE(pdata->chip)];
 876	const struct			of_device_id *match;
 877	u32				spi_present_mask = 0;
 878
 879	match = of_match_device(of_match_ptr(mcp23s08_spi_of_match), &spi->dev);
 880	if (match) {
 881		type = (int)(uintptr_t)match->data;
 882		status = of_property_read_u32(spi->dev.of_node,
 883			    "microchip,spi-present-mask", &spi_present_mask);
 884		if (status) {
 885			status = of_property_read_u32(spi->dev.of_node,
 886				    "mcp,spi-present-mask", &spi_present_mask);
 887			if (status) {
 888				dev_err(&spi->dev,
 889					"DT has no spi-present-mask\n");
 890				return -ENODEV;
 891			}
 892		}
 893		if ((spi_present_mask <= 0) || (spi_present_mask >= 256)) {
 894			dev_err(&spi->dev, "invalid spi-present-mask\n");
 895			return -ENODEV;
 896		}
 
 
 
 897		for (addr = 0; addr < ARRAY_SIZE(pdata->chip); addr++) {
 898			if ((spi_present_mask & (1 << addr)))
 
 899				chips++;
 900			pullups[addr] = 0;
 901		}
 
 
 
 
 
 902	} else {
 903		type = spi_get_device_id(spi)->driver_data;
 904		pdata = dev_get_platdata(&spi->dev);
 905		if (!pdata || !gpio_is_valid(pdata->base)) {
 906			dev_dbg(&spi->dev,
 907					"invalid or missing platform data\n");
 908			return -EINVAL;
 
 909		}
 910
 911		for (addr = 0; addr < ARRAY_SIZE(pdata->chip); addr++) {
 912			if (!pdata->chip[addr].is_present)
 913				continue;
 914			chips++;
 915			if ((type == MCP_TYPE_S08) && (addr > 3)) {
 916				dev_err(&spi->dev,
 917					"mcp23s08 only supports address 0..3\n");
 918				return -EINVAL;
 919			}
 920			spi_present_mask |= 1 << addr;
 921			pullups[addr] = pdata->chip[addr].pullups;
 922		}
 923
 924		base = pdata->base;
 925	}
 926
 927	if (!chips)
 928		return -ENODEV;
 929
 930	data = kzalloc(sizeof(*data) + chips * sizeof(struct mcp23s08),
 931			GFP_KERNEL);
 
 932	if (!data)
 933		return -ENOMEM;
 
 934	spi_set_drvdata(spi, data);
 935
 
 
 936	for (addr = 0; addr < ARRAY_SIZE(pdata->chip); addr++) {
 937		if (!(spi_present_mask & (1 << addr)))
 938			continue;
 939		chips--;
 940		data->mcp[addr] = &data->chip[chips];
 
 941		status = mcp23s08_probe_one(data->mcp[addr], &spi->dev, spi,
 942					    0x40 | (addr << 1), type, base,
 943					    pullups[addr]);
 944		if (status < 0)
 945			goto fail;
 946
 947		if (base != -1)
 948			base += (type == MCP_TYPE_S17) ? 16 : 8;
 949		ngpio += (type == MCP_TYPE_S17) ? 16 : 8;
 950	}
 951	data->ngpio = ngpio;
 952
 953	/* NOTE:  these chips have a relatively sane IRQ framework, with
 954	 * per-signal masking and level/edge triggering.  It's not yet
 955	 * handled here...
 956	 */
 957
 958	return 0;
 959
 960fail:
 961	for (addr = 0; addr < ARRAY_SIZE(data->mcp); addr++) {
 962		int tmp;
 963
 964		if (!data->mcp[addr])
 965			continue;
 966		tmp = gpiochip_remove(&data->mcp[addr]->chip);
 967		if (tmp < 0)
 968			dev_err(&spi->dev, "%s --> %d\n", "remove", tmp);
 969	}
 970	kfree(data);
 971	return status;
 972}
 973
 974static int mcp23s08_remove(struct spi_device *spi)
 975{
 976	struct mcp23s08_driver_data	*data = spi_get_drvdata(spi);
 977	unsigned			addr;
 978	int				status = 0;
 979
 980	for (addr = 0; addr < ARRAY_SIZE(data->mcp); addr++) {
 981		int tmp;
 982
 983		if (!data->mcp[addr])
 984			continue;
 985
 986		tmp = gpiochip_remove(&data->mcp[addr]->chip);
 987		if (tmp < 0) {
 988			dev_err(&spi->dev, "%s --> %d\n", "remove", tmp);
 989			status = tmp;
 990		}
 991	}
 992	if (status == 0)
 993		kfree(data);
 994	return status;
 995}
 996
 997static const struct spi_device_id mcp23s08_ids[] = {
 998	{ "mcp23s08", MCP_TYPE_S08 },
 999	{ "mcp23s17", MCP_TYPE_S17 },
 
1000	{ },
1001};
1002MODULE_DEVICE_TABLE(spi, mcp23s08_ids);
1003
1004static struct spi_driver mcp23s08_driver = {
1005	.probe		= mcp23s08_probe,
1006	.remove		= mcp23s08_remove,
1007	.id_table	= mcp23s08_ids,
1008	.driver = {
1009		.name	= "mcp23s08",
1010		.owner	= THIS_MODULE,
1011		.of_match_table = of_match_ptr(mcp23s08_spi_of_match),
1012	},
1013};
1014
1015static int __init mcp23s08_spi_init(void)
1016{
1017	return spi_register_driver(&mcp23s08_driver);
1018}
1019
1020static void mcp23s08_spi_exit(void)
1021{
1022	spi_unregister_driver(&mcp23s08_driver);
1023}
1024
1025#else
1026
1027static int __init mcp23s08_spi_init(void) { return 0; }
1028static void mcp23s08_spi_exit(void) { }
1029
1030#endif /* CONFIG_SPI_MASTER */
1031
1032/*----------------------------------------------------------------------*/
1033
1034static int __init mcp23s08_init(void)
1035{
1036	int ret;
1037
1038	ret = mcp23s08_spi_init();
1039	if (ret)
1040		goto spi_fail;
1041
1042	ret = mcp23s08_i2c_init();
1043	if (ret)
1044		goto i2c_fail;
1045
1046	return 0;
1047
1048 i2c_fail:
1049	mcp23s08_spi_exit();
1050 spi_fail:
1051	return ret;
1052}
1053/* register after spi/i2c postcore initcall and before
1054 * subsys initcalls that may rely on these GPIOs
1055 */
1056subsys_initcall(mcp23s08_init);
1057
1058static void __exit mcp23s08_exit(void)
1059{
1060	mcp23s08_spi_exit();
1061	mcp23s08_i2c_exit();
1062}
1063module_exit(mcp23s08_exit);
1064
1065MODULE_LICENSE("GPL");