|
@@ -594,13 +594,20 @@ static const char *const stm32_count_direction_states[] = {
|
|
|
|
|
|
static int stm32_set_count_direction(struct iio_dev *indio_dev,
|
|
|
const struct iio_chan_spec *chan,
|
|
|
- unsigned int mode)
|
|
|
+ unsigned int dir)
|
|
|
{
|
|
|
struct stm32_timer_trigger *priv = iio_priv(indio_dev);
|
|
|
+ u32 val;
|
|
|
+ int mode;
|
|
|
|
|
|
- regmap_update_bits(priv->regmap, TIM_CR1, TIM_CR1_DIR, mode);
|
|
|
+ /* In encoder mode, direction is RO (given by TI1/TI2 signals) */
|
|
|
+ regmap_read(priv->regmap, TIM_SMCR, &val);
|
|
|
+ mode = (val & TIM_SMCR_SMS) - 1;
|
|
|
+ if ((mode >= 0) || (mode < ARRAY_SIZE(stm32_quadrature_modes)))
|
|
|
+ return -EBUSY;
|
|
|
|
|
|
- return 0;
|
|
|
+ return regmap_update_bits(priv->regmap, TIM_CR1, TIM_CR1_DIR,
|
|
|
+ dir ? TIM_CR1_DIR : 0);
|
|
|
}
|
|
|
|
|
|
static int stm32_get_count_direction(struct iio_dev *indio_dev,
|
|
@@ -611,7 +618,7 @@ static int stm32_get_count_direction(struct iio_dev *indio_dev,
|
|
|
|
|
|
regmap_read(priv->regmap, TIM_CR1, &cr1);
|
|
|
|
|
|
- return (cr1 & TIM_CR1_DIR);
|
|
|
+ return ((cr1 & TIM_CR1_DIR) ? 1 : 0);
|
|
|
}
|
|
|
|
|
|
static const struct iio_enum stm32_count_direction_enum = {
|