hc
2024-08-16 a24a44ff9ca902811b99aa9663d697cf452e08ef
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");