Commit 168115f9 authored by David Lechner's avatar David Lechner Committed by Jonathan Cameron

staging: iio: resolver: ad2s1210: rework gpios

- Remove "adi," prefix from gpio names.
- Sample gpio is now expected to be active low.
- Convert A0 and A1 gpios to "mode-gpios" gpio array.
- Convert RES0 and RES1 gpios to "resolution-gpios" gpio array.
- Remove extraneous lookup tables.
- Remove unused mode field from state struct.
- Swap argument order of ad2s1210_set_mode() while we are touching this.
Signed-off-by: default avatarDavid Lechner <dlechner@baylibre.com>
Link: https://lore.kernel.org/r/20230929-ad2s1210-mainline-v3-13-fa4364281745@baylibre.comSigned-off-by: default avatarJonathan Cameron <Jonathan.Cameron@huawei.com>
parent 8ab5bf1a
...@@ -58,39 +58,21 @@ ...@@ -58,39 +58,21 @@
#define AD2S1210_DEF_EXCIT 10000 #define AD2S1210_DEF_EXCIT 10000
enum ad2s1210_mode { enum ad2s1210_mode {
MOD_POS = 0, MOD_POS = 0b00,
MOD_VEL, MOD_VEL = 0b01,
MOD_CONFIG, MOD_RESERVED = 0b10,
MOD_RESERVED, MOD_CONFIG = 0b11,
}; };
enum ad2s1210_gpios {
AD2S1210_SAMPLE,
AD2S1210_A0,
AD2S1210_A1,
AD2S1210_RES0,
AD2S1210_RES1,
};
struct ad2s1210_gpio {
const char *name;
unsigned long flags;
};
static const struct ad2s1210_gpio gpios[] = {
[AD2S1210_SAMPLE] = { .name = "adi,sample", .flags = GPIOD_OUT_LOW },
[AD2S1210_A0] = { .name = "adi,a0", .flags = GPIOD_OUT_LOW },
[AD2S1210_A1] = { .name = "adi,a1", .flags = GPIOD_OUT_LOW },
[AD2S1210_RES0] = { .name = "adi,res0", .flags = GPIOD_OUT_LOW },
[AD2S1210_RES1] = { .name = "adi,res1", .flags = GPIOD_OUT_LOW },
};
static const unsigned int ad2s1210_resolution_value[] = { 10, 12, 14, 16 };
struct ad2s1210_state { struct ad2s1210_state {
struct mutex lock; struct mutex lock;
struct spi_device *sdev; struct spi_device *sdev;
struct gpio_desc *gpios[5]; /** GPIO pin connected to SAMPLE line. */
struct gpio_desc *sample_gpio;
/** GPIO pins connected to A0 and A1 lines. */
struct gpio_descs *mode_gpios;
/** GPIO pins connected to RES0 and RES1 lines. */
struct gpio_descs *resolution_gpios;
/** Used to access config registers. */ /** Used to access config registers. */
struct regmap *regmap; struct regmap *regmap;
/** The external oscillator frequency in Hz. */ /** The external oscillator frequency in Hz. */
...@@ -98,7 +80,6 @@ struct ad2s1210_state { ...@@ -98,7 +80,6 @@ struct ad2s1210_state {
unsigned int fexcit; unsigned int fexcit;
bool hysteresis; bool hysteresis;
u8 resolution; u8 resolution;
enum ad2s1210_mode mode;
/** For reading raw sample value via SPI. */ /** For reading raw sample value via SPI. */
__be16 sample __aligned(IIO_DMA_MINALIGN); __be16 sample __aligned(IIO_DMA_MINALIGN);
/** SPI transmit buffer. */ /** SPI transmit buffer. */
...@@ -107,18 +88,15 @@ struct ad2s1210_state { ...@@ -107,18 +88,15 @@ struct ad2s1210_state {
u8 tx[2]; u8 tx[2];
}; };
static const int ad2s1210_mode_vals[4][2] = { static int ad2s1210_set_mode(struct ad2s1210_state *st, enum ad2s1210_mode mode)
[MOD_POS] = { 0, 0 },
[MOD_VEL] = { 0, 1 },
[MOD_CONFIG] = { 1, 1 },
};
static inline void ad2s1210_set_mode(enum ad2s1210_mode mode,
struct ad2s1210_state *st)
{ {
gpiod_set_value(st->gpios[AD2S1210_A0], ad2s1210_mode_vals[mode][0]); struct gpio_descs *gpios = st->mode_gpios;
gpiod_set_value(st->gpios[AD2S1210_A1], ad2s1210_mode_vals[mode][1]); DECLARE_BITMAP(bitmap, 2);
st->mode = mode;
bitmap[0] = mode;
return gpiod_set_array_value(gpios->ndescs, gpios->desc, gpios->info,
bitmap);
} }
/* /*
...@@ -143,6 +121,7 @@ static int ad2s1210_regmap_reg_write(void *context, unsigned int reg, ...@@ -143,6 +121,7 @@ static int ad2s1210_regmap_reg_write(void *context, unsigned int reg,
.tx_buf = &st->tx[1], .tx_buf = &st->tx[1],
}, },
}; };
int ret;
/* values can only be 7 bits, the MSB indicates an address */ /* values can only be 7 bits, the MSB indicates an address */
if (val & ~0x7F) if (val & ~0x7F)
...@@ -151,7 +130,9 @@ static int ad2s1210_regmap_reg_write(void *context, unsigned int reg, ...@@ -151,7 +130,9 @@ static int ad2s1210_regmap_reg_write(void *context, unsigned int reg,
st->tx[0] = reg; st->tx[0] = reg;
st->tx[1] = val; st->tx[1] = val;
ad2s1210_set_mode(MOD_CONFIG, st); ret = ad2s1210_set_mode(st, MOD_CONFIG);
if (ret < 0)
return ret;
return spi_sync_transfer(st->sdev, xfers, ARRAY_SIZE(xfers)); return spi_sync_transfer(st->sdev, xfers, ARRAY_SIZE(xfers));
} }
...@@ -180,7 +161,10 @@ static int ad2s1210_regmap_reg_read(void *context, unsigned int reg, ...@@ -180,7 +161,10 @@ static int ad2s1210_regmap_reg_read(void *context, unsigned int reg,
}; };
int ret; int ret;
ad2s1210_set_mode(MOD_CONFIG, st); ret = ad2s1210_set_mode(st, MOD_CONFIG);
if (ret < 0)
return ret;
st->tx[0] = reg; st->tx[0] = reg;
/* /*
* Must be valid register address here otherwise this could write data. * Must be valid register address here otherwise this could write data.
...@@ -219,16 +203,16 @@ int ad2s1210_update_frequency_control_word(struct ad2s1210_state *st) ...@@ -219,16 +203,16 @@ int ad2s1210_update_frequency_control_word(struct ad2s1210_state *st)
return regmap_write(st->regmap, AD2S1210_REG_EXCIT_FREQ, fcw); return regmap_write(st->regmap, AD2S1210_REG_EXCIT_FREQ, fcw);
} }
static const int ad2s1210_res_pins[4][2] = { static int ad2s1210_set_resolution_gpios(struct ad2s1210_state *st,
{ 0, 0 }, {0, 1}, {1, 0}, {1, 1} u8 resolution)
};
static inline void ad2s1210_set_resolution_pin(struct ad2s1210_state *st)
{ {
gpiod_set_value(st->gpios[AD2S1210_RES0], struct gpio_descs *gpios = st->resolution_gpios;
ad2s1210_res_pins[(st->resolution - 10) / 2][0]); DECLARE_BITMAP(bitmap, 2);
gpiod_set_value(st->gpios[AD2S1210_RES1],
ad2s1210_res_pins[(st->resolution - 10) / 2][1]); bitmap[0] = (resolution - 10) >> 1;
return gpiod_set_array_value(gpios->ndescs, gpios->desc, gpios->info,
bitmap);
} }
static inline int ad2s1210_soft_reset(struct ad2s1210_state *st) static inline int ad2s1210_soft_reset(struct ad2s1210_state *st)
...@@ -305,10 +289,13 @@ static ssize_t ad2s1210_store_resolution(struct device *dev, ...@@ -305,10 +289,13 @@ static ssize_t ad2s1210_store_resolution(struct device *dev,
if (ret < 0) if (ret < 0)
goto error_ret; goto error_ret;
st->resolution = ret = ad2s1210_set_resolution_gpios(st, udata);
ad2s1210_resolution_value[data & AD2S1210_SET_RES]; if (ret < 0)
ad2s1210_set_resolution_pin(st); goto error_ret;
st->resolution = udata;
ret = len; ret = len;
error_ret: error_ret:
mutex_unlock(&st->lock); mutex_unlock(&st->lock);
return ret; return ret;
...@@ -339,15 +326,19 @@ static ssize_t ad2s1210_clear_fault(struct device *dev, ...@@ -339,15 +326,19 @@ static ssize_t ad2s1210_clear_fault(struct device *dev,
int ret; int ret;
mutex_lock(&st->lock); mutex_lock(&st->lock);
gpiod_set_value(st->gpios[AD2S1210_SAMPLE], 0);
gpiod_set_value(st->sample_gpio, 1);
/* delay (2 * tck + 20) nano seconds */ /* delay (2 * tck + 20) nano seconds */
udelay(1); udelay(1);
gpiod_set_value(st->gpios[AD2S1210_SAMPLE], 1); gpiod_set_value(st->sample_gpio, 0);
ret = regmap_read(st->regmap, AD2S1210_REG_FAULT, &value); ret = regmap_read(st->regmap, AD2S1210_REG_FAULT, &value);
if (ret < 0) if (ret < 0)
goto error_ret; goto error_ret;
gpiod_set_value(st->gpios[AD2S1210_SAMPLE], 0);
gpiod_set_value(st->gpios[AD2S1210_SAMPLE], 1); gpiod_set_value(st->sample_gpio, 1);
gpiod_set_value(st->sample_gpio, 0);
error_ret: error_ret:
mutex_unlock(&st->lock); mutex_unlock(&st->lock);
...@@ -393,19 +384,19 @@ static int ad2s1210_single_conversion(struct ad2s1210_state *st, ...@@ -393,19 +384,19 @@ static int ad2s1210_single_conversion(struct ad2s1210_state *st,
struct iio_chan_spec const *chan, struct iio_chan_spec const *chan,
int *val) int *val)
{ {
int ret = 0; int ret;
mutex_lock(&st->lock); mutex_lock(&st->lock);
gpiod_set_value(st->gpios[AD2S1210_SAMPLE], 0); gpiod_set_value(st->sample_gpio, 1);
/* delay (6 * tck + 20) nano seconds */ /* delay (6 * tck + 20) nano seconds */
udelay(1); udelay(1);
switch (chan->type) { switch (chan->type) {
case IIO_ANGL: case IIO_ANGL:
ad2s1210_set_mode(MOD_POS, st); ret = ad2s1210_set_mode(st, MOD_POS);
break; break;
case IIO_ANGL_VEL: case IIO_ANGL_VEL:
ad2s1210_set_mode(MOD_VEL, st); ret = ad2s1210_set_mode(st, MOD_VEL);
break; break;
default: default:
ret = -EINVAL; ret = -EINVAL;
...@@ -432,7 +423,7 @@ static int ad2s1210_single_conversion(struct ad2s1210_state *st, ...@@ -432,7 +423,7 @@ static int ad2s1210_single_conversion(struct ad2s1210_state *st,
} }
error_ret: error_ret:
gpiod_set_value(st->gpios[AD2S1210_SAMPLE], 1); gpiod_set_value(st->sample_gpio, 0);
/* delay (2 * tck + 20) nano seconds */ /* delay (2 * tck + 20) nano seconds */
udelay(1); udelay(1);
mutex_unlock(&st->lock); mutex_unlock(&st->lock);
...@@ -546,7 +537,9 @@ static int ad2s1210_initial(struct ad2s1210_state *st) ...@@ -546,7 +537,9 @@ static int ad2s1210_initial(struct ad2s1210_state *st)
int ret; int ret;
mutex_lock(&st->lock); mutex_lock(&st->lock);
ad2s1210_set_resolution_pin(st); ret = ad2s1210_set_resolution_gpios(st, st->resolution);
if (ret < 0)
goto error_ret;
/* Use default config register value plus resolution from devicetree. */ /* Use default config register value plus resolution from devicetree. */
data = FIELD_PREP(AD2S1210_PHASE_LOCK_RANGE_44, 1); data = FIELD_PREP(AD2S1210_PHASE_LOCK_RANGE_44, 1);
...@@ -612,20 +605,34 @@ static int ad2s1210_setup_clocks(struct ad2s1210_state *st) ...@@ -612,20 +605,34 @@ static int ad2s1210_setup_clocks(struct ad2s1210_state *st)
static int ad2s1210_setup_gpios(struct ad2s1210_state *st) static int ad2s1210_setup_gpios(struct ad2s1210_state *st)
{ {
struct spi_device *spi = st->sdev; struct device *dev = &st->sdev->dev;
int i, ret;
/* should not be sampling on startup */
for (i = 0; i < ARRAY_SIZE(gpios); i++) { st->sample_gpio = devm_gpiod_get(dev, "sample", GPIOD_OUT_LOW);
st->gpios[i] = devm_gpiod_get(&spi->dev, gpios[i].name, if (IS_ERR(st->sample_gpio))
gpios[i].flags); return dev_err_probe(dev, PTR_ERR(st->sample_gpio),
if (IS_ERR(st->gpios[i])) { "failed to request sample GPIO\n");
ret = PTR_ERR(st->gpios[i]);
dev_err(&spi->dev, /* both pins high means that we start in config mode */
"ad2s1210: failed to request %s GPIO: %d\n", st->mode_gpios = devm_gpiod_get_array(dev, "mode", GPIOD_OUT_HIGH);
gpios[i].name, ret); if (IS_ERR(st->mode_gpios))
return ret; return dev_err_probe(dev, PTR_ERR(st->mode_gpios),
} "failed to request mode GPIOs\n");
}
if (st->mode_gpios->ndescs != 2)
return dev_err_probe(dev, -EINVAL,
"requires exactly 2 mode-gpios\n");
/* both pins high means that we start with 16-bit resolution */
st->resolution_gpios = devm_gpiod_get_array(dev, "resolution",
GPIOD_OUT_HIGH);
if (IS_ERR(st->resolution_gpios))
return dev_err_probe(dev, PTR_ERR(st->resolution_gpios),
"failed to request resolution GPIOs\n");
if (st->resolution_gpios->ndescs != 2)
return dev_err_probe(dev, -EINVAL,
"requires exactly 2 resolution-gpios\n");
return 0; return 0;
} }
...@@ -690,7 +697,6 @@ static int ad2s1210_probe(struct spi_device *spi) ...@@ -690,7 +697,6 @@ static int ad2s1210_probe(struct spi_device *spi)
mutex_init(&st->lock); mutex_init(&st->lock);
st->sdev = spi; st->sdev = spi;
st->hysteresis = true; st->hysteresis = true;
st->mode = MOD_CONFIG;
st->resolution = 12; st->resolution = 12;
st->fexcit = AD2S1210_DEF_EXCIT; st->fexcit = AD2S1210_DEF_EXCIT;
......
Markdown is supported
0%
or
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment