[people/ms/u-boot.git] / drivers / gpio / pca953x.c

/*
 * Copyright 2008 Extreme Engineering Solutions, Inc.
 *
 * SPDX-License-Identifier:	GPL-2.0
 */

/*
 * Driver for NXP's 4, 8 and 16 bit I2C gpio expanders (eg pca9537, pca9557,
 * pca9539, etc)
 */

#include <common.h>
#include <i2c.h>
#include <pca953x.h>

/* Default to an address that hopefully won't corrupt other i2c devices */
#ifndef CONFIG_SYS_I2C_PCA953X_ADDR
#define CONFIG_SYS_I2C_PCA953X_ADDR	(~0)
#endif

enum {
	PCA953X_CMD_INFO,
	PCA953X_CMD_DEVICE,
	PCA953X_CMD_OUTPUT,
	PCA953X_CMD_INPUT,
	PCA953X_CMD_INVERT,
};

#ifdef CONFIG_SYS_I2C_PCA953X_WIDTH
struct pca953x_chip_ngpio {
	uint8_t chip;
	uint8_t ngpio;
};

static struct pca953x_chip_ngpio pca953x_chip_ngpios[] =
    CONFIG_SYS_I2C_PCA953X_WIDTH;

/*
 * Determine the number of GPIO pins supported. If we don't know we assume
 * 8 pins.
 */
static int pca953x_ngpio(uint8_t chip)
{
	int i;

	for (i = 0; i < ARRAY_SIZE(pca953x_chip_ngpios); i++)
		if (pca953x_chip_ngpios[i].chip == chip)
			return pca953x_chip_ngpios[i].ngpio;

	return 8;
}
#else
static int pca953x_ngpio(uint8_t chip)
{
	return 8;
}
#endif

/*
 * Modify masked bits in register
 */
static int pca953x_reg_write(uint8_t chip, uint addr, uint mask, uint data)
{
	uint8_t valb;
	uint16_t valw;

	if (pca953x_ngpio(chip) <= 8) {
		if (i2c_read(chip, addr, 1, &valb, 1))
			return -1;

		valb &= ~mask;
		valb |= data;

		return i2c_write(chip, addr, 1, &valb, 1);
	} else {
		if (i2c_read(chip, addr << 1, 1, (u8*)&valw, 2))
			return -1;

		valw = le16_to_cpu(valw);
		valw &= ~mask;
		valw |= data;
		valw = cpu_to_le16(valw);

		return i2c_write(chip, addr << 1, 1, (u8*)&valw, 2);
	}
}

static int pca953x_reg_read(uint8_t chip, uint addr, uint *data)
{
	uint8_t valb;
	uint16_t valw;

	if (pca953x_ngpio(chip) <= 8) {
		if (i2c_read(chip, addr, 1, &valb, 1))
			return -1;
		*data = (int)valb;
	} else {
		if (i2c_read(chip, addr << 1, 1, (u8*)&valw, 2))
			return -1;
		*data = (uint)le16_to_cpu(valw);
	}
	return 0;
}

/*
 * Set output value of IO pins in 'mask' to corresponding value in 'data'
 * 0 = low, 1 = high
 */
int pca953x_set_val(uint8_t chip, uint mask, uint data)
{
	return pca953x_reg_write(chip, PCA953X_OUT, mask, data);
}

/*
 * Set read polarity of IO pins in 'mask' to corresponding value in 'data'
 * 0 = read pin value, 1 = read inverted pin value
 */
int pca953x_set_pol(uint8_t chip, uint mask, uint data)
{
	return pca953x_reg_write(chip, PCA953X_POL, mask, data);
}

/*
 * Set direction of IO pins in 'mask' to corresponding value in 'data'
 * 0 = output, 1 = input
 */
int pca953x_set_dir(uint8_t chip, uint mask, uint data)
{
	return pca953x_reg_write(chip, PCA953X_CONF, mask, data);
}

