Message ID | 20190306111208.7454-6-patrick.havelange@essensium.com (mailing list archive) |
---|---|
State | New, archived |
Headers | show |
Series | FlexTimer Module Quadrature decoder counter | expand |
On Wed, Mar 06, 2019 at 12:12:06PM +0100, Patrick Havelange wrote: > This driver exposes the counter for the quadrature decoder of the > FlexTimer Module, present in the LS1021A soc. > > Signed-off-by: Patrick Havelange <patrick.havelange@essensium.com> > --- > Changes v2 > - Rebased on new counter subsystem > - Cleaned up included headers > - Use devm_ioremap() > - Correct order of devm_ and unmanaged resources > --- > drivers/counter/Kconfig | 9 + > drivers/counter/Makefile | 1 + > drivers/counter/ftm-quaddec.c | 356 ++++++++++++++++++++++++++++++++++ > 3 files changed, 366 insertions(+) > create mode 100644 drivers/counter/ftm-quaddec.c Overall, I think you utilized the Generic Counter interface correctly. So good job on the conversion from your initial patch. :-) Some minor inline suggestions/comments follow. > > diff --git a/drivers/counter/Kconfig b/drivers/counter/Kconfig > index 87c491a19c63..233ac305d878 100644 > --- a/drivers/counter/Kconfig > +++ b/drivers/counter/Kconfig > @@ -48,4 +48,13 @@ config STM32_LPTIMER_CNT > To compile this driver as a module, choose M here: the > module will be called stm32-lptimer-cnt. > > +config FTM_QUADDEC > + tristate "Flex Timer Module Quadrature decoder driver" > + help > + Select this option to enable the Flex Timer Quadrature decoder > + driver. > + > + To compile this driver as a module, choose M here: the > + module will be called ftm-quaddec. > + > endif # COUNTER > diff --git a/drivers/counter/Makefile b/drivers/counter/Makefile > index 5589976d37f8..0c9e622a6bea 100644 > --- a/drivers/counter/Makefile > +++ b/drivers/counter/Makefile > @@ -7,3 +7,4 @@ obj-$(CONFIG_COUNTER) += 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 > +obj-$(CONFIG_FTM_QUADDEC) += ftm-quaddec.o > diff --git a/drivers/counter/ftm-quaddec.c b/drivers/counter/ftm-quaddec.c > new file mode 100644 > index 000000000000..1bc9e075a386 > --- /dev/null > +++ b/drivers/counter/ftm-quaddec.c > @@ -0,0 +1,356 @@ > +// SPDX-License-Identifier: GPL-2.0 > +/* > + * Flex Timer Module Quadrature decoder > + * > + * This module implements a driver for decoding the FTM quadrature > + * of ex. a LS1021A > + */ > + > +#include <linux/fsl/ftm.h> > +#include <linux/module.h> > +#include <linux/platform_device.h> > +#include <linux/of.h> > +#include <linux/io.h> > +#include <linux/mutex.h> > +#include <linux/counter.h> > + > +struct ftm_quaddec { > + struct counter_device counter; > + struct platform_device *pdev; > + void __iomem *ftm_base; > + bool big_endian; > + struct mutex ftm_quaddec_mutex; > +}; > + > +static void ftm_read(struct ftm_quaddec *ftm, uint32_t offset, uint32_t *data) > +{ > + if (ftm->big_endian) > + *data = ioread32be(ftm->ftm_base + offset); > + else > + *data = ioread32(ftm->ftm_base + offset); > +} > + > +static void ftm_write(struct ftm_quaddec *ftm, uint32_t offset, uint32_t data) > +{ > + if (ftm->big_endian) > + iowrite32be(data, ftm->ftm_base + offset); > + else > + iowrite32(data, ftm->ftm_base + offset); > +} > + > +/* > + * take mutex > + * call ftm_clear_write_protection > + * update settings > + * call ftm_set_write_protection > + * release mutex > + */ Jonathan mentioned it before in the previous review, and I think I agree too, that this comment block is superfluous: the context of this code is simple enough that the function call order is naturally obvious (i.e. write protection must be cleared before settings are modified). The only important thing to mention here is that the mutex must be held before the write protection state is modified so a comment along the following lines should suffice: /* hold mutex before modifying write protection state */ > +static void ftm_clear_write_protection(struct ftm_quaddec *ftm) > +{ > + uint32_t flag; > + > + /* First see if it is enabled */ > + ftm_read(ftm, FTM_FMS, &flag); > + > + if (flag & FTM_FMS_WPEN) { > + ftm_read(ftm, FTM_MODE, &flag); > + ftm_write(ftm, FTM_MODE, flag | FTM_MODE_WPDIS); > + } > +} > + > +static void ftm_set_write_protection(struct ftm_quaddec *ftm) > +{ > + ftm_write(ftm, FTM_FMS, FTM_FMS_WPEN); > +} > + > +static void ftm_reset_counter(struct ftm_quaddec *ftm) > +{ > + /* Reset hardware counter to CNTIN */ > + ftm_write(ftm, FTM_CNT, 0x0); > +} > + > +static void ftm_quaddec_init(struct ftm_quaddec *ftm) > +{ > + ftm_clear_write_protection(ftm); > + > + /* > + * Do not write in the region from the CNTIN register through the > + * PWMLOAD register when FTMEN = 0. > + */ > + ftm_write(ftm, FTM_MODE, FTM_MODE_FTMEN); > + ftm_write(ftm, FTM_CNTIN, 0x0000); > + ftm_write(ftm, FTM_MOD, 0xffff); > + ftm_write(ftm, FTM_CNT, 0x0); > + ftm_write(ftm, FTM_SC, FTM_SC_PS_1); > + > + /* Select quad mode */ > + ftm_write(ftm, FTM_QDCTRL, FTM_QDCTRL_QUADEN); > + > + /* Unused features and reset to default section */ > + ftm_write(ftm, FTM_POL, 0x0); > + ftm_write(ftm, FTM_FLTCTRL, 0x0); > + ftm_write(ftm, FTM_SYNCONF, 0x0); > + ftm_write(ftm, FTM_SYNC, 0xffff); > + > + /* Lock the FTM */ > + ftm_set_write_protection(ftm); > +} > + > +static void ftm_quaddec_disable(struct ftm_quaddec *ftm) > +{ > + ftm_write(ftm, FTM_MODE, 0); > +} The ftm_quaddec_disable function is only used for cleanup when the driver is being removed. Is disabling the FTM counter on removal actually something we need to do? While it's true that the register will keep updating, since the driver is no longer loaded, we don't care about that register value. Once we take control of the hardware again (by reloading our driver or via a new one), we reinitialize the counter and set the count value back to 0 anyway -- so whatever value the register had no longer matters. > + > +static int ftm_quaddec_get_prescaler(struct counter_device *counter, > + struct counter_count *count, > + size_t *cnt_mode) > +{ > + struct ftm_quaddec *ftm = counter->priv; > + uint32_t scflags; > + > + ftm_read(ftm, FTM_SC, &scflags); > + > + *cnt_mode = scflags & FTM_SC_PS_MASK; > + > + return 0; > +} > + > +static int ftm_quaddec_set_prescaler(struct counter_device *counter, > + struct counter_count *count, > + size_t cnt_mode) > +{ > + struct ftm_quaddec *ftm = counter->priv; > + > + uint32_t scflags; > + > + mutex_lock(&ftm->ftm_quaddec_mutex); > + > + ftm_read(ftm, FTM_SC, &scflags); > + > + scflags &= ~FTM_SC_PS_MASK; > + cnt_mode &= FTM_SC_PS_MASK; /*just to be 100% sure*/ > + > + scflags |= cnt_mode; > + > + /* Write */ > + ftm_clear_write_protection(ftm); > + ftm_write(ftm, FTM_SC, scflags); > + ftm_set_write_protection(ftm); > + > + /* Also resets the counter as it is undefined anyway now */ > + ftm_reset_counter(ftm); > + > + mutex_unlock(&ftm->ftm_quaddec_mutex); > + return 0; > +} > + > +static const char * const ftm_quaddec_prescaler[] = { > + "1", "2", "4", "8", "16", "32", "64", "128" > +}; > + > +static struct counter_count_enum_ext ftm_quaddec_prescaler_enum = { > + .items = ftm_quaddec_prescaler, > + .num_items = ARRAY_SIZE(ftm_quaddec_prescaler), > + .get = ftm_quaddec_get_prescaler, > + .set = ftm_quaddec_set_prescaler > +}; > + > +enum ftm_quaddec_synapse_action { > + FTM_QUADDEC_SYNAPSE_ACTION_BOTH_EDGES, > +}; > + > +static enum counter_synapse_action ftm_quaddec_synapse_actions[] = { > + [FTM_QUADDEC_SYNAPSE_ACTION_BOTH_EDGES] = > + COUNTER_SYNAPSE_ACTION_BOTH_EDGES > +}; > + > +enum ftm_quaddec_count_function { > + FTM_QUADDEC_COUNT_ENCODER_MODE_1, > +}; The FlexTimer Module supports more than just a quadrature counter mode doesn't it? We should keep this initial patch simple since we are still introducing the Counter subsystem, but it'll be nice to add support in the future for the other counter modes such as single-edge capture. > + > +static const enum counter_count_function ftm_quaddec_count_functions[] = { > + [FTM_QUADDEC_COUNT_ENCODER_MODE_1] = > + COUNTER_COUNT_FUNCTION_QUADRATURE_X4 > +}; > + > +static int ftm_quaddec_count_read(struct counter_device *counter, > + struct counter_count *count, > + struct counter_count_read_value *val) > +{ > + struct ftm_quaddec *const ftm = counter->priv; > + uint32_t cntval; > + > + ftm_read(ftm, FTM_CNT, &cntval); > + > + counter_count_read_value_set(val, COUNTER_COUNT_POSITION, &cntval); > + > + return 0; > +} > + > +static int ftm_quaddec_count_write(struct counter_device *counter, > + struct counter_count *count, > + struct counter_count_write_value *val) > +{ > + struct ftm_quaddec *const ftm = counter->priv; > + u32 cnt; > + int err; > + > + err = counter_count_write_value_get(&cnt, COUNTER_COUNT_POSITION, val); > + if (err) > + return err; > + > + if (cnt != 0) { > + dev_warn(&ftm->pdev->dev, "Can only accept '0' as new counter value\n"); > + return -EINVAL; > + } > + > + ftm_reset_counter(ftm); > + > + return 0; > +} > + > +static int ftm_quaddec_count_function_get(struct counter_device *counter, > + struct counter_count *count, > + size_t *function) > +{ > + *function = FTM_QUADDEC_COUNT_ENCODER_MODE_1; > + > + return 0; > +} > + > +static int ftm_quaddec_action_get(struct counter_device *counter, > + struct counter_count *count, > + struct counter_synapse *synapse, > + size_t *action) > +{ > + *action = FTM_QUADDEC_SYNAPSE_ACTION_BOTH_EDGES; > + > + return 0; > +} > + > +static const struct counter_ops ftm_quaddec_cnt_ops = { > + .count_read = ftm_quaddec_count_read, > + .count_write = ftm_quaddec_count_write, > + .function_get = ftm_quaddec_count_function_get, > + .action_get = ftm_quaddec_action_get, > +}; > + > +static struct counter_signal ftm_quaddec_signals[] = { > + { > + .id = 0, > + .name = "Channel 1 Quadrature A" > + }, > + { > + .id = 1, > + .name = "Channel 1 Quadrature B" > + } > +}; If possible, these names should match the FTM datasheet naming convention. The reason is to make it easier for users to match the input signals described in the datasheet with the Signal data provided by the Generic Counter interface. I think the FTM datasheet describes these signals as "Phase A" and "Phase B", so perhaps "Channel 1 Phase A" and "Channel 1 Phase B" may be more appropriate names in this case. > + > +static struct counter_synapse ftm_quaddec_count_synapses[] = { > + { > + .actions_list = ftm_quaddec_synapse_actions, > + .num_actions = ARRAY_SIZE(ftm_quaddec_synapse_actions), > + .signal = &ftm_quaddec_signals[0] > + }, > + { > + .actions_list = ftm_quaddec_synapse_actions, > + .num_actions = ARRAY_SIZE(ftm_quaddec_synapse_actions), > + .signal = &ftm_quaddec_signals[1] > + } > +}; > + > +static const struct counter_count_ext ftm_quaddec_count_ext[] = { > + COUNTER_COUNT_ENUM("prescaler", &ftm_quaddec_prescaler_enum), > + COUNTER_COUNT_ENUM_AVAILABLE("prescaler", &ftm_quaddec_prescaler_enum), > +}; > + > +static struct counter_count ftm_quaddec_counts = { > + .id = 0, > + .name = "Channel 1 Count", > + .functions_list = ftm_quaddec_count_functions, > + .num_functions = ARRAY_SIZE(ftm_quaddec_count_functions), > + .synapses = ftm_quaddec_count_synapses, > + .num_synapses = ARRAY_SIZE(ftm_quaddec_count_synapses), > + .ext = ftm_quaddec_count_ext, > + .num_ext = ARRAY_SIZE(ftm_quaddec_count_ext) > +}; > + > +static int ftm_quaddec_probe(struct platform_device *pdev) > +{ > + struct ftm_quaddec *ftm; > + > + struct device_node *node = pdev->dev.of_node; > + struct resource *io; > + int ret; > + > + ftm = devm_kzalloc(&pdev->dev, sizeof(*ftm), GFP_KERNEL); > + if (!ftm) > + return -ENOMEM; > + > + platform_set_drvdata(pdev, ftm); > + > + io = platform_get_resource(pdev, IORESOURCE_MEM, 0); > + if (!io) { > + dev_err(&pdev->dev, "Failed to get memory region\n"); > + return -ENODEV; > + } > + > + ftm->pdev = pdev; > + ftm->big_endian = of_property_read_bool(node, "big-endian"); > + ftm->ftm_base = devm_ioremap(&pdev->dev, io->start, resource_size(io)); > + > + if (!ftm->ftm_base) { > + dev_err(&pdev->dev, "Failed to map memory region\n"); > + return -EINVAL; > + } > + ftm->counter.name = dev_name(&pdev->dev); > + ftm->counter.parent = &pdev->dev; > + ftm->counter.ops = &ftm_quaddec_cnt_ops; > + ftm->counter.counts = &ftm_quaddec_counts; > + ftm->counter.num_counts = 1; > + ftm->counter.signals = ftm_quaddec_signals; > + ftm->counter.num_signals = ARRAY_SIZE(ftm_quaddec_signals); > + ftm->counter.priv = ftm; > + > + mutex_init(&ftm->ftm_quaddec_mutex); > + > + ftm_quaddec_init(ftm); > + > + ret = counter_register(&ftm->counter); > + if (ret) > + ftm_quaddec_disable(ftm); > + > + return ret; > +} > + > +static int ftm_quaddec_remove(struct platform_device *pdev) > +{ > + struct ftm_quaddec *ftm = platform_get_drvdata(pdev); > + > + counter_unregister(&ftm->counter); > + > + ftm_quaddec_disable(ftm); > + > + return 0; > +} If the ftm_quaddec_disable is not necessary, then we can eliminate the ftm_quaddec_remove function as well by replacing the counter_register call with a devm_counter_register call. William Breathitt Gray > + > +static const struct of_device_id ftm_quaddec_match[] = { > + { .compatible = "fsl,ftm-quaddec" }, > + {}, > +}; > + > +static struct platform_driver ftm_quaddec_driver = { > + .driver = { > + .name = "ftm-quaddec", > + .owner = THIS_MODULE, > + .of_match_table = ftm_quaddec_match, > + }, > + .probe = ftm_quaddec_probe, > + .remove = ftm_quaddec_remove, > +}; > + > +module_platform_driver(ftm_quaddec_driver); > + > +MODULE_LICENSE("GPL"); > +MODULE_AUTHOR("Kjeld Flarup <kfa@deif.com"); > +MODULE_AUTHOR("Patrick Havelange <patrick.havelange@essensium.com"); > -- > 2.19.1 >
On Thu, Mar 7, 2019 at 12:32 PM William Breathitt Gray <vilhelm.gray@gmail.com> wrote: > > +/* > > + * take mutex > > + * call ftm_clear_write_protection > > + * update settings > > + * call ftm_set_write_protection > > + * release mutex > > + */ > > Jonathan mentioned it before in the previous review, and I think I agree > too, that this comment block is superfluous: the context of this code is > simple enough that the function call order is naturally obvious (i.e. > write protection must be cleared before settings are modified). > > The only important thing to mention here is that the mutex must be held > before the write protection state is modified so a comment along the > following lines should suffice: > > /* hold mutex before modifying write protection state */ I think that keeping the more verbose comments is better. You directly see what operations are needed, and is a good reminder, especially if you are not familiar with the driver. I'll use your comment on the next version if you insist (see below for why new versoion). > > +static void ftm_quaddec_disable(struct ftm_quaddec *ftm) > > +{ > > + ftm_write(ftm, FTM_MODE, 0); > > +} > > The ftm_quaddec_disable function is only used for cleanup when the > driver is being removed. Is disabling the FTM counter on removal > actually something we need to do? It might provide some power-saving, so I would keep that function. > > While it's true that the register will keep updating, since the driver > is no longer loaded, we don't care about that register value. Once we > take control of the hardware again (by reloading our driver or via a new > one), we reinitialize the counter and set the count value back to 0 > anyway -- so whatever value the register had no longer matters. > Indeed the previous values at start do not matter. It's there just to shut down the device properly. This discussion made me verify again the specs and in its current form the disable doesn't even work at all : - That register should be written with write protection disabled (duh!) - It doesn't even stop the FTM from running, the clock must be disabled for that. So I'll probably provide a fix for that (in some days/weeks). > > + > > +enum ftm_quaddec_count_function { > > + FTM_QUADDEC_COUNT_ENCODER_MODE_1, > > +}; > > The FlexTimer Module supports more than just a quadrature counter mode > doesn't it? > > We should keep this initial patch simple since we are still introducing > the Counter subsystem, but it'll be nice to add support in the future > for the other counter modes such as single-edge capture. yes it provides more features, those are in a backlog ;). I would prefer if this simple version(I mean, with the disable/shutdown fixed) of the driver could be merged already before extending support. > > > + > > +static struct counter_signal ftm_quaddec_signals[] = { > > + { > > + .id = 0, > > + .name = "Channel 1 Quadrature A" > > + }, > > + { > > + .id = 1, > > + .name = "Channel 1 Quadrature B" > > + } > > +}; > > If possible, these names should match the FTM datasheet naming > convention. The reason is to make it easier for users to match the > input signals described in the datasheet with the Signal data provided > by the Generic Counter interface. > > I think the FTM datasheet describes these signals as "Phase A" and > "Phase B", so perhaps "Channel 1 Phase A" and "Channel 1 Phase B" may be > more appropriate names in this case. I'll verify those, > > +static int ftm_quaddec_remove(struct platform_device *pdev) > > +{ > > + struct ftm_quaddec *ftm = platform_get_drvdata(pdev); > > + > > + counter_unregister(&ftm->counter); > > + > > + ftm_quaddec_disable(ftm); > > + > > + return 0; > > +} > > If the ftm_quaddec_disable is not necessary, then we can eliminate the > ftm_quaddec_remove function as well by replacing the counter_register > call with a devm_counter_register call. yes, but as stated before, I would keep it for potential energy saving. Thanks for your feedback :)
On Wed, 6 Mar 2019 12:12:06 +0100 Patrick Havelange <patrick.havelange@essensium.com> wrote: > This driver exposes the counter for the quadrature decoder of the > FlexTimer Module, present in the LS1021A soc. > > Signed-off-by: Patrick Havelange <patrick.havelange@essensium.com> A few really trivial bits inline to add to William's feedback. Otherwise I'm happy enough, Reviewed-by: Jonathan Cameron <Jonathan.Cameron@huawei.com> > --- > Changes v2 > - Rebased on new counter subsystem > - Cleaned up included headers > - Use devm_ioremap() > - Correct order of devm_ and unmanaged resources > --- > drivers/counter/Kconfig | 9 + > drivers/counter/Makefile | 1 + > drivers/counter/ftm-quaddec.c | 356 ++++++++++++++++++++++++++++++++++ > 3 files changed, 366 insertions(+) > create mode 100644 drivers/counter/ftm-quaddec.c > > diff --git a/drivers/counter/Kconfig b/drivers/counter/Kconfig > index 87c491a19c63..233ac305d878 100644 > --- a/drivers/counter/Kconfig > +++ b/drivers/counter/Kconfig > @@ -48,4 +48,13 @@ config STM32_LPTIMER_CNT > To compile this driver as a module, choose M here: the > module will be called stm32-lptimer-cnt. > > +config FTM_QUADDEC > + tristate "Flex Timer Module Quadrature decoder driver" > + help > + Select this option to enable the Flex Timer Quadrature decoder > + driver. > + > + To compile this driver as a module, choose M here: the > + module will be called ftm-quaddec. > + > endif # COUNTER > diff --git a/drivers/counter/Makefile b/drivers/counter/Makefile > index 5589976d37f8..0c9e622a6bea 100644 > --- a/drivers/counter/Makefile > +++ b/drivers/counter/Makefile > @@ -7,3 +7,4 @@ obj-$(CONFIG_COUNTER) += 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 > +obj-$(CONFIG_FTM_QUADDEC) += ftm-quaddec.o > diff --git a/drivers/counter/ftm-quaddec.c b/drivers/counter/ftm-quaddec.c > new file mode 100644 > index 000000000000..1bc9e075a386 > --- /dev/null > +++ b/drivers/counter/ftm-quaddec.c > @@ -0,0 +1,356 @@ > +// SPDX-License-Identifier: GPL-2.0 > +/* > + * Flex Timer Module Quadrature decoder > + * > + * This module implements a driver for decoding the FTM quadrature > + * of ex. a LS1021A > + */ > + > +#include <linux/fsl/ftm.h> > +#include <linux/module.h> > +#include <linux/platform_device.h> > +#include <linux/of.h> > +#include <linux/io.h> > +#include <linux/mutex.h> > +#include <linux/counter.h> > + > +struct ftm_quaddec { > + struct counter_device counter; > + struct platform_device *pdev; > + void __iomem *ftm_base; > + bool big_endian; > + struct mutex ftm_quaddec_mutex; > +}; > + > +static void ftm_read(struct ftm_quaddec *ftm, uint32_t offset, uint32_t *data) > +{ > + if (ftm->big_endian) > + *data = ioread32be(ftm->ftm_base + offset); > + else > + *data = ioread32(ftm->ftm_base + offset); > +} > + > +static void ftm_write(struct ftm_quaddec *ftm, uint32_t offset, uint32_t data) > +{ > + if (ftm->big_endian) > + iowrite32be(data, ftm->ftm_base + offset); > + else > + iowrite32(data, ftm->ftm_base + offset); > +} > + > +/* > + * take mutex > + * call ftm_clear_write_protection > + * update settings > + * call ftm_set_write_protection > + * release mutex > + */ > +static void ftm_clear_write_protection(struct ftm_quaddec *ftm) > +{ > + uint32_t flag; > + > + /* First see if it is enabled */ > + ftm_read(ftm, FTM_FMS, &flag); > + > + if (flag & FTM_FMS_WPEN) { > + ftm_read(ftm, FTM_MODE, &flag); > + ftm_write(ftm, FTM_MODE, flag | FTM_MODE_WPDIS); > + } > +} > + > +static void ftm_set_write_protection(struct ftm_quaddec *ftm) > +{ > + ftm_write(ftm, FTM_FMS, FTM_FMS_WPEN); > +} > + > +static void ftm_reset_counter(struct ftm_quaddec *ftm) > +{ > + /* Reset hardware counter to CNTIN */ > + ftm_write(ftm, FTM_CNT, 0x0); > +} > + > +static void ftm_quaddec_init(struct ftm_quaddec *ftm) > +{ > + ftm_clear_write_protection(ftm); > + > + /* > + * Do not write in the region from the CNTIN register through the > + * PWMLOAD register when FTMEN = 0. > + */ > + ftm_write(ftm, FTM_MODE, FTM_MODE_FTMEN); > + ftm_write(ftm, FTM_CNTIN, 0x0000); > + ftm_write(ftm, FTM_MOD, 0xffff); > + ftm_write(ftm, FTM_CNT, 0x0); > + ftm_write(ftm, FTM_SC, FTM_SC_PS_1); > + > + /* Select quad mode */ > + ftm_write(ftm, FTM_QDCTRL, FTM_QDCTRL_QUADEN); > + > + /* Unused features and reset to default section */ > + ftm_write(ftm, FTM_POL, 0x0); > + ftm_write(ftm, FTM_FLTCTRL, 0x0); > + ftm_write(ftm, FTM_SYNCONF, 0x0); > + ftm_write(ftm, FTM_SYNC, 0xffff); > + > + /* Lock the FTM */ > + ftm_set_write_protection(ftm); > +} > + > +static void ftm_quaddec_disable(struct ftm_quaddec *ftm) > +{ > + ftm_write(ftm, FTM_MODE, 0); > +} > + > +static int ftm_quaddec_get_prescaler(struct counter_device *counter, > + struct counter_count *count, > + size_t *cnt_mode) > +{ > + struct ftm_quaddec *ftm = counter->priv; > + uint32_t scflags; > + > + ftm_read(ftm, FTM_SC, &scflags); > + > + *cnt_mode = scflags & FTM_SC_PS_MASK; FIELD_GET and FIELD_PREP are a tidy way of doing these sorts of accesses. Helpfully they also save a reviewer having to sanity check that the offset is 0 as it is here. > + > + return 0; > +} > + > +static int ftm_quaddec_set_prescaler(struct counter_device *counter, > + struct counter_count *count, > + size_t cnt_mode) > +{ > + struct ftm_quaddec *ftm = counter->priv; > + > + uint32_t scflags; > + > + mutex_lock(&ftm->ftm_quaddec_mutex); > + > + ftm_read(ftm, FTM_SC, &scflags); > + > + scflags &= ~FTM_SC_PS_MASK; > + cnt_mode &= FTM_SC_PS_MASK; /*just to be 100% sure*/ nitpick: Comment syntax is /* just to be 100% sure */ > + > + scflags |= cnt_mode; > + > + /* Write */ > + ftm_clear_write_protection(ftm); > + ftm_write(ftm, FTM_SC, scflags); > + ftm_set_write_protection(ftm); > + > + /* Also resets the counter as it is undefined anyway now */ > + ftm_reset_counter(ftm); > + > + mutex_unlock(&ftm->ftm_quaddec_mutex); > + return 0; > +} > + > +static const char * const ftm_quaddec_prescaler[] = { > + "1", "2", "4", "8", "16", "32", "64", "128" > +}; > + > +static struct counter_count_enum_ext ftm_quaddec_prescaler_enum = { > + .items = ftm_quaddec_prescaler, > + .num_items = ARRAY_SIZE(ftm_quaddec_prescaler), > + .get = ftm_quaddec_get_prescaler, > + .set = ftm_quaddec_set_prescaler > +}; > + > +enum ftm_quaddec_synapse_action { > + FTM_QUADDEC_SYNAPSE_ACTION_BOTH_EDGES, > +}; > + > +static enum counter_synapse_action ftm_quaddec_synapse_actions[] = { > + [FTM_QUADDEC_SYNAPSE_ACTION_BOTH_EDGES] = > + COUNTER_SYNAPSE_ACTION_BOTH_EDGES > +}; > + > +enum ftm_quaddec_count_function { > + FTM_QUADDEC_COUNT_ENCODER_MODE_1, > +}; > + > +static const enum counter_count_function ftm_quaddec_count_functions[] = { > + [FTM_QUADDEC_COUNT_ENCODER_MODE_1] = > + COUNTER_COUNT_FUNCTION_QUADRATURE_X4 > +}; > + > +static int ftm_quaddec_count_read(struct counter_device *counter, > + struct counter_count *count, > + struct counter_count_read_value *val) > +{ > + struct ftm_quaddec *const ftm = counter->priv; > + uint32_t cntval; > + > + ftm_read(ftm, FTM_CNT, &cntval); > + > + counter_count_read_value_set(val, COUNTER_COUNT_POSITION, &cntval); > + > + return 0; > +} > + > +static int ftm_quaddec_count_write(struct counter_device *counter, > + struct counter_count *count, > + struct counter_count_write_value *val) > +{ > + struct ftm_quaddec *const ftm = counter->priv; > + u32 cnt; > + int err; > + > + err = counter_count_write_value_get(&cnt, COUNTER_COUNT_POSITION, val); > + if (err) > + return err; > + > + if (cnt != 0) { > + dev_warn(&ftm->pdev->dev, "Can only accept '0' as new counter value\n"); > + return -EINVAL; > + } > + > + ftm_reset_counter(ftm); > + > + return 0; > +} > + > +static int ftm_quaddec_count_function_get(struct counter_device *counter, > + struct counter_count *count, > + size_t *function) > +{ > + *function = FTM_QUADDEC_COUNT_ENCODER_MODE_1; > + > + return 0; > +} > + > +static int ftm_quaddec_action_get(struct counter_device *counter, > + struct counter_count *count, > + struct counter_synapse *synapse, > + size_t *action) > +{ > + *action = FTM_QUADDEC_SYNAPSE_ACTION_BOTH_EDGES; > + > + return 0; > +} > + > +static const struct counter_ops ftm_quaddec_cnt_ops = { > + .count_read = ftm_quaddec_count_read, > + .count_write = ftm_quaddec_count_write, > + .function_get = ftm_quaddec_count_function_get, > + .action_get = ftm_quaddec_action_get, > +}; > + > +static struct counter_signal ftm_quaddec_signals[] = { > + { > + .id = 0, > + .name = "Channel 1 Quadrature A" > + }, > + { > + .id = 1, > + .name = "Channel 1 Quadrature B" > + } > +}; > + > +static struct counter_synapse ftm_quaddec_count_synapses[] = { > + { > + .actions_list = ftm_quaddec_synapse_actions, > + .num_actions = ARRAY_SIZE(ftm_quaddec_synapse_actions), > + .signal = &ftm_quaddec_signals[0] > + }, > + { > + .actions_list = ftm_quaddec_synapse_actions, > + .num_actions = ARRAY_SIZE(ftm_quaddec_synapse_actions), > + .signal = &ftm_quaddec_signals[1] > + } > +}; > + > +static const struct counter_count_ext ftm_quaddec_count_ext[] = { > + COUNTER_COUNT_ENUM("prescaler", &ftm_quaddec_prescaler_enum), > + COUNTER_COUNT_ENUM_AVAILABLE("prescaler", &ftm_quaddec_prescaler_enum), > +}; > + > +static struct counter_count ftm_quaddec_counts = { > + .id = 0, > + .name = "Channel 1 Count", > + .functions_list = ftm_quaddec_count_functions, > + .num_functions = ARRAY_SIZE(ftm_quaddec_count_functions), > + .synapses = ftm_quaddec_count_synapses, > + .num_synapses = ARRAY_SIZE(ftm_quaddec_count_synapses), > + .ext = ftm_quaddec_count_ext, > + .num_ext = ARRAY_SIZE(ftm_quaddec_count_ext) > +}; > + > +static int ftm_quaddec_probe(struct platform_device *pdev) > +{ > + struct ftm_quaddec *ftm; > + > + struct device_node *node = pdev->dev.of_node; > + struct resource *io; > + int ret; > + > + ftm = devm_kzalloc(&pdev->dev, sizeof(*ftm), GFP_KERNEL); > + if (!ftm) > + return -ENOMEM; > + > + platform_set_drvdata(pdev, ftm); > + > + io = platform_get_resource(pdev, IORESOURCE_MEM, 0); > + if (!io) { > + dev_err(&pdev->dev, "Failed to get memory region\n"); > + return -ENODEV; > + } > + > + ftm->pdev = pdev; > + ftm->big_endian = of_property_read_bool(node, "big-endian"); > + ftm->ftm_base = devm_ioremap(&pdev->dev, io->start, resource_size(io)); > + > + if (!ftm->ftm_base) { > + dev_err(&pdev->dev, "Failed to map memory region\n"); > + return -EINVAL; > + } > + ftm->counter.name = dev_name(&pdev->dev); > + ftm->counter.parent = &pdev->dev; > + ftm->counter.ops = &ftm_quaddec_cnt_ops; > + ftm->counter.counts = &ftm_quaddec_counts; > + ftm->counter.num_counts = 1; > + ftm->counter.signals = ftm_quaddec_signals; > + ftm->counter.num_signals = ARRAY_SIZE(ftm_quaddec_signals); > + ftm->counter.priv = ftm; > + > + mutex_init(&ftm->ftm_quaddec_mutex); > + > + ftm_quaddec_init(ftm); > + > + ret = counter_register(&ftm->counter); > + if (ret) > + ftm_quaddec_disable(ftm); > + > + return ret; > +} > + > +static int ftm_quaddec_remove(struct platform_device *pdev) > +{ > + struct ftm_quaddec *ftm = platform_get_drvdata(pdev); > + > + counter_unregister(&ftm->counter); > + > + ftm_quaddec_disable(ftm); > + > + return 0; > +} > + > +static const struct of_device_id ftm_quaddec_match[] = { > + { .compatible = "fsl,ftm-quaddec" }, > + {}, > +}; > + > +static struct platform_driver ftm_quaddec_driver = { > + .driver = { > + .name = "ftm-quaddec", > + .owner = THIS_MODULE, No need to set this, the call to __platform_driver_register that comes from the module_platform_driver macro below will deal with this for you. > + .of_match_table = ftm_quaddec_match, > + }, > + .probe = ftm_quaddec_probe, > + .remove = ftm_quaddec_remove, > +}; > + > +module_platform_driver(ftm_quaddec_driver); > + > +MODULE_LICENSE("GPL"); > +MODULE_AUTHOR("Kjeld Flarup <kfa@deif.com"); > +MODULE_AUTHOR("Patrick Havelange <patrick.havelange@essensium.com");
diff --git a/drivers/counter/Kconfig b/drivers/counter/Kconfig index 87c491a19c63..233ac305d878 100644 --- a/drivers/counter/Kconfig +++ b/drivers/counter/Kconfig @@ -48,4 +48,13 @@ config STM32_LPTIMER_CNT To compile this driver as a module, choose M here: the module will be called stm32-lptimer-cnt. +config FTM_QUADDEC + tristate "Flex Timer Module Quadrature decoder driver" + help + Select this option to enable the Flex Timer Quadrature decoder + driver. + + To compile this driver as a module, choose M here: the + module will be called ftm-quaddec. + endif # COUNTER diff --git a/drivers/counter/Makefile b/drivers/counter/Makefile index 5589976d37f8..0c9e622a6bea 100644 --- a/drivers/counter/Makefile +++ b/drivers/counter/Makefile @@ -7,3 +7,4 @@ obj-$(CONFIG_COUNTER) += 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 +obj-$(CONFIG_FTM_QUADDEC) += ftm-quaddec.o diff --git a/drivers/counter/ftm-quaddec.c b/drivers/counter/ftm-quaddec.c new file mode 100644 index 000000000000..1bc9e075a386 --- /dev/null +++ b/drivers/counter/ftm-quaddec.c @@ -0,0 +1,356 @@ +// SPDX-License-Identifier: GPL-2.0 +/* + * Flex Timer Module Quadrature decoder + * + * This module implements a driver for decoding the FTM quadrature + * of ex. a LS1021A + */ + +#include <linux/fsl/ftm.h> +#include <linux/module.h> +#include <linux/platform_device.h> +#include <linux/of.h> +#include <linux/io.h> +#include <linux/mutex.h> +#include <linux/counter.h> + +struct ftm_quaddec { + struct counter_device counter; + struct platform_device *pdev; + void __iomem *ftm_base; + bool big_endian; + struct mutex ftm_quaddec_mutex; +}; + +static void ftm_read(struct ftm_quaddec *ftm, uint32_t offset, uint32_t *data) +{ + if (ftm->big_endian) + *data = ioread32be(ftm->ftm_base + offset); + else + *data = ioread32(ftm->ftm_base + offset); +} + +static void ftm_write(struct ftm_quaddec *ftm, uint32_t offset, uint32_t data) +{ + if (ftm->big_endian) + iowrite32be(data, ftm->ftm_base + offset); + else + iowrite32(data, ftm->ftm_base + offset); +} + +/* + * take mutex + * call ftm_clear_write_protection + * update settings + * call ftm_set_write_protection + * release mutex + */ +static void ftm_clear_write_protection(struct ftm_quaddec *ftm) +{ + uint32_t flag; + + /* First see if it is enabled */ + ftm_read(ftm, FTM_FMS, &flag); + + if (flag & FTM_FMS_WPEN) { + ftm_read(ftm, FTM_MODE, &flag); + ftm_write(ftm, FTM_MODE, flag | FTM_MODE_WPDIS); + } +} + +static void ftm_set_write_protection(struct ftm_quaddec *ftm) +{ + ftm_write(ftm, FTM_FMS, FTM_FMS_WPEN); +} + +static void ftm_reset_counter(struct ftm_quaddec *ftm) +{ + /* Reset hardware counter to CNTIN */ + ftm_write(ftm, FTM_CNT, 0x0); +} + +static void ftm_quaddec_init(struct ftm_quaddec *ftm) +{ + ftm_clear_write_protection(ftm); + + /* + * Do not write in the region from the CNTIN register through the + * PWMLOAD register when FTMEN = 0. + */ + ftm_write(ftm, FTM_MODE, FTM_MODE_FTMEN); + ftm_write(ftm, FTM_CNTIN, 0x0000); + ftm_write(ftm, FTM_MOD, 0xffff); + ftm_write(ftm, FTM_CNT, 0x0); + ftm_write(ftm, FTM_SC, FTM_SC_PS_1); + + /* Select quad mode */ + ftm_write(ftm, FTM_QDCTRL, FTM_QDCTRL_QUADEN); + + /* Unused features and reset to default section */ + ftm_write(ftm, FTM_POL, 0x0); + ftm_write(ftm, FTM_FLTCTRL, 0x0); + ftm_write(ftm, FTM_SYNCONF, 0x0); + ftm_write(ftm, FTM_SYNC, 0xffff); + + /* Lock the FTM */ + ftm_set_write_protection(ftm); +} + +static void ftm_quaddec_disable(struct ftm_quaddec *ftm) +{ + ftm_write(ftm, FTM_MODE, 0); +} + +static int ftm_quaddec_get_prescaler(struct counter_device *counter, + struct counter_count *count, + size_t *cnt_mode) +{ + struct ftm_quaddec *ftm = counter->priv; + uint32_t scflags; + + ftm_read(ftm, FTM_SC, &scflags); + + *cnt_mode = scflags & FTM_SC_PS_MASK; + + return 0; +} + +static int ftm_quaddec_set_prescaler(struct counter_device *counter, + struct counter_count *count, + size_t cnt_mode) +{ + struct ftm_quaddec *ftm = counter->priv; + + uint32_t scflags; + + mutex_lock(&ftm->ftm_quaddec_mutex); + + ftm_read(ftm, FTM_SC, &scflags); + + scflags &= ~FTM_SC_PS_MASK; + cnt_mode &= FTM_SC_PS_MASK; /*just to be 100% sure*/ + + scflags |= cnt_mode; + + /* Write */ + ftm_clear_write_protection(ftm); + ftm_write(ftm, FTM_SC, scflags); + ftm_set_write_protection(ftm); + + /* Also resets the counter as it is undefined anyway now */ + ftm_reset_counter(ftm); + + mutex_unlock(&ftm->ftm_quaddec_mutex); + return 0; +} + +static const char * const ftm_quaddec_prescaler[] = { + "1", "2", "4", "8", "16", "32", "64", "128" +}; + +static struct counter_count_enum_ext ftm_quaddec_prescaler_enum = { + .items = ftm_quaddec_prescaler, + .num_items = ARRAY_SIZE(ftm_quaddec_prescaler), + .get = ftm_quaddec_get_prescaler, + .set = ftm_quaddec_set_prescaler +}; + +enum ftm_quaddec_synapse_action { + FTM_QUADDEC_SYNAPSE_ACTION_BOTH_EDGES, +}; + +static enum counter_synapse_action ftm_quaddec_synapse_actions[] = { + [FTM_QUADDEC_SYNAPSE_ACTION_BOTH_EDGES] = + COUNTER_SYNAPSE_ACTION_BOTH_EDGES +}; + +enum ftm_quaddec_count_function { + FTM_QUADDEC_COUNT_ENCODER_MODE_1, +}; + +static const enum counter_count_function ftm_quaddec_count_functions[] = { + [FTM_QUADDEC_COUNT_ENCODER_MODE_1] = + COUNTER_COUNT_FUNCTION_QUADRATURE_X4 +}; + +static int ftm_quaddec_count_read(struct counter_device *counter, + struct counter_count *count, + struct counter_count_read_value *val) +{ + struct ftm_quaddec *const ftm = counter->priv; + uint32_t cntval; + + ftm_read(ftm, FTM_CNT, &cntval); + + counter_count_read_value_set(val, COUNTER_COUNT_POSITION, &cntval); + + return 0; +} + +static int ftm_quaddec_count_write(struct counter_device *counter, + struct counter_count *count, + struct counter_count_write_value *val) +{ + struct ftm_quaddec *const ftm = counter->priv; + u32 cnt; + int err; + + err = counter_count_write_value_get(&cnt, COUNTER_COUNT_POSITION, val); + if (err) + return err; + + if (cnt != 0) { + dev_warn(&ftm->pdev->dev, "Can only accept '0' as new counter value\n"); + return -EINVAL; + } + + ftm_reset_counter(ftm); + + return 0; +} + +static int ftm_quaddec_count_function_get(struct counter_device *counter, + struct counter_count *count, + size_t *function) +{ + *function = FTM_QUADDEC_COUNT_ENCODER_MODE_1; + + return 0; +} + +static int ftm_quaddec_action_get(struct counter_device *counter, + struct counter_count *count, + struct counter_synapse *synapse, + size_t *action) +{ + *action = FTM_QUADDEC_SYNAPSE_ACTION_BOTH_EDGES; + + return 0; +} + +static const struct counter_ops ftm_quaddec_cnt_ops = { + .count_read = ftm_quaddec_count_read, + .count_write = ftm_quaddec_count_write, + .function_get = ftm_quaddec_count_function_get, + .action_get = ftm_quaddec_action_get, +}; + +static struct counter_signal ftm_quaddec_signals[] = { + { + .id = 0, + .name = "Channel 1 Quadrature A" + }, + { + .id = 1, + .name = "Channel 1 Quadrature B" + } +}; + +static struct counter_synapse ftm_quaddec_count_synapses[] = { + { + .actions_list = ftm_quaddec_synapse_actions, + .num_actions = ARRAY_SIZE(ftm_quaddec_synapse_actions), + .signal = &ftm_quaddec_signals[0] + }, + { + .actions_list = ftm_quaddec_synapse_actions, + .num_actions = ARRAY_SIZE(ftm_quaddec_synapse_actions), + .signal = &ftm_quaddec_signals[1] + } +}; + +static const struct counter_count_ext ftm_quaddec_count_ext[] = { + COUNTER_COUNT_ENUM("prescaler", &ftm_quaddec_prescaler_enum), + COUNTER_COUNT_ENUM_AVAILABLE("prescaler", &ftm_quaddec_prescaler_enum), +}; + +static struct counter_count ftm_quaddec_counts = { + .id = 0, + .name = "Channel 1 Count", + .functions_list = ftm_quaddec_count_functions, + .num_functions = ARRAY_SIZE(ftm_quaddec_count_functions), + .synapses = ftm_quaddec_count_synapses, + .num_synapses = ARRAY_SIZE(ftm_quaddec_count_synapses), + .ext = ftm_quaddec_count_ext, + .num_ext = ARRAY_SIZE(ftm_quaddec_count_ext) +}; + +static int ftm_quaddec_probe(struct platform_device *pdev) +{ + struct ftm_quaddec *ftm; + + struct device_node *node = pdev->dev.of_node; + struct resource *io; + int ret; + + ftm = devm_kzalloc(&pdev->dev, sizeof(*ftm), GFP_KERNEL); + if (!ftm) + return -ENOMEM; + + platform_set_drvdata(pdev, ftm); + + io = platform_get_resource(pdev, IORESOURCE_MEM, 0); + if (!io) { + dev_err(&pdev->dev, "Failed to get memory region\n"); + return -ENODEV; + } + + ftm->pdev = pdev; + ftm->big_endian = of_property_read_bool(node, "big-endian"); + ftm->ftm_base = devm_ioremap(&pdev->dev, io->start, resource_size(io)); + + if (!ftm->ftm_base) { + dev_err(&pdev->dev, "Failed to map memory region\n"); + return -EINVAL; + } + ftm->counter.name = dev_name(&pdev->dev); + ftm->counter.parent = &pdev->dev; + ftm->counter.ops = &ftm_quaddec_cnt_ops; + ftm->counter.counts = &ftm_quaddec_counts; + ftm->counter.num_counts = 1; + ftm->counter.signals = ftm_quaddec_signals; + ftm->counter.num_signals = ARRAY_SIZE(ftm_quaddec_signals); + ftm->counter.priv = ftm; + + mutex_init(&ftm->ftm_quaddec_mutex); + + ftm_quaddec_init(ftm); + + ret = counter_register(&ftm->counter); + if (ret) + ftm_quaddec_disable(ftm); + + return ret; +} + +static int ftm_quaddec_remove(struct platform_device *pdev) +{ + struct ftm_quaddec *ftm = platform_get_drvdata(pdev); + + counter_unregister(&ftm->counter); + + ftm_quaddec_disable(ftm); + + return 0; +} + +static const struct of_device_id ftm_quaddec_match[] = { + { .compatible = "fsl,ftm-quaddec" }, + {}, +}; + +static struct platform_driver ftm_quaddec_driver = { + .driver = { + .name = "ftm-quaddec", + .owner = THIS_MODULE, + .of_match_table = ftm_quaddec_match, + }, + .probe = ftm_quaddec_probe, + .remove = ftm_quaddec_remove, +}; + +module_platform_driver(ftm_quaddec_driver); + +MODULE_LICENSE("GPL"); +MODULE_AUTHOR("Kjeld Flarup <kfa@deif.com"); +MODULE_AUTHOR("Patrick Havelange <patrick.havelange@essensium.com");
This driver exposes the counter for the quadrature decoder of the FlexTimer Module, present in the LS1021A soc. Signed-off-by: Patrick Havelange <patrick.havelange@essensium.com> --- Changes v2 - Rebased on new counter subsystem - Cleaned up included headers - Use devm_ioremap() - Correct order of devm_ and unmanaged resources --- drivers/counter/Kconfig | 9 + drivers/counter/Makefile | 1 + drivers/counter/ftm-quaddec.c | 356 ++++++++++++++++++++++++++++++++++ 3 files changed, 366 insertions(+) create mode 100644 drivers/counter/ftm-quaddec.c