Loading...
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28 29 30 31 32 33 34 35 36 37 38 39 40 41 42 43 44 45 46 47 48 49 50 51 52 53 54 55 56 57 58 59 60 61 62 63 64 65 66 67 68 69 70 71 72 73 74 75 76 77 78 79 80 81 82 83 84 85 86 87 88 89 90 91 92 93 94 95 96 97 98 99 100 101 102 103 104 105 106 107 108 109 110 111 112 113 114 115 116 | // SPDX-License-Identifier: GPL-2.0 /* * STM32 Low-Power Timer Trigger driver * * Copyright (C) STMicroelectronics 2017 * * Author: Fabrice Gasnier <fabrice.gasnier@st.com>. * * Inspired by Benjamin Gaignard's stm32-timer-trigger driver */ #include <linux/iio/timer/stm32-lptim-trigger.h> #include <linux/mfd/stm32-lptimer.h> #include <linux/module.h> #include <linux/platform_device.h> /* List Low-Power Timer triggers */ static const char * const stm32_lptim_triggers[] = { LPTIM1_OUT, LPTIM2_OUT, LPTIM3_OUT, }; struct stm32_lptim_trigger { struct device *dev; const char *trg; }; static int stm32_lptim_validate_device(struct iio_trigger *trig, struct iio_dev *indio_dev) { if (indio_dev->modes & INDIO_HARDWARE_TRIGGERED) return 0; return -EINVAL; } static const struct iio_trigger_ops stm32_lptim_trigger_ops = { .validate_device = stm32_lptim_validate_device, }; /** * is_stm32_lptim_trigger * @trig: trigger to be checked * * return true if the trigger is a valid STM32 IIO Low-Power Timer Trigger * either return false */ bool is_stm32_lptim_trigger(struct iio_trigger *trig) { return (trig->ops == &stm32_lptim_trigger_ops); } EXPORT_SYMBOL(is_stm32_lptim_trigger); static int stm32_lptim_setup_trig(struct stm32_lptim_trigger *priv) { struct iio_trigger *trig; trig = devm_iio_trigger_alloc(priv->dev, "%s", priv->trg); if (!trig) return -ENOMEM; trig->dev.parent = priv->dev->parent; trig->ops = &stm32_lptim_trigger_ops; iio_trigger_set_drvdata(trig, priv); return devm_iio_trigger_register(priv->dev, trig); } static int stm32_lptim_trigger_probe(struct platform_device *pdev) { struct stm32_lptim_trigger *priv; u32 index; int ret; priv = devm_kzalloc(&pdev->dev, sizeof(*priv), GFP_KERNEL); if (!priv) return -ENOMEM; if (of_property_read_u32(pdev->dev.of_node, "reg", &index)) return -EINVAL; if (index >= ARRAY_SIZE(stm32_lptim_triggers)) return -EINVAL; priv->dev = &pdev->dev; priv->trg = stm32_lptim_triggers[index]; ret = stm32_lptim_setup_trig(priv); if (ret) return ret; platform_set_drvdata(pdev, priv); return 0; } static const struct of_device_id stm32_lptim_trig_of_match[] = { { .compatible = "st,stm32-lptimer-trigger", }, {}, }; MODULE_DEVICE_TABLE(of, stm32_lptim_trig_of_match); static struct platform_driver stm32_lptim_trigger_driver = { .probe = stm32_lptim_trigger_probe, .driver = { .name = "stm32-lptimer-trigger", .of_match_table = stm32_lptim_trig_of_match, }, }; module_platform_driver(stm32_lptim_trigger_driver); MODULE_AUTHOR("Fabrice Gasnier <fabrice.gasnier@st.com>"); MODULE_ALIAS("platform:stm32-lptimer-trigger"); MODULE_DESCRIPTION("STMicroelectronics STM32 LPTIM trigger driver"); MODULE_LICENSE("GPL v2"); |