/*
 * Read current logic level of all IO pins
 */
int pca953x_get_val(uint8_t chip)
{
	uint val;

	if (pca953x_reg_read(chip, PCA953X_IN, &val) < 0)
		return -1;

	return (int)val;
}

#ifdef CONFIG_CMD_PCA953X
#ifdef CONFIG_CMD_PCA953X_INFO
/*
 * Display pca953x information
 */
static int pca953x_info(uint8_t chip)
{
	int i;
	uint data;
	int nr_gpio = pca953x_ngpio(chip);
	int msb = nr_gpio - 1;

	printf("pca953x@ 0x%x (%d pins):\n\n", chip, nr_gpio);
	printf("gpio pins: ");
	for (i = msb; i >= 0; i--)
		printf("%x", i);
	printf("\n");
	for (i = 11 + nr_gpio; i > 0; i--)
		printf("-");
	printf("\n");

	if (pca953x_reg_read(chip, PCA953X_CONF, &data) < 0)
		return -1;
	printf("conf:      ");
	for (i = msb; i >= 0; i--)
		printf("%c", data & (1 << i) ? 'i' : 'o');
	printf("\n");

	if (pca953x_reg_read(chip, PCA953X_POL, &data) < 0)
		return -1;
	printf("invert:    ");
	for (i = msb; i >= 0; i--)
		printf("%c", data & (1 << i) ? '1' : '0');
	printf("\n");

	if (pca953x_reg_read(chip, PCA953X_IN, &data) < 0)
		return -1;
	printf("input:     ");
	for (i = msb; i >= 0; i--)
		printf("%c", data & (1 << i) ? '1' : '0');
	printf("\n");

	if (pca953x_reg_read(chip, PCA953X_OUT, &data) < 0)
		return -1;
	printf("output:    ");
	for (i = msb; i >= 0; i--)
		printf("%c", data & (1 << i) ? '1' : '0');
	printf("\n");

	return 0;
}
#endif /* CONFIG_CMD_PCA953X_INFO */

cmd_tbl_t cmd_pca953x[] = {
	U_BOOT_CMD_MKENT(device, 3, 0, (void *)PCA953X_CMD_DEVICE, "", ""),
	U_BOOT_CMD_MKENT(output, 4, 0, (void *)PCA953X_CMD_OUTPUT, "", ""),
	U_BOOT_CMD_MKENT(input, 3, 0, (void *)PCA953X_CMD_INPUT, "", ""),
	U_BOOT_CMD_MKENT(invert, 4, 0, (void *)PCA953X_CMD_INVERT, "", ""),
#ifdef CONFIG_CMD_PCA953X_INFO
	U_BOOT_CMD_MKENT(info, 2, 0, (void *)PCA953X_CMD_INFO, "", ""),
#endif
};

