1 // SPDX-License-Identifier: GPL-2.0
6 #include <linux/counter.h>
8 #include <linux/interrupt.h>
14 #define INTERRUPT_CNT_NAME "interrupt-cnt"
18 	struct counter_device counter;  member
31 	atomic_inc(&priv->count);  in interrupt_cnt_isr()
36 static ssize_t interrupt_cnt_enable_read(struct counter_device *counter,  in interrupt_cnt_enable_read()  argument
40 	struct interrupt_cnt_priv *priv = counter->priv;  in interrupt_cnt_enable_read()
42 	return sysfs_emit(buf, "%d\n", priv->enabled);  in interrupt_cnt_enable_read()
45 static ssize_t interrupt_cnt_enable_write(struct counter_device *counter,  in interrupt_cnt_enable_write()  argument
50 	struct interrupt_cnt_priv *priv = counter->priv;  in interrupt_cnt_enable_write()
58 	if (priv->enabled == enable)  in interrupt_cnt_enable_write()
62 		priv->enabled = true;  in interrupt_cnt_enable_write()
63 		enable_irq(priv->irq);  in interrupt_cnt_enable_write()
65 		disable_irq(priv->irq);  in interrupt_cnt_enable_write()
66 		priv->enabled = false;  in interrupt_cnt_enable_write()
84 static int interrupt_cnt_action_get(struct counter_device *counter,  in interrupt_cnt_action_get()  argument
94 static int interrupt_cnt_read(struct counter_device *counter,  in interrupt_cnt_read()  argument
97 	struct interrupt_cnt_priv *priv = counter->priv;  in interrupt_cnt_read()
99 	*val = atomic_read(&priv->count);  in interrupt_cnt_read()
104 static int interrupt_cnt_write(struct counter_device *counter,  in interrupt_cnt_write()  argument
108 	struct interrupt_cnt_priv *priv = counter->priv;  in interrupt_cnt_write()
110 	if (val != (typeof(priv->count.counter))val)  in interrupt_cnt_write()
111 		return -ERANGE;  in interrupt_cnt_write()
113 	atomic_set(&priv->count, val);  in interrupt_cnt_write()
122 static int interrupt_cnt_function_get(struct counter_device *counter,  in interrupt_cnt_function_get()  argument
131 static int interrupt_cnt_signal_read(struct counter_device *counter,  in interrupt_cnt_signal_read()  argument
135 	struct interrupt_cnt_priv *priv = counter->priv;  in interrupt_cnt_signal_read()
138 	if (!priv->gpio)  in interrupt_cnt_signal_read()
139 		return -EINVAL;  in interrupt_cnt_signal_read()
141 	ret = gpiod_get_value(priv->gpio);  in interrupt_cnt_signal_read()
160 	struct device *dev = &pdev->dev;  in interrupt_cnt_probe()
166 		return -ENOMEM;  in interrupt_cnt_probe()
168 	priv->irq = platform_get_irq_optional(pdev,  0);  in interrupt_cnt_probe()
169 	if (priv->irq == -ENXIO)  in interrupt_cnt_probe()
170 		priv->irq = 0;  in interrupt_cnt_probe()
171 	else if (priv->irq < 0)  in interrupt_cnt_probe()
172 		return dev_err_probe(dev, priv->irq, "failed to get IRQ\n");  in interrupt_cnt_probe()
174 	priv->gpio = devm_gpiod_get_optional(dev, NULL, GPIOD_IN);  in interrupt_cnt_probe()
175 	if (IS_ERR(priv->gpio))  in interrupt_cnt_probe()
176 		return dev_err_probe(dev, PTR_ERR(priv->gpio), "failed to get GPIO\n");  in interrupt_cnt_probe()
178 	if (!priv->irq && !priv->gpio) {  in interrupt_cnt_probe()
180 		return -ENODEV;  in interrupt_cnt_probe()
183 	if (!priv->irq) {  in interrupt_cnt_probe()
184 		int irq = gpiod_to_irq(priv->gpio);  in interrupt_cnt_probe()
189 		priv->irq = irq;  in interrupt_cnt_probe()
192 	priv->signals.name = devm_kasprintf(dev, GFP_KERNEL, "IRQ %d",  in interrupt_cnt_probe()
193 					    priv->irq);  in interrupt_cnt_probe()
194 	if (!priv->signals.name)  in interrupt_cnt_probe()
195 		return -ENOMEM;  in interrupt_cnt_probe()
197 	priv->counter.signals = &priv->signals;  in interrupt_cnt_probe()
198 	priv->counter.num_signals = 1;  in interrupt_cnt_probe()
200 	priv->synapses.actions_list = interrupt_cnt_synapse_actions;  in interrupt_cnt_probe()
201 	priv->synapses.num_actions = ARRAY_SIZE(interrupt_cnt_synapse_actions);  in interrupt_cnt_probe()
202 	priv->synapses.signal = &priv->signals;  in interrupt_cnt_probe()
204 	priv->cnts.name = "Channel 0 Count";  in interrupt_cnt_probe()
205 	priv->cnts.functions_list = interrupt_cnt_functions;  in interrupt_cnt_probe()
206 	priv->cnts.num_functions = ARRAY_SIZE(interrupt_cnt_functions);  in interrupt_cnt_probe()
207 	priv->cnts.synapses = &priv->synapses;  in interrupt_cnt_probe()
208 	priv->cnts.num_synapses = 1;  in interrupt_cnt_probe()
209 	priv->cnts.ext = interrupt_cnt_ext;  in interrupt_cnt_probe()
210 	priv->cnts.num_ext = ARRAY_SIZE(interrupt_cnt_ext);  in interrupt_cnt_probe()
212 	priv->counter.priv = priv;  in interrupt_cnt_probe()
213 	priv->counter.name = dev_name(dev);  in interrupt_cnt_probe()
214 	priv->counter.parent = dev;  in interrupt_cnt_probe()
215 	priv->counter.ops = &interrupt_cnt_ops;  in interrupt_cnt_probe()
216 	priv->counter.counts = &priv->cnts;  in interrupt_cnt_probe()
217 	priv->counter.num_counts = 1;  in interrupt_cnt_probe()
219 	irq_set_status_flags(priv->irq, IRQ_NOAUTOEN);  in interrupt_cnt_probe()
220 	ret = devm_request_irq(dev, priv->irq, interrupt_cnt_isr,  in interrupt_cnt_probe()
226 	return devm_counter_register(dev, &priv->counter);  in interrupt_cnt_probe()
230 	{ .compatible = "interrupt-counter", },
244 MODULE_ALIAS("platform:interrupt-counter");
246 MODULE_DESCRIPTION("Interrupt counter driver");