pps/clients/pps-gpio.c

44 static irqreturn_t pps_gpio_irq_handler(int irq, void *data)
53 	info = data;
58 		pps_event(info->pps, &ts, PPS_CAPTUREASSERT, data);
62 		pps_event(info->pps, &ts, PPS_CAPTURECLEAR, data);
68 static void pps_gpio_echo(struct pps_device *pps, int event, void *data)
71 	struct pps_gpio_device_data *info = data;
104 	struct pps_gpio_device_data *data = dev_get_drvdata(dev);
108 	data->gpio_pin = devm_gpiod_get(dev, NULL, GPIOD_IN);
109 	if (IS_ERR(data->gpio_pin))
110 		return dev_err_probe(dev, PTR_ERR(data->gpio_pin),
113 	data->assert_falling_edge =
116 	data->echo_pin = devm_gpiod_get_optional(dev, "echo", GPIOD_OUT_LOW);
117 	if (IS_ERR(data->echo_pin))
118 		return dev_err_probe(dev, PTR_ERR(data->echo_pin),
121 	if (!data->echo_pin)
136 	data->echo_active_ms = value;
142 get_irqf_trigger_flags(const struct pps_gpio_device_data *data)
144 	unsigned long flags = data->assert_falling_edge ?
147 	if (data->capture_clear) {
157 	struct pps_gpio_device_data *data;
163 	data = devm_kzalloc(dev, sizeof(*data), GFP_KERNEL);
164 	if (!data)
167 	dev_set_drvdata(dev, data);
175 	ret = gpiod_to_irq(data->gpio_pin);
180 	data->irq = ret;
182 	/* initialize PPS specific parts of the bookkeeping data structure. */
183 	data->info.mode = PPS_CAPTUREASSERT | PPS_OFFSETASSERT |
185 	if (data->capture_clear)
186 		data->info.mode |= PPS_CAPTURECLEAR | PPS_OFFSETCLEAR |
188 	data->info.owner = THIS_MODULE;
189 	snprintf(data->info.name, PPS_MAX_NAME_LEN - 1, "%s.%d",
191 	if (data->echo_pin) {
192 		data->info.echo = pps_gpio_echo;
193 		data->echo_timeout = msecs_to_jiffies(data->echo_active_ms);
194 		timer_setup(&data->echo_timer, pps_gpio_echo_timer_callback, 0);
199 	if (data->capture_clear)
201 	data->pps = pps_register_source(&data->info, pps_default_params);
202 	if (IS_ERR(data->pps)) {
204 			data->irq);
205 		return PTR_ERR(data->pps);
209 	ret = devm_request_irq(dev, data->irq, pps_gpio_irq_handler,
210 			get_irqf_trigger_flags(data), data->info.name, data);
212 		pps_unregister_source(data->pps);
213 		dev_err(dev, "failed to acquire IRQ %d\n", data->irq);
217 	dev_info(data->pps->dev, "Registered IRQ %d as PPS source\n",
218 		 data->irq);
225 	struct pps_gpio_device_data *data = platform_get_drvdata(pdev);
227 	pps_unregister_source(data->pps);
228 	del_timer_sync(&data->echo_timer);
230 	gpiod_set_value(data->echo_pin, 0);
231 	dev_info(&pdev->dev, "removed IRQ %d as PPS source\n", data->irq);