int do_pca953x(cmd_tbl_t *cmdtp, int flag, int argc, char * const argv[])
{
	static uint8_t chip = CONFIG_SYS_I2C_PCA953X_ADDR;
	int ret = CMD_RET_USAGE, val;
	ulong ul_arg2 = 0;
	ulong ul_arg3 = 0;
	cmd_tbl_t *c;

	c = find_cmd_tbl(argv[1], cmd_pca953x, ARRAY_SIZE(cmd_pca953x));

	/* All commands but "device" require 'maxargs' arguments */
	if (!c || !((argc == (c->maxargs)) ||
		(((int)c->cmd == PCA953X_CMD_DEVICE) &&
		 (argc == (c->maxargs - 1))))) {
		return CMD_RET_USAGE;
	}

	/* arg2 used as chip number or pin number */
	if (argc > 2)
		ul_arg2 = simple_strtoul(argv[2], NULL, 16);

	/* arg3 used as pin or invert value */
	if (argc > 3)
		ul_arg3 = simple_strtoul(argv[3], NULL, 16) & 0x1;

	switch ((int)c->cmd) {
#ifdef CONFIG_CMD_PCA953X_INFO
	case PCA953X_CMD_INFO:
		ret = pca953x_info(chip);
		if (ret)
			ret = CMD_RET_FAILURE;
		break;
#endif

	case PCA953X_CMD_DEVICE:
		if (argc == 3)
			chip = (uint8_t)ul_arg2;
		printf("Current device address: 0x%x\n", chip);
		ret = CMD_RET_SUCCESS;
		break;

	case PCA953X_CMD_INPUT:
		ret = pca953x_set_dir(chip, (1 << ul_arg2),
				PCA953X_DIR_IN << ul_arg2);
		val = (pca953x_get_val(chip) & (1 << ul_arg2)) != 0;

		if (ret)
			ret = CMD_RET_FAILURE;
		else
			printf("chip 0x%02x, pin 0x%lx = %d\n", chip, ul_arg2,
									val);
		break;

	case PCA953X_CMD_OUTPUT:
		ret = pca953x_set_dir(chip, (1 << ul_arg2),
				(PCA953X_DIR_OUT << ul_arg2));
		if (!ret)
			ret = pca953x_set_val(chip, (1 << ul_arg2),
						(ul_arg3 << ul_arg2));
		if (ret)
			ret = CMD_RET_FAILURE;
		break;

	case PCA953X_CMD_INVERT:
		ret = pca953x_set_pol(chip, (1 << ul_arg2),
					(ul_arg3 << ul_arg2));
		if (ret)
			ret = CMD_RET_FAILURE;
		break;
	}

	if (ret == CMD_RET_FAILURE)
		eprintf("Error talking to chip at 0x%x\n", chip);

	return ret;
}

U_BOOT_CMD(
	pca953x,	5,	1,	do_pca953x,
	"pca953x gpio access",
	"device [dev]\n"
	"	- show or set current device address\n"
#ifdef CONFIG_CMD_PCA953X_INFO
	"pca953x info\n"
	"	- display info for current chip\n"
#endif
	"pca953x output pin 0|1\n"
	"	- set pin as output and drive low or high\n"
	"pca953x invert pin 0|1\n"
	"	- disable/enable polarity inversion for reads\n"
	"pca953x input pin\n"
	"	- set pin as input and read value"
);

#endif /* CONFIG_CMD_PCA953X */
Commit	Line	Data
e92739d3 PT	1	/*
	2	* Copyright 2008 Extreme Engineering Solutions, Inc.
	3	*
5b8031cc	4	* SPDX-License-Identifier: GPL-2.0
e92739d3 PT	5	*/
	6
	7	/*
5dec49ca CP	8	* Driver for NXP's 4, 8 and 16 bit I2C gpio expanders (eg pca9537, pca9557,
5dec49ca CP	9	* pca9539, etc)
e92739d3 PT	10	*/
	11
	12	#include <common.h>
	13	#include <i2c.h>
	14	#include <pca953x.h>
	15
	16	/* Default to an address that hopefully won't corrupt other i2c devices */
	17	#ifndef CONFIG_SYS_I2C_PCA953X_ADDR
	18	#define CONFIG_SYS_I2C_PCA953X_ADDR (~0)
	19	#endif
	20
	21	enum {
	22	PCA953X_CMD_INFO,
	23	PCA953X_CMD_DEVICE,
	24	PCA953X_CMD_OUTPUT,
	25	PCA953X_CMD_INPUT,
	26	PCA953X_CMD_INVERT,
	27	};
	28
5dec49ca CP	29	#ifdef CONFIG_SYS_I2C_PCA953X_WIDTH
	30	struct pca953x_chip_ngpio {
	31	uint8_t chip;
	32	uint8_t ngpio;
	33	};
	34
	35	static struct pca953x_chip_ngpio pca953x_chip_ngpios[] =
	36	CONFIG_SYS_I2C_PCA953X_WIDTH;
	37
