Author | Tokens | Token Proportion | Commits | Commit Proportion |
---|---|---|---|---|
Fabrice Gasnier | 3057 | 99.93% | 3 | 75.00% |
Benjamin Gaignard | 2 | 0.07% | 1 | 25.00% |
Total | 3059 | 4 |
// SPDX-License-Identifier: GPL-2.0 /* * STM32 Low-Power Timer Encoder and Counter driver * * Copyright (C) STMicroelectronics 2017 * * Author: Fabrice Gasnier <fabrice.gasnier@st.com> * * Inspired by 104-quad-8 and stm32-timer-trigger drivers. * */ #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/pinctrl/consumer.h> #include <linux/platform_device.h> struct stm32_lptim_cnt { struct counter_device counter; struct device *dev; struct regmap *regmap; struct clk *clk; u32 ceiling; u32 polarity; u32 quadrature_mode; bool enabled; }; static int stm32_lptim_is_enabled(struct stm32_lptim_cnt *priv) { u32 val; int ret; ret = regmap_read(priv->regmap, STM32_LPTIM_CR, &val); if (ret) return ret; return FIELD_GET(STM32_LPTIM_ENABLE, val); } static int stm32_lptim_set_enable_state(struct stm32_lptim_cnt *priv, int enable) { int ret; u32 val; val = FIELD_PREP(STM32_LPTIM_ENABLE, enable); ret = regmap_write(priv->regmap, STM32_LPTIM_CR, val); if (ret) return ret; if (!enable) { clk_disable(priv->clk); priv->enabled = false; return 0; } /* LP timer must be enabled before writing CMP & ARR */ ret = regmap_write(priv->regmap, STM32_LPTIM_ARR, priv->ceiling); if (ret) return ret; ret = regmap_write(priv->regmap, STM32_LPTIM_CMP, 0); if (ret) return ret; /* ensure CMP & ARR registers are properly written */ ret = regmap_read_poll_timeout(priv->regmap, STM32_LPTIM_ISR, val, (val & STM32_LPTIM_CMPOK_ARROK), 100, 1000); if (ret) return ret; ret = regmap_write(priv->regmap, STM32_LPTIM_ICR, STM32_LPTIM_CMPOKCF_ARROKCF); if (ret) return ret; ret = clk_enable(priv->clk); if (ret) { regmap_write(priv->regmap, STM32_LPTIM_CR, 0); return ret; } priv->enabled = true; /* Start LP timer in continuous mode */ return regmap_update_bits(priv->regmap, STM32_LPTIM_CR, STM32_LPTIM_CNTSTRT, STM32_LPTIM_CNTSTRT); } static int stm32_lptim_setup(struct stm32_lptim_cnt *priv, int enable) { u32 mask = STM32_LPTIM_ENC | STM32_LPTIM_COUNTMODE | STM32_LPTIM_CKPOL | STM32_LPTIM_PRESC; u32 val; /* Setup LP timer encoder/counter and polarity, without prescaler */ if (priv->quadrature_mode) val = enable ? STM32_LPTIM_ENC : 0; else val = enable ? STM32_LPTIM_COUNTMODE : 0; val |= FIELD_PREP(STM32_LPTIM_CKPOL, enable ? priv->polarity : 0); return regmap_update_bits(priv->regmap, STM32_LPTIM_CFGR, mask, val); } static int stm32_lptim_write_raw(struct iio_dev *indio_dev, struct iio_chan_spec const *chan, int val, int val2, long mask) { struct stm32_lptim_cnt *priv = iio_priv(indio_dev); int ret; switch (mask) { case IIO_CHAN_INFO_ENABLE: if (val < 0 || val > 1) return -EINVAL; /* Check nobody uses the timer, or already disabled/enabled */ ret = stm32_lptim_is_enabled(priv); if ((ret < 0) || (!ret && !val)) return ret; if (val && ret) return -EBUSY; ret = stm32_lptim_setup(priv, val); if (ret) return ret; return stm32_lptim_set_enable_state(priv, val); default: return -EINVAL; } } static int stm32_lptim_read_raw(struct iio_dev *indio_dev, struct iio_chan_spec const *chan, int *val, int *val2, long mask) { struct stm32_lptim_cnt *priv = iio_priv(indio_dev); u32 dat; int ret; switch (mask) { case IIO_CHAN_INFO_RAW: ret = regmap_read(priv->regmap, STM32_LPTIM_CNT, &dat); if (ret) return ret; *val = dat; return IIO_VAL_INT; case IIO_CHAN_INFO_ENABLE: ret = stm32_lptim_is_enabled(priv); if (ret < 0) return ret; *val = ret; return IIO_VAL_INT; case IIO_CHAN_INFO_SCALE: /* Non-quadrature mode: scale = 1 */ *val = 1; *val2 = 0; if (priv->quadrature_mode) { /* * Quadrature encoder mode: * - both edges, quarter cycle, scale is 0.25 * - either rising/falling edge scale is 0.5 */ if (priv->polarity > 1) *val2 = 2; else *val2 = 1; } return IIO_VAL_FRACTIONAL_LOG2; default: return -EINVAL; } } static const struct iio_info stm32_lptim_cnt_iio_info = { .read_raw = stm32_lptim_read_raw, .write_raw = stm32_lptim_write_raw, }; static const char *const stm32_lptim_quadrature_modes[] = { "non-quadrature", "quadrature", }; static int stm32_lptim_get_quadrature_mode(struct iio_dev *indio_dev, const struct iio_chan_spec *chan) { struct stm32_lptim_cnt *priv = iio_priv(indio_dev); return priv->quadrature_mode; } static int stm32_lptim_set_quadrature_mode(struct iio_dev *indio_dev, const struct iio_chan_spec *chan, unsigned int type) { struct stm32_lptim_cnt *priv = iio_priv(indio_dev); if (stm32_lptim_is_enabled(priv)) return -EBUSY; priv->quadrature_mode = type; return 0; } static const struct iio_enum stm32_lptim_quadrature_mode_en = { .items = stm32_lptim_quadrature_modes, .num_items = ARRAY_SIZE(stm32_lptim_quadrature_modes), .get = stm32_lptim_get_quadrature_mode, .set = stm32_lptim_set_quadrature_mode, }; static const char * const stm32_lptim_cnt_polarity[] = { "rising-edge", "falling-edge", "both-edges", }; static int stm32_lptim_cnt_get_polarity(struct iio_dev *indio_dev, const struct iio_chan_spec *chan) { struct stm32_lptim_cnt *priv = iio_priv(indio_dev); return priv->polarity; } static int stm32_lptim_cnt_set_polarity(struct iio_dev *indio_dev, const struct iio_chan_spec *chan, unsigned int type) { struct stm32_lptim_cnt *priv = iio_priv(indio_dev); if (stm32_lptim_is_enabled(priv)) return -EBUSY; priv->polarity = type; return 0; } static const struct iio_enum stm32_lptim_cnt_polarity_en = { .items = stm32_lptim_cnt_polarity, .num_items = ARRAY_SIZE(stm32_lptim_cnt_polarity), .get = stm32_lptim_cnt_get_polarity, .set = stm32_lptim_cnt_set_polarity, }; static ssize_t stm32_lptim_cnt_get_ceiling(struct stm32_lptim_cnt *priv, char *buf) { return snprintf(buf, PAGE_SIZE, "%u\n", priv->ceiling); } static ssize_t stm32_lptim_cnt_set_ceiling(struct stm32_lptim_cnt *priv, const char *buf, size_t len) { int ret; if (stm32_lptim_is_enabled(priv)) return -EBUSY; ret = kstrtouint(buf, 0, &priv->ceiling); if (ret) return ret; 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_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), IIO_ENUM("quadrature_mode", IIO_SEPARATE, &stm32_lptim_quadrature_mode_en), IIO_ENUM_AVAILABLE("quadrature_mode", &stm32_lptim_quadrature_mode_en), {} }; static const struct iio_chan_spec stm32_lptim_enc_channels = { .type = IIO_COUNT, .channel = 0, .info_mask_separate = BIT(IIO_CHAN_INFO_RAW) | BIT(IIO_CHAN_INFO_ENABLE) | BIT(IIO_CHAN_INFO_SCALE), .ext_info = stm32_lptim_enc_ext_info, .indexed = 1, }; /* LP timer without encoder (counter only) */ static const struct iio_chan_spec_ext_info stm32_lptim_cnt_ext_info[] = { { .name = "preset", .shared = IIO_SEPARATE, .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), {} }; static const struct iio_chan_spec stm32_lptim_cnt_channels = { .type = IIO_COUNT, .channel = 0, .info_mask_separate = BIT(IIO_CHAN_INFO_RAW) | BIT(IIO_CHAN_INFO_ENABLE) | BIT(IIO_CHAN_INFO_SCALE), .ext_info = stm32_lptim_cnt_ext_info, .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 counter_count_function stm32_lptim_cnt_functions[] = { [STM32_LPTIM_COUNTER_INCREASE] = COUNTER_COUNT_FUNCTION_INCREASE, [STM32_LPTIM_ENCODER_BOTH_EDGE] = COUNTER_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 counter_synapse_action stm32_lptim_cnt_synapse_actions[] = { /* Index must match with stm32_lptim_cnt_polarity[] (priv->polarity) */ [STM32_LPTIM_SYNAPSE_ACTION_RISING_EDGE] = COUNTER_SYNAPSE_ACTION_RISING_EDGE, [STM32_LPTIM_SYNAPSE_ACTION_FALLING_EDGE] = COUNTER_SYNAPSE_ACTION_FALLING_EDGE, [STM32_LPTIM_SYNAPSE_ACTION_BOTH_EDGES] = COUNTER_SYNAPSE_ACTION_BOTH_EDGES, [STM32_LPTIM_SYNAPSE_ACTION_NONE] = COUNTER_SYNAPSE_ACTION_NONE, }; static int stm32_lptim_cnt_read(struct counter_device *counter, struct counter_count *count, struct counter_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; counter_count_read_value_set(val, COUNTER_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; indio_dev = devm_iio_device_alloc(&pdev->dev, sizeof(*priv)); if (!indio_dev) return -ENOMEM; priv = iio_priv(indio_dev); priv->dev = &pdev->dev; priv->regmap = ddata->regmap; priv->clk = ddata->clk; 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; indio_dev->info = &stm32_lptim_cnt_iio_info; if (ddata->has_encoder) indio_dev->channels = &stm32_lptim_enc_channels; else 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); ret = devm_iio_device_register(&pdev->dev, indio_dev); if (ret) return ret; return devm_counter_register(&pdev->dev, &priv->counter); } #ifdef CONFIG_PM_SLEEP static int stm32_lptim_cnt_suspend(struct device *dev) { struct stm32_lptim_cnt *priv = dev_get_drvdata(dev); int ret; /* Only take care of enabled counter: don't disturb other MFD child */ if (priv->enabled) { ret = stm32_lptim_setup(priv, 0); if (ret) return ret; ret = stm32_lptim_set_enable_state(priv, 0); if (ret) return ret; /* Force enable state for later resume */ priv->enabled = true; } return pinctrl_pm_select_sleep_state(dev); } static int stm32_lptim_cnt_resume(struct device *dev) { struct stm32_lptim_cnt *priv = dev_get_drvdata(dev); int ret; ret = pinctrl_pm_select_default_state(dev); if (ret) return ret; if (priv->enabled) { priv->enabled = false; ret = stm32_lptim_setup(priv, 1); if (ret) return ret; ret = stm32_lptim_set_enable_state(priv, 1); if (ret) return ret; } return 0; } #endif static SIMPLE_DEV_PM_OPS(stm32_lptim_cnt_pm_ops, stm32_lptim_cnt_suspend, stm32_lptim_cnt_resume); static const struct of_device_id stm32_lptim_cnt_of_match[] = { { .compatible = "st,stm32-lptimer-counter", }, {}, }; MODULE_DEVICE_TABLE(of, stm32_lptim_cnt_of_match); static struct platform_driver stm32_lptim_cnt_driver = { .probe = stm32_lptim_cnt_probe, .driver = { .name = "stm32-lptimer-counter", .of_match_table = stm32_lptim_cnt_of_match, .pm = &stm32_lptim_cnt_pm_ops, }, }; module_platform_driver(stm32_lptim_cnt_driver); MODULE_AUTHOR("Fabrice Gasnier <fabrice.gasnier@st.com>"); MODULE_ALIAS("platform:stm32-lptimer-counter"); MODULE_DESCRIPTION("STMicroelectronics STM32 LPTIM counter driver"); MODULE_LICENSE("GPL v2");
Information contained on this website is for historical information purposes only and does not indicate or represent copyright ownership.
Created with Cregit http://github.com/cregit/cregit
Version 2.0-RC1