On Thu, 21 Jun 2018 17:08:46 -0400
William Breathitt Gray <vilhelm.gray@xxxxxxxxx> wrote:
> From: Fabrice Gasnier <fabrice.gasnier@xxxxxx>
>
> Add support for new counter device to stm32-lptimer.
>
> Signed-off-by: Fabrice Gasnier <fabrice.gasnier@xxxxxx>
> Signed-off-by: William Breathitt Gray <vilhelm.gray@xxxxxxxxx>
Reviewed-by: Jonathan Cameron <Jonathan.Cameron@xxxxxxxxxx>
> ---
> drivers/counter/Kconfig | 10 +
> drivers/counter/Makefile | 1 +
> drivers/{iio => }/counter/stm32-lptimer-cnt.c | 361 ++++++++++++++++--
> drivers/iio/Kconfig | 1 -
> drivers/iio/Makefile | 1 -
> drivers/iio/counter/Kconfig | 17 -
> drivers/iio/counter/Makefile | 7 -
> 7 files changed, 350 insertions(+), 48 deletions(-)
> rename drivers/{iio => }/counter/stm32-lptimer-cnt.c (48%)
> delete mode 100644 drivers/iio/counter/Kconfig
> delete mode 100644 drivers/iio/counter/Makefile
>
> diff --git a/drivers/counter/Kconfig b/drivers/counter/Kconfig
> index fcfbaa935122..fc072b97e5d2 100644
> --- a/drivers/counter/Kconfig
> +++ b/drivers/counter/Kconfig
> @@ -46,4 +46,14 @@ config STM32_TIMER_CNT
> To compile this driver as a module, choose M here: the
> module will be called stm32-timer-cnt.
>
> +config STM32_LPTIMER_CNT
> + tristate "STM32 LP Timer encoder counter driver"
> + depends on (MFD_STM32_LPTIMER || COMPILE_TEST) && IIO
> + help
> + Select this option to enable STM32 Low-Power Timer quadrature encoder
> + and counter driver.
> +
> + To compile this driver as a module, choose M here: the
> + module will be called stm32-lptimer-cnt.
> +
> endif # COUNTER
> diff --git a/drivers/counter/Makefile b/drivers/counter/Makefile
> index ff024259fb46..8ff19b32022b 100644
> --- a/drivers/counter/Makefile
> +++ b/drivers/counter/Makefile
> @@ -9,3 +9,4 @@ counter-y := generic-counter.o
>
> obj-$(CONFIG_104_QUAD_8) += 104-quad-8.o
> obj-$(CONFIG_STM32_TIMER_CNT) += stm32-timer-cnt.o
> +obj-$(CONFIG_STM32_LPTIMER_CNT) += stm32-lptimer-cnt.o
> diff --git a/drivers/iio/counter/stm32-lptimer-cnt.c b/drivers/counter/stm32-lptimer-cnt.c
> similarity index 48%
> rename from drivers/iio/counter/stm32-lptimer-cnt.c
> rename to drivers/counter/stm32-lptimer-cnt.c
> index 42fb8ba67090..80fc883f84e7 100644
> --- a/drivers/iio/counter/stm32-lptimer-cnt.c
> +++ b/drivers/counter/stm32-lptimer-cnt.c
> @@ -11,16 +11,18 @@
> */
>
> #include <linux/bitfield.h>
> +#include <linux/counter.h>
> #include <linux/iio/iio.h>
> #include <linux/mfd/stm32-lptimer.h>
> #include <linux/module.h>
> #include <linux/platform_device.h>
>
> struct stm32_lptim_cnt {
> + struct counter_device counter;
> struct device *dev;
> struct regmap *regmap;
> struct clk *clk;
> - u32 preset;
> + u32 ceiling;
> u32 polarity;
> u32 quadrature_mode;
> };
> @@ -54,7 +56,7 @@ static int stm32_lptim_set_enable_state(struct stm32_lptim_cnt *priv,
> }
>
> /* LP timer must be enabled before writing CMP & ARR */
> - ret = regmap_write(priv->regmap, STM32_LPTIM_ARR, priv->preset);
> + ret = regmap_write(priv->regmap, STM32_LPTIM_ARR, priv->ceiling);
> if (ret)
> return ret;
>
> @@ -247,44 +249,57 @@ static const struct iio_enum stm32_lptim_cnt_polarity_en = {
> .set = stm32_lptim_cnt_set_polarity,
> };
>
> -static ssize_t stm32_lptim_cnt_get_preset(struct iio_dev *indio_dev,
> - uintptr_t private,
> - const struct iio_chan_spec *chan,
> - char *buf)
> +static ssize_t stm32_lptim_cnt_get_ceiling(struct stm32_lptim_cnt *priv,
> + char *buf)
> {
> - struct stm32_lptim_cnt *priv = iio_priv(indio_dev);
> -
> - return snprintf(buf, PAGE_SIZE, "%u\n", priv->preset);
> + return snprintf(buf, PAGE_SIZE, "%u\n", priv->ceiling);
> }
>
> -static ssize_t stm32_lptim_cnt_set_preset(struct iio_dev *indio_dev,
> - uintptr_t private,
> - const struct iio_chan_spec *chan,
> - const char *buf, size_t len)
> +static ssize_t stm32_lptim_cnt_set_ceiling(struct stm32_lptim_cnt *priv,
> + const char *buf, size_t len)
> {
> - struct stm32_lptim_cnt *priv = iio_priv(indio_dev);
> int ret;
>
> if (stm32_lptim_is_enabled(priv))
> return -EBUSY;
>
> - ret = kstrtouint(buf, 0, &priv->preset);
> + ret = kstrtouint(buf, 0, &priv->ceiling);
> if (ret)
> return ret;
>
> - if (priv->preset > STM32_LPTIM_MAX_ARR)
> + if (priv->ceiling > STM32_LPTIM_MAX_ARR)
> return -EINVAL;
>
> return len;
> }
>
> +static ssize_t stm32_lptim_cnt_get_preset_iio(struct iio_dev *indio_dev,
> + uintptr_t private,
> + const struct iio_chan_spec *chan,
> + char *buf)
> +{
> + struct stm32_lptim_cnt *priv = iio_priv(indio_dev);
> +
> + return stm32_lptim_cnt_get_ceiling(priv, buf);
> +}
> +
> +static ssize_t stm32_lptim_cnt_set_preset_iio(struct iio_dev *indio_dev,
> + uintptr_t private,
> + const struct iio_chan_spec *chan,
> + const char *buf, size_t len)
> +{
> + struct stm32_lptim_cnt *priv = iio_priv(indio_dev);
> +
> + return stm32_lptim_cnt_set_ceiling(priv, buf, len);
> +}
> +
> /* LP timer with encoder */
> static const struct iio_chan_spec_ext_info stm32_lptim_enc_ext_info[] = {
> {
> .name = "preset",
> .shared = IIO_SEPARATE,
> - .read = stm32_lptim_cnt_get_preset,
> - .write = stm32_lptim_cnt_set_preset,
> + .read = stm32_lptim_cnt_get_preset_iio,
> + .write = stm32_lptim_cnt_set_preset_iio,
> },
> IIO_ENUM("polarity", IIO_SEPARATE, &stm32_lptim_cnt_polarity_en),
> IIO_ENUM_AVAILABLE("polarity", &stm32_lptim_cnt_polarity_en),
> @@ -309,8 +324,8 @@ static const struct iio_chan_spec_ext_info stm32_lptim_cnt_ext_info[] = {
> {
> .name = "preset",
> .shared = IIO_SEPARATE,
> - .read = stm32_lptim_cnt_get_preset,
> - .write = stm32_lptim_cnt_set_preset,
> + .read = stm32_lptim_cnt_get_preset_iio,
> + .write = stm32_lptim_cnt_set_preset_iio,
> },
> IIO_ENUM("polarity", IIO_SEPARATE, &stm32_lptim_cnt_polarity_en),
> IIO_ENUM_AVAILABLE("polarity", &stm32_lptim_cnt_polarity_en),
> @@ -327,11 +342,293 @@ static const struct iio_chan_spec stm32_lptim_cnt_channels = {
> .indexed = 1,
> };
>
> +/**
> + * stm32_lptim_cnt_function - enumerates stm32 LPTimer counter & encoder modes
> + * @STM32_LPTIM_COUNTER_INCREASE: up count on IN1 rising, falling or both edges
> + * @STM32_LPTIM_ENCODER_BOTH_EDGE: count on both edges (IN1 & IN2 quadrature)
> + */
> +enum stm32_lptim_cnt_function {
> + STM32_LPTIM_COUNTER_INCREASE,
> + STM32_LPTIM_ENCODER_BOTH_EDGE,
> +};
> +
> +static enum count_function stm32_lptim_cnt_functions[] = {
> + [STM32_LPTIM_COUNTER_INCREASE] = COUNT_FUNCTION_INCREASE,
> + [STM32_LPTIM_ENCODER_BOTH_EDGE] = COUNT_FUNCTION_QUADRATURE_X4,
> +};
> +
> +enum stm32_lptim_synapse_action {
> + STM32_LPTIM_SYNAPSE_ACTION_RISING_EDGE,
> + STM32_LPTIM_SYNAPSE_ACTION_FALLING_EDGE,
> + STM32_LPTIM_SYNAPSE_ACTION_BOTH_EDGES,
> + STM32_LPTIM_SYNAPSE_ACTION_NONE,
> +};
> +
> +static enum synapse_action stm32_lptim_cnt_synapse_actions[] = {
> + /* Index must match with stm32_lptim_cnt_polarity[] (priv->polarity) */
> + [STM32_LPTIM_SYNAPSE_ACTION_RISING_EDGE] = SYNAPSE_ACTION_RISING_EDGE,
> + [STM32_LPTIM_SYNAPSE_ACTION_FALLING_EDGE] = SYNAPSE_ACTION_FALLING_EDGE,
> + [STM32_LPTIM_SYNAPSE_ACTION_BOTH_EDGES] = SYNAPSE_ACTION_BOTH_EDGES,
> + [STM32_LPTIM_SYNAPSE_ACTION_NONE] = SYNAPSE_ACTION_NONE,
> +};
> +
> +static int stm32_lptim_cnt_read(struct counter_device *counter,
> + struct counter_count *count,
> + struct count_read_value *val)
> +{
> + struct stm32_lptim_cnt *const priv = counter->priv;
> + u32 cnt;
> + int ret;
> +
> + ret = regmap_read(priv->regmap, STM32_LPTIM_CNT, &cnt);
> + if (ret)
> + return ret;
> +
> + count_read_value_set(val, COUNT_POSITION, &cnt);
> +
> + return 0;
> +}
> +
> +static int stm32_lptim_cnt_function_get(struct counter_device *counter,
> + struct counter_count *count,
> + size_t *function)
> +{
> + struct stm32_lptim_cnt *const priv = counter->priv;
> +
> + if (!priv->quadrature_mode) {
> + *function = STM32_LPTIM_COUNTER_INCREASE;
> + return 0;
> + }
> +
> + if (priv->polarity == STM32_LPTIM_SYNAPSE_ACTION_BOTH_EDGES) {
> + *function = STM32_LPTIM_ENCODER_BOTH_EDGE;
> + return 0;
> + }
> +
> + return -EINVAL;
> +}
> +
> +static int stm32_lptim_cnt_function_set(struct counter_device *counter,
> + struct counter_count *count,
> + size_t function)
> +{
> + struct stm32_lptim_cnt *const priv = counter->priv;
> +
> + if (stm32_lptim_is_enabled(priv))
> + return -EBUSY;
> +
> + switch (function) {
> + case STM32_LPTIM_COUNTER_INCREASE:
> + priv->quadrature_mode = 0;
> + return 0;
> + case STM32_LPTIM_ENCODER_BOTH_EDGE:
> + priv->quadrature_mode = 1;
> + priv->polarity = STM32_LPTIM_SYNAPSE_ACTION_BOTH_EDGES;
> + return 0;
> + }
> +
> + return -EINVAL;
> +}
> +
> +static ssize_t stm32_lptim_cnt_enable_read(struct counter_device *counter,
> + struct counter_count *count,
> + void *private, char *buf)
> +{
> + struct stm32_lptim_cnt *const priv = counter->priv;
> + int ret;
> +
> + ret = stm32_lptim_is_enabled(priv);
> + if (ret < 0)
> + return ret;
> +
> + return scnprintf(buf, PAGE_SIZE, "%u\n", ret);
> +}
> +
> +static ssize_t stm32_lptim_cnt_enable_write(struct counter_device *counter,
> + struct counter_count *count,
> + void *private,
> + const char *buf, size_t len)
> +{
> + struct stm32_lptim_cnt *const priv = counter->priv;
> + bool enable;
> + int ret;
> +
> + ret = kstrtobool(buf, &enable);
> + if (ret)
> + return ret;
> +
> + /* Check nobody uses the timer, or already disabled/enabled */
> + ret = stm32_lptim_is_enabled(priv);
> + if ((ret < 0) || (!ret && !enable))
> + return ret;
> + if (enable && ret)
> + return -EBUSY;
> +
> + ret = stm32_lptim_setup(priv, enable);
> + if (ret)
> + return ret;
> +
> + ret = stm32_lptim_set_enable_state(priv, enable);
> + if (ret)
> + return ret;
> +
> + return len;
> +}
> +
> +static ssize_t stm32_lptim_cnt_ceiling_read(struct counter_device *counter,
> + struct counter_count *count,
> + void *private, char *buf)
> +{
> + struct stm32_lptim_cnt *const priv = counter->priv;
> +
> + return stm32_lptim_cnt_get_ceiling(priv, buf);
> +}
> +
> +static ssize_t stm32_lptim_cnt_ceiling_write(struct counter_device *counter,
> + struct counter_count *count,
> + void *private,
> + const char *buf, size_t len)
> +{
> + struct stm32_lptim_cnt *const priv = counter->priv;
> +
> + return stm32_lptim_cnt_set_ceiling(priv, buf, len);
> +}
> +
> +static const struct counter_count_ext stm32_lptim_cnt_ext[] = {
> + {
> + .name = "enable",
> + .read = stm32_lptim_cnt_enable_read,
> + .write = stm32_lptim_cnt_enable_write
> + },
> + {
> + .name = "ceiling",
> + .read = stm32_lptim_cnt_ceiling_read,
> + .write = stm32_lptim_cnt_ceiling_write
> + },
> +};
> +
> +static int stm32_lptim_cnt_action_get(struct counter_device *counter,
> + struct counter_count *count,
> + struct counter_synapse *synapse,
> + size_t *action)
> +{
> + struct stm32_lptim_cnt *const priv = counter->priv;
> + size_t function;
> + int err;
> +
> + err = stm32_lptim_cnt_function_get(counter, count, &function);
> + if (err)
> + return err;
> +
> + switch (function) {
> + case STM32_LPTIM_COUNTER_INCREASE:
> + /* LP Timer acts as up-counter on input 1 */
> + if (synapse->signal->id == count->synapses[0].signal->id)
> + *action = priv->polarity;
> + else
> + *action = STM32_LPTIM_SYNAPSE_ACTION_NONE;
> + return 0;
> + case STM32_LPTIM_ENCODER_BOTH_EDGE:
> + *action = priv->polarity;
> + return 0;
> + }
> +
> + return -EINVAL;
> +}
> +
> +static int stm32_lptim_cnt_action_set(struct counter_device *counter,
> + struct counter_count *count,
> + struct counter_synapse *synapse,
> + size_t action)
> +{
> + struct stm32_lptim_cnt *const priv = counter->priv;
> + size_t function;
> + int err;
> +
> + if (stm32_lptim_is_enabled(priv))
> + return -EBUSY;
> +
> + err = stm32_lptim_cnt_function_get(counter, count, &function);
> + if (err)
> + return err;
> +
> + /* only set polarity when in counter mode (on input 1) */
> + if (function == STM32_LPTIM_COUNTER_INCREASE
> + && synapse->signal->id == count->synapses[0].signal->id) {
> + switch (action) {
> + case STM32_LPTIM_SYNAPSE_ACTION_RISING_EDGE:
> + case STM32_LPTIM_SYNAPSE_ACTION_FALLING_EDGE:
> + case STM32_LPTIM_SYNAPSE_ACTION_BOTH_EDGES:
> + priv->polarity = action;
> + return 0;
> + }
> + }
> +
> + return -EINVAL;
> +}
> +
> +static const struct counter_ops stm32_lptim_cnt_ops = {
> + .count_read = stm32_lptim_cnt_read,
> + .function_get = stm32_lptim_cnt_function_get,
> + .function_set = stm32_lptim_cnt_function_set,
> + .action_get = stm32_lptim_cnt_action_get,
> + .action_set = stm32_lptim_cnt_action_set,
> +};
> +
> +static struct counter_signal stm32_lptim_cnt_signals[] = {
> + {
> + .id = 0,
> + .name = "Channel 1 Quadrature A"
> + },
> + {
> + .id = 1,
> + .name = "Channel 1 Quadrature B"
> + }
> +};
> +
> +static struct counter_synapse stm32_lptim_cnt_synapses[] = {
> + {
> + .actions_list = stm32_lptim_cnt_synapse_actions,
> + .num_actions = ARRAY_SIZE(stm32_lptim_cnt_synapse_actions),
> + .signal = &stm32_lptim_cnt_signals[0]
> + },
> + {
> + .actions_list = stm32_lptim_cnt_synapse_actions,
> + .num_actions = ARRAY_SIZE(stm32_lptim_cnt_synapse_actions),
> + .signal = &stm32_lptim_cnt_signals[1]
> + }
> +};
> +
> +/* LP timer with encoder */
> +static struct counter_count stm32_lptim_enc_counts = {
> + .id = 0,
> + .name = "LPTimer Count",
> + .functions_list = stm32_lptim_cnt_functions,
> + .num_functions = ARRAY_SIZE(stm32_lptim_cnt_functions),
> + .synapses = stm32_lptim_cnt_synapses,
> + .num_synapses = ARRAY_SIZE(stm32_lptim_cnt_synapses),
> + .ext = stm32_lptim_cnt_ext,
> + .num_ext = ARRAY_SIZE(stm32_lptim_cnt_ext)
> +};
> +
> +/* LP timer without encoder (counter only) */
> +static struct counter_count stm32_lptim_in1_counts = {
> + .id = 0,
> + .name = "LPTimer Count",
> + .functions_list = stm32_lptim_cnt_functions,
> + .num_functions = 1,
> + .synapses = stm32_lptim_cnt_synapses,
> + .num_synapses = 1,
> + .ext = stm32_lptim_cnt_ext,
> + .num_ext = ARRAY_SIZE(stm32_lptim_cnt_ext)
> +};
> +
> static int stm32_lptim_cnt_probe(struct platform_device *pdev)
> {
> struct stm32_lptimer *ddata = dev_get_drvdata(pdev->dev.parent);
> struct stm32_lptim_cnt *priv;
> struct iio_dev *indio_dev;
> + int ret;
>
> if (IS_ERR_OR_NULL(ddata))
> return -EINVAL;
> @@ -344,8 +641,9 @@ static int stm32_lptim_cnt_probe(struct platform_device *pdev)
> priv->dev = &pdev->dev;
> priv->regmap = ddata->regmap;
> priv->clk = ddata->clk;
> - priv->preset = STM32_LPTIM_MAX_ARR;
> + priv->ceiling = STM32_LPTIM_MAX_ARR;
>
> + /* Initialize IIO device */
> indio_dev->name = dev_name(&pdev->dev);
> indio_dev->dev.parent = &pdev->dev;
> indio_dev->dev.of_node = pdev->dev.of_node;
> @@ -356,9 +654,28 @@ static int stm32_lptim_cnt_probe(struct platform_device *pdev)
> indio_dev->channels = &stm32_lptim_cnt_channels;
> indio_dev->num_channels = 1;
>
> + /* Initialize Counter device */
> + priv->counter.name = dev_name(&pdev->dev);
> + priv->counter.parent = &pdev->dev;
> + priv->counter.ops = &stm32_lptim_cnt_ops;
> + if (ddata->has_encoder) {
> + priv->counter.counts = &stm32_lptim_enc_counts;
> + priv->counter.num_signals = ARRAY_SIZE(stm32_lptim_cnt_signals);
> + } else {
> + priv->counter.counts = &stm32_lptim_in1_counts;
> + priv->counter.num_signals = 1;
> + }
> + priv->counter.num_counts = 1;
> + priv->counter.signals = stm32_lptim_cnt_signals;
> + priv->counter.priv = priv;
> +
> platform_set_drvdata(pdev, priv);
>
> - return devm_iio_device_register(&pdev->dev, indio_dev);
> + ret = devm_iio_device_register(&pdev->dev, indio_dev);
> + if (ret)
> + return ret;
> +
> + return devm_counter_register(&pdev->dev, &priv->counter);
> }
>
> static const struct of_device_id stm32_lptim_cnt_of_match[] = {
> diff --git a/drivers/iio/Kconfig b/drivers/iio/Kconfig
> index d08aeb41cd07..ac764840483a 100644
> --- a/drivers/iio/Kconfig
> +++ b/drivers/iio/Kconfig
> @@ -74,7 +74,6 @@ source "drivers/iio/afe/Kconfig"
> source "drivers/iio/amplifiers/Kconfig"
> source "drivers/iio/chemical/Kconfig"
> source "drivers/iio/common/Kconfig"
> -source "drivers/iio/counter/Kconfig"
> source "drivers/iio/dac/Kconfig"
> source "drivers/iio/dummy/Kconfig"
> source "drivers/iio/frequency/Kconfig"
> diff --git a/drivers/iio/Makefile b/drivers/iio/Makefile
> index cb5993251381..bff682ad1cfb 100644
> --- a/drivers/iio/Makefile
> +++ b/drivers/iio/Makefile
> @@ -20,7 +20,6 @@ obj-y += amplifiers/
> obj-y += buffer/
> obj-y += chemical/
> obj-y += common/
> -obj-y += counter/
> obj-y += dac/
> obj-y += dummy/
> obj-y += gyro/
> diff --git a/drivers/iio/counter/Kconfig b/drivers/iio/counter/Kconfig
> deleted file mode 100644
> index eeb358122cbe..000000000000
> --- a/drivers/iio/counter/Kconfig
> +++ /dev/null
> @@ -1,17 +0,0 @@
> -#
> -# Counter devices
> -#
> -# When adding new entries keep the list in alphabetical order
> -
> -menu "Counters"
> -
> -config STM32_LPTIMER_CNT
> - tristate "STM32 LP Timer encoder counter driver"
> - depends on MFD_STM32_LPTIMER || COMPILE_TEST
> - help
> - Select this option to enable STM32 Low-Power Timer quadrature encoder
> - and counter driver.
> -
> - To compile this driver as a module, choose M here: the
> - module will be called stm32-lptimer-cnt.
> -endmenu
> diff --git a/drivers/iio/counter/Makefile b/drivers/iio/counter/Makefile
> deleted file mode 100644
> index 93933ba49280..000000000000
> --- a/drivers/iio/counter/Makefile
> +++ /dev/null
> @@ -1,7 +0,0 @@
> -#
> -# Makefile for IIO counter devices
> -#
> -
> -# When adding new entries keep the list in alphabetical order
> -
> -obj-$(CONFIG_STM32_LPTIMER_CNT) += stm32-lptimer-cnt.o
--
To unsubscribe from this list: send the line "unsubscribe devicetree" in
the body of a message to majordomo@xxxxxxxxxxxxxxx
More majordomo info at http://vger.kernel.org/majordomo-info.html