5dec49ca CP	38	/*
	39	* Determine the number of GPIO pins supported. If we don't know we assume
	40	* 8 pins.
	41	*/
	42	static int pca953x_ngpio(uint8_t chip)
	43	{
	44	int i;
	45
f2187617	46	for (i = 0; i < ARRAY_SIZE(pca953x_chip_ngpios); i++)
5dec49ca CP	47	if (pca953x_chip_ngpios[i].chip == chip)
	48	return pca953x_chip_ngpios[i].ngpio;
	49
	50	return 8;
	51	}
	52	#else
	53	static int pca953x_ngpio(uint8_t chip)
	54	{
	55	return 8;
	56	}
	57	#endif
	58
e92739d3 PT	59	/*
	60	* Modify masked bits in register
	61	*/
	62	static int pca953x_reg_write(uint8_t chip, uint addr, uint mask, uint data)
	63	{
5dec49ca CP	64	uint8_t valb;
5dec49ca CP	65	uint16_t valw;
e92739d3	66
5dec49ca CP	67	if (pca953x_ngpio(chip) <= 8) {
	68	if (i2c_read(chip, addr, 1, &valb, 1))
	69	return -1;
	70
	71	valb &= ~mask;
	72	valb \|= data;
	73
	74	return i2c_write(chip, addr, 1, &valb, 1);
	75	} else {
	76	if (i2c_read(chip, addr << 1, 1, (u8*)&valw, 2))
	77	return -1;
	78
daa75b34	79	valw = le16_to_cpu(valw);
5dec49ca CP	80	valw &= ~mask;
5dec49ca CP	81	valw \|= data;
daa75b34	82	valw = cpu_to_le16(valw);
e92739d3	83
5dec49ca CP	84	return i2c_write(chip, addr << 1, 1, (u8*)&valw, 2);
	85	}
	86	}
