296 lines
6.5 KiB
C
296 lines
6.5 KiB
C
// SPDX-License-Identifier: GPL-2.0
|
|
/*
|
|
* Copyright 2008 Extreme Engineering Solutions, Inc.
|
|
*/
|
|
|
|
/*
|
|
* Driver for NXP's 4, 8 and 16 bit I2C gpio expanders (eg pca9537, pca9557,
|
|
* pca9539, etc)
|
|
*/
|
|
|
|
#include <common.h>
|
|
#include <command.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;
|
|
}
|
|
|
|
#if defined(CONFIG_CMD_PCA953X) && !defined(CONFIG_SPL_BUILD)
|
|
/*
|
|
* 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;
|
|
}
|
|
|
|
static struct cmd_tbl 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, "", ""),
|
|
U_BOOT_CMD_MKENT(info, 2, 0, (void *)PCA953X_CMD_INFO, "", ""),
|
|
};
|
|
|
|
static int do_pca953x(struct cmd_tbl *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;
|
|
struct cmd_tbl *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)) ||
|
|
(((long)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 ((long)c->cmd) {
|
|
case PCA953X_CMD_INFO:
|
|
ret = pca953x_info(chip);
|
|
if (ret)
|
|
ret = CMD_RET_FAILURE;
|
|
break;
|
|
|
|
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"
|
|
"pca953x info\n"
|
|
" - display info for current chip\n"
|
|
"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 */
|