e92739d3	87
5dec49ca CP	88	static int pca953x_reg_read(uint8_t chip, uint addr, uint *data)
	89	{
	90	uint8_t valb;
	91	uint16_t valw;
	92
	93	if (pca953x_ngpio(chip) <= 8) {
	94	if (i2c_read(chip, addr, 1, &valb, 1))
	95	return -1;
	96	*data = (int)valb;
	97	} else {
	98	if (i2c_read(chip, addr << 1, 1, (u8*)&valw, 2))
	99	return -1;
daa75b34	100	*data = (uint)le16_to_cpu(valw);
5dec49ca CP	101	}
5dec49ca CP	102	return 0;
e92739d3 PT	103	}
	104
	105	/*
	106	* Set output value of IO pins in 'mask' to corresponding value in 'data'
	107	* 0 = low, 1 = high
	108	*/
	109	int pca953x_set_val(uint8_t chip, uint mask, uint data)
	110	{
	111	return pca953x_reg_write(chip, PCA953X_OUT, mask, data);
	112	}
	113
	114	/*
	115	* Set read polarity of IO pins in 'mask' to corresponding value in 'data'
	116	* 0 = read pin value, 1 = read inverted pin value
	117	*/
	118	int pca953x_set_pol(uint8_t chip, uint mask, uint data)
	119	{
	120	return pca953x_reg_write(chip, PCA953X_POL, mask, data);
	121	}
	122
	123	/*
	124	* Set direction of IO pins in 'mask' to corresponding value in 'data'
	125	* 0 = output, 1 = input
	126	*/
	127	int pca953x_set_dir(uint8_t chip, uint mask, uint data)
	128	{
	129	return pca953x_reg_write(chip, PCA953X_CONF, mask, data);
	130	}
	131
	132	/*
	133	* Read current logic level of all IO pins
	134	*/
	135	int pca953x_get_val(uint8_t chip)
	136	{
5dec49ca	137	uint val;
e92739d3	138
5dec49ca	139	if (pca953x_reg_read(chip, PCA953X_IN, &val) < 0)
e92739d3 PT	140	return -1;
	141
	142	return (int)val;
	143	}
	144
	145	#ifdef CONFIG_CMD_PCA953X
	146	#ifdef CONFIG_CMD_PCA953X_INFO
	147	/*
	148	* Display pca953x information
	149	*/
	150	static int pca953x_info(uint8_t chip)
	151	{
	152	int i;
5dec49ca CP	153	uint data;
	154	int nr_gpio = pca953x_ngpio(chip);
	155	int msb = nr_gpio - 1;
	156
	157	printf("pca953x@ 0x%x (%d pins):\n\n", chip, nr_gpio);
	158	printf("gpio pins: ");
	159	for (i = msb; i >= 0; i--)
	160	printf("%x", i);
	161	printf("\n");
	162	for (i = 11 + nr_gpio; i > 0; i--)
	163	printf("-");
	164	printf("\n");
e92739d3	165
5dec49ca	166	if (pca953x_reg_read(chip, PCA953X_CONF, &data) < 0)
e92739d3 PT	167	return -1;
e92739d3 PT	168	printf("conf: ");
5dec49ca	169	for (i = msb; i >= 0; i--)
e92739d3 PT	170	printf("%c", data & (1 << i) ? 'i' : 'o');
	171	printf("\n");
	172
5dec49ca	173	if (pca953x_reg_read(chip, PCA953X_POL, &data) < 0)
e92739d3 PT	174	return -1;
e92739d3 PT	175	printf("invert: ");
5dec49ca	176	for (i = msb; i >= 0; i--)
e92739d3 PT	177	printf("%c", data & (1 << i) ? '1' : '0');
	178	printf("\n");
	179
5dec49ca	180	if (pca953x_reg_read(chip, PCA953X_IN, &data) < 0)
e92739d3 PT	181	return -1;
e92739d3 PT	182	printf("input: ");
5dec49ca	183	for (i = msb; i >= 0; i--)
e92739d3 PT	184	printf("%c", data & (1 << i) ? '1' : '0');
	185	printf("\n");
	186
5dec49ca	187	if (pca953x_reg_read(chip, PCA953X_OUT, &data) < 0)
e92739d3 PT	188	return -1;
e92739d3 PT	189	printf("output: ");
5dec49ca	190	for (i = msb; i >= 0; i--)
e92739d3 PT	191	printf("%c", data & (1 << i) ? '1' : '0');
	192	printf("\n");
	193
	194	return 0;
	195	}
	196	#endif /* CONFIG_CMD_PCA953X_INFO */
	197
	198	cmd_tbl_t cmd_pca953x[] = {
	199	U_BOOT_CMD_MKENT(device, 3, 0, (void *)PCA953X_CMD_DEVICE, "", ""),
	200	U_BOOT_CMD_MKENT(output, 4, 0, (void *)PCA953X_CMD_OUTPUT, "", ""),
	201	U_BOOT_CMD_MKENT(input, 3, 0, (void *)PCA953X_CMD_INPUT, "", ""),
	202	U_BOOT_CMD_MKENT(invert, 4, 0, (void *)PCA953X_CMD_INVERT, "", ""),
	203	#ifdef CONFIG_CMD_PCA953X_INFO
	204	U_BOOT_CMD_MKENT(info, 2, 0, (void *)PCA953X_CMD_INFO, "", ""),
	205	#endif
	206	};
	207
54841ab5	208	int do_pca953x(cmd_tbl_t cmdtp, int flag, int argc, char const argv[])
e92739d3 PT	209	{
e92739d3 PT	210	static uint8_t chip = CONFIG_SYS_I2C_PCA953X_ADDR;
633efe9c	211	int ret = CMD_RET_USAGE, val;
e92739d3 PT	212	ulong ul_arg2 = 0;
	213	ulong ul_arg3 = 0;
	214	cmd_tbl_t *c;
	215
	216	c = find_cmd_tbl(argv[1], cmd_pca953x, ARRAY_SIZE(cmd_pca953x));
	217
	218	/* All commands but "device" require 'maxargs' arguments */
	219	if (!c \|\| !((argc == (c->maxargs)) \|\|
	220	(((int)c->cmd == PCA953X_CMD_DEVICE) &&
	221	(argc == (c->maxargs - 1))))) {
633efe9c	222	return CMD_RET_USAGE;
e92739d3 PT	223	}
	224
	225	/* arg2 used as chip number or pin number */
	226	if (argc > 2)
	227	ul_arg2 = simple_strtoul(argv[2], NULL, 16);
	228
	229	/* arg3 used as pin or invert value */
	230	if (argc > 3)
	231	ul_arg3 = simple_strtoul(argv[3], NULL, 16) & 0x1;
	232
	233	switch ((int)c->cmd) {
	234	#ifdef CONFIG_CMD_PCA953X_INFO
	235	case PCA953X_CMD_INFO:
633efe9c LW	236	ret = pca953x_info(chip);
	237	if (ret)
	238	ret = CMD_RET_FAILURE;
	239	break;
e92739d3	240	#endif
633efe9c	241
e92739d3 PT	242	case PCA953X_CMD_DEVICE:
	243	if (argc == 3)
	244	chip = (uint8_t)ul_arg2;
	245	printf("Current device address: 0x%x\n", chip);
633efe9c LW	246	ret = CMD_RET_SUCCESS;
	247	break;
	248
e92739d3	249	case PCA953X_CMD_INPUT:
633efe9c	250	ret = pca953x_set_dir(chip, (1 << ul_arg2),
e92739d3 PT	251	PCA953X_DIR_IN << ul_arg2);
	252	val = (pca953x_get_val(chip) & (1 << ul_arg2)) != 0;
	253
633efe9c LW	254	if (ret)
	255	ret = CMD_RET_FAILURE;
	256	else
	257	printf("chip 0x%02x, pin 0x%lx = %d\n", chip, ul_arg2,
	258	val);
	259	break;
	260
e92739d3	261	case PCA953X_CMD_OUTPUT:
633efe9c	262	ret = pca953x_set_dir(chip, (1 << ul_arg2),
e92739d3	263	(PCA953X_DIR_OUT << ul_arg2));
633efe9c LW	264	if (!ret)
	265	ret = pca953x_set_val(chip, (1 << ul_arg2),
	266	(ul_arg3 << ul_arg2));
	267	if (ret)
	268	ret = CMD_RET_FAILURE;
	269	break;
	270
e92739d3	271	case PCA953X_CMD_INVERT:
633efe9c	272	ret = pca953x_set_pol(chip, (1 << ul_arg2),
e92739d3	273	(ul_arg3 << ul_arg2));
633efe9c LW	274	if (ret)
	275	ret = CMD_RET_FAILURE;
	276	break;
e92739d3	277	}
633efe9c LW	278
	279	if (ret == CMD_RET_FAILURE)
	280	eprintf("Error talking to chip at 0x%x\n", chip);
	281
	282	return ret;
e92739d3 PT	283	}
	284
	285	U_BOOT_CMD(
	286	pca953x, 5, 1, do_pca953x,
2fb2604d	287	"pca953x gpio access",
e92739d3 PT	288	"device [dev]\n"
	289	" - show or set current device address\n"
	290	#ifdef CONFIG_CMD_PCA953X_INFO
	291	"pca953x info\n"
	292	" - display info for current chip\n"
	293	#endif
	294	"pca953x output pin 0\|1\n"
	295	" - set pin as output and drive low or high\n"
	296	"pca953x invert pin 0\|1\n"
	297	" - disable/enable polarity inversion for reads\n"
d75bc03f	298	"pca953x input pin\n"
a89c33db	299	" - set pin as input and read value"
e92739d3 PT	300	);
	301
	302	#endif /* CONFIG_CMD_PCA953X */