1eae9d2ba0cfc27a2ad9765f23efb98fb80d80234Rodolfo Giometti/* 2eae9d2ba0cfc27a2ad9765f23efb98fb80d80234Rodolfo Giometti * kernel API 3eae9d2ba0cfc27a2ad9765f23efb98fb80d80234Rodolfo Giometti * 4eae9d2ba0cfc27a2ad9765f23efb98fb80d80234Rodolfo Giometti * 5eae9d2ba0cfc27a2ad9765f23efb98fb80d80234Rodolfo Giometti * Copyright (C) 2005-2009 Rodolfo Giometti <giometti@linux.it> 6eae9d2ba0cfc27a2ad9765f23efb98fb80d80234Rodolfo Giometti * 7eae9d2ba0cfc27a2ad9765f23efb98fb80d80234Rodolfo Giometti * This program is free software; you can redistribute it and/or modify 8eae9d2ba0cfc27a2ad9765f23efb98fb80d80234Rodolfo Giometti * it under the terms of the GNU General Public License as published by 9eae9d2ba0cfc27a2ad9765f23efb98fb80d80234Rodolfo Giometti * the Free Software Foundation; either version 2 of the License, or 10eae9d2ba0cfc27a2ad9765f23efb98fb80d80234Rodolfo Giometti * (at your option) any later version. 11eae9d2ba0cfc27a2ad9765f23efb98fb80d80234Rodolfo Giometti * 12eae9d2ba0cfc27a2ad9765f23efb98fb80d80234Rodolfo Giometti * This program is distributed in the hope that it will be useful, 13eae9d2ba0cfc27a2ad9765f23efb98fb80d80234Rodolfo Giometti * but WITHOUT ANY WARRANTY; without even the implied warranty of 14eae9d2ba0cfc27a2ad9765f23efb98fb80d80234Rodolfo Giometti * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the 15eae9d2ba0cfc27a2ad9765f23efb98fb80d80234Rodolfo Giometti * GNU General Public License for more details. 16eae9d2ba0cfc27a2ad9765f23efb98fb80d80234Rodolfo Giometti * 17eae9d2ba0cfc27a2ad9765f23efb98fb80d80234Rodolfo Giometti * You should have received a copy of the GNU General Public License 18eae9d2ba0cfc27a2ad9765f23efb98fb80d80234Rodolfo Giometti * along with this program; if not, write to the Free Software 19eae9d2ba0cfc27a2ad9765f23efb98fb80d80234Rodolfo Giometti * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA. 20eae9d2ba0cfc27a2ad9765f23efb98fb80d80234Rodolfo Giometti */ 21eae9d2ba0cfc27a2ad9765f23efb98fb80d80234Rodolfo Giometti 227f7cce74105adf714bdc9357da3b6f06e019958cAlexander Gordeev#define pr_fmt(fmt) KBUILD_MODNAME ": " fmt 23eae9d2ba0cfc27a2ad9765f23efb98fb80d80234Rodolfo Giometti 24eae9d2ba0cfc27a2ad9765f23efb98fb80d80234Rodolfo Giometti#include <linux/kernel.h> 25eae9d2ba0cfc27a2ad9765f23efb98fb80d80234Rodolfo Giometti#include <linux/module.h> 26eae9d2ba0cfc27a2ad9765f23efb98fb80d80234Rodolfo Giometti#include <linux/init.h> 27eae9d2ba0cfc27a2ad9765f23efb98fb80d80234Rodolfo Giometti#include <linux/sched.h> 28eae9d2ba0cfc27a2ad9765f23efb98fb80d80234Rodolfo Giometti#include <linux/time.h> 29717c033669ed3ceaee8df57d4562fafcc1a6267aAlexander Gordeev#include <linux/timex.h> 30eae9d2ba0cfc27a2ad9765f23efb98fb80d80234Rodolfo Giometti#include <linux/spinlock.h> 31eae9d2ba0cfc27a2ad9765f23efb98fb80d80234Rodolfo Giometti#include <linux/fs.h> 32eae9d2ba0cfc27a2ad9765f23efb98fb80d80234Rodolfo Giometti#include <linux/pps_kernel.h> 335a0e3ad6af8660be21ca98a971cd00f331318c05Tejun Heo#include <linux/slab.h> 34eae9d2ba0cfc27a2ad9765f23efb98fb80d80234Rodolfo Giometti 35717c033669ed3ceaee8df57d4562fafcc1a6267aAlexander Gordeev#include "kc.h" 36717c033669ed3ceaee8df57d4562fafcc1a6267aAlexander Gordeev 37eae9d2ba0cfc27a2ad9765f23efb98fb80d80234Rodolfo Giometti/* 38eae9d2ba0cfc27a2ad9765f23efb98fb80d80234Rodolfo Giometti * Local functions 39eae9d2ba0cfc27a2ad9765f23efb98fb80d80234Rodolfo Giometti */ 40eae9d2ba0cfc27a2ad9765f23efb98fb80d80234Rodolfo Giometti 41eae9d2ba0cfc27a2ad9765f23efb98fb80d80234Rodolfo Giomettistatic void pps_add_offset(struct pps_ktime *ts, struct pps_ktime *offset) 42eae9d2ba0cfc27a2ad9765f23efb98fb80d80234Rodolfo Giometti{ 43eae9d2ba0cfc27a2ad9765f23efb98fb80d80234Rodolfo Giometti ts->nsec += offset->nsec; 44eae9d2ba0cfc27a2ad9765f23efb98fb80d80234Rodolfo Giometti while (ts->nsec >= NSEC_PER_SEC) { 45eae9d2ba0cfc27a2ad9765f23efb98fb80d80234Rodolfo Giometti ts->nsec -= NSEC_PER_SEC; 46eae9d2ba0cfc27a2ad9765f23efb98fb80d80234Rodolfo Giometti ts->sec++; 47eae9d2ba0cfc27a2ad9765f23efb98fb80d80234Rodolfo Giometti } 48eae9d2ba0cfc27a2ad9765f23efb98fb80d80234Rodolfo Giometti while (ts->nsec < 0) { 49eae9d2ba0cfc27a2ad9765f23efb98fb80d80234Rodolfo Giometti ts->nsec += NSEC_PER_SEC; 50eae9d2ba0cfc27a2ad9765f23efb98fb80d80234Rodolfo Giometti ts->sec--; 51eae9d2ba0cfc27a2ad9765f23efb98fb80d80234Rodolfo Giometti } 52eae9d2ba0cfc27a2ad9765f23efb98fb80d80234Rodolfo Giometti ts->sec += offset->sec; 53eae9d2ba0cfc27a2ad9765f23efb98fb80d80234Rodolfo Giometti} 54eae9d2ba0cfc27a2ad9765f23efb98fb80d80234Rodolfo Giometti 55437c53418616973071fd2d7c87497780944d8fdbJames Nussstatic void pps_echo_client_default(struct pps_device *pps, int event, 56437c53418616973071fd2d7c87497780944d8fdbJames Nuss void *data) 57437c53418616973071fd2d7c87497780944d8fdbJames Nuss{ 58437c53418616973071fd2d7c87497780944d8fdbJames Nuss dev_info(pps->dev, "echo %s %s\n", 59437c53418616973071fd2d7c87497780944d8fdbJames Nuss event & PPS_CAPTUREASSERT ? "assert" : "", 60437c53418616973071fd2d7c87497780944d8fdbJames Nuss event & PPS_CAPTURECLEAR ? "clear" : ""); 61437c53418616973071fd2d7c87497780944d8fdbJames Nuss} 62437c53418616973071fd2d7c87497780944d8fdbJames Nuss 63eae9d2ba0cfc27a2ad9765f23efb98fb80d80234Rodolfo Giometti/* 64eae9d2ba0cfc27a2ad9765f23efb98fb80d80234Rodolfo Giometti * Exported functions 65eae9d2ba0cfc27a2ad9765f23efb98fb80d80234Rodolfo Giometti */ 66eae9d2ba0cfc27a2ad9765f23efb98fb80d80234Rodolfo Giometti 67eae9d2ba0cfc27a2ad9765f23efb98fb80d80234Rodolfo Giometti/* pps_register_source - add a PPS source in the system 68eae9d2ba0cfc27a2ad9765f23efb98fb80d80234Rodolfo Giometti * @info: the PPS info struct 69eae9d2ba0cfc27a2ad9765f23efb98fb80d80234Rodolfo Giometti * @default_params: the default PPS parameters of the new source 70eae9d2ba0cfc27a2ad9765f23efb98fb80d80234Rodolfo Giometti * 71eae9d2ba0cfc27a2ad9765f23efb98fb80d80234Rodolfo Giometti * This function is used to add a new PPS source in the system. The new 72eae9d2ba0cfc27a2ad9765f23efb98fb80d80234Rodolfo Giometti * source is described by info's fields and it will have, as default PPS 73eae9d2ba0cfc27a2ad9765f23efb98fb80d80234Rodolfo Giometti * parameters, the ones specified into default_params. 74eae9d2ba0cfc27a2ad9765f23efb98fb80d80234Rodolfo Giometti * 755e196d34a776420278e4117b4742cd9d3f2350edAlexander Gordeev * The function returns, in case of success, the PPS device. Otherwise NULL. 76eae9d2ba0cfc27a2ad9765f23efb98fb80d80234Rodolfo Giometti */ 77eae9d2ba0cfc27a2ad9765f23efb98fb80d80234Rodolfo Giometti 785e196d34a776420278e4117b4742cd9d3f2350edAlexander Gordeevstruct pps_device *pps_register_source(struct pps_source_info *info, 795e196d34a776420278e4117b4742cd9d3f2350edAlexander Gordeev int default_params) 80eae9d2ba0cfc27a2ad9765f23efb98fb80d80234Rodolfo Giometti{ 81eae9d2ba0cfc27a2ad9765f23efb98fb80d80234Rodolfo Giometti struct pps_device *pps; 82eae9d2ba0cfc27a2ad9765f23efb98fb80d80234Rodolfo Giometti int err; 83eae9d2ba0cfc27a2ad9765f23efb98fb80d80234Rodolfo Giometti 84eae9d2ba0cfc27a2ad9765f23efb98fb80d80234Rodolfo Giometti /* Sanity checks */ 85eae9d2ba0cfc27a2ad9765f23efb98fb80d80234Rodolfo Giometti if ((info->mode & default_params) != default_params) { 867f7cce74105adf714bdc9357da3b6f06e019958cAlexander Gordeev pr_err("%s: unsupported default parameters\n", 87eae9d2ba0cfc27a2ad9765f23efb98fb80d80234Rodolfo Giometti info->name); 88eae9d2ba0cfc27a2ad9765f23efb98fb80d80234Rodolfo Giometti err = -EINVAL; 89eae9d2ba0cfc27a2ad9765f23efb98fb80d80234Rodolfo Giometti goto pps_register_source_exit; 90eae9d2ba0cfc27a2ad9765f23efb98fb80d80234Rodolfo Giometti } 91eae9d2ba0cfc27a2ad9765f23efb98fb80d80234Rodolfo Giometti if ((info->mode & (PPS_TSFMT_TSPEC | PPS_TSFMT_NTPFP)) == 0) { 927f7cce74105adf714bdc9357da3b6f06e019958cAlexander Gordeev pr_err("%s: unspecified time format\n", 93eae9d2ba0cfc27a2ad9765f23efb98fb80d80234Rodolfo Giometti info->name); 94eae9d2ba0cfc27a2ad9765f23efb98fb80d80234Rodolfo Giometti err = -EINVAL; 95eae9d2ba0cfc27a2ad9765f23efb98fb80d80234Rodolfo Giometti goto pps_register_source_exit; 96eae9d2ba0cfc27a2ad9765f23efb98fb80d80234Rodolfo Giometti } 97eae9d2ba0cfc27a2ad9765f23efb98fb80d80234Rodolfo Giometti 98eae9d2ba0cfc27a2ad9765f23efb98fb80d80234Rodolfo Giometti /* Allocate memory for the new PPS source struct */ 99eae9d2ba0cfc27a2ad9765f23efb98fb80d80234Rodolfo Giometti pps = kzalloc(sizeof(struct pps_device), GFP_KERNEL); 100eae9d2ba0cfc27a2ad9765f23efb98fb80d80234Rodolfo Giometti if (pps == NULL) { 101eae9d2ba0cfc27a2ad9765f23efb98fb80d80234Rodolfo Giometti err = -ENOMEM; 102eae9d2ba0cfc27a2ad9765f23efb98fb80d80234Rodolfo Giometti goto pps_register_source_exit; 103eae9d2ba0cfc27a2ad9765f23efb98fb80d80234Rodolfo Giometti } 104eae9d2ba0cfc27a2ad9765f23efb98fb80d80234Rodolfo Giometti 105eae9d2ba0cfc27a2ad9765f23efb98fb80d80234Rodolfo Giometti /* These initializations must be done before calling idr_get_new() 106eae9d2ba0cfc27a2ad9765f23efb98fb80d80234Rodolfo Giometti * in order to avoid reces into pps_event(). 107eae9d2ba0cfc27a2ad9765f23efb98fb80d80234Rodolfo Giometti */ 108eae9d2ba0cfc27a2ad9765f23efb98fb80d80234Rodolfo Giometti pps->params.api_version = PPS_API_VERS; 109eae9d2ba0cfc27a2ad9765f23efb98fb80d80234Rodolfo Giometti pps->params.mode = default_params; 110eae9d2ba0cfc27a2ad9765f23efb98fb80d80234Rodolfo Giometti pps->info = *info; 111eae9d2ba0cfc27a2ad9765f23efb98fb80d80234Rodolfo Giometti 112437c53418616973071fd2d7c87497780944d8fdbJames Nuss /* check for default echo function */ 113437c53418616973071fd2d7c87497780944d8fdbJames Nuss if ((pps->info.mode & (PPS_ECHOASSERT | PPS_ECHOCLEAR)) && 114437c53418616973071fd2d7c87497780944d8fdbJames Nuss pps->info.echo == NULL) 115437c53418616973071fd2d7c87497780944d8fdbJames Nuss pps->info.echo = pps_echo_client_default; 116437c53418616973071fd2d7c87497780944d8fdbJames Nuss 117eae9d2ba0cfc27a2ad9765f23efb98fb80d80234Rodolfo Giometti init_waitqueue_head(&pps->queue); 118eae9d2ba0cfc27a2ad9765f23efb98fb80d80234Rodolfo Giometti spin_lock_init(&pps->lock); 119eae9d2ba0cfc27a2ad9765f23efb98fb80d80234Rodolfo Giometti 120eae9d2ba0cfc27a2ad9765f23efb98fb80d80234Rodolfo Giometti /* Create the char device */ 121eae9d2ba0cfc27a2ad9765f23efb98fb80d80234Rodolfo Giometti err = pps_register_cdev(pps); 122eae9d2ba0cfc27a2ad9765f23efb98fb80d80234Rodolfo Giometti if (err < 0) { 1237f7cce74105adf714bdc9357da3b6f06e019958cAlexander Gordeev pr_err("%s: unable to create char device\n", 124eae9d2ba0cfc27a2ad9765f23efb98fb80d80234Rodolfo Giometti info->name); 125083e58666ff5b3c5750d9a5c0560018b03cfb4b2Alexander Gordeev goto kfree_pps; 126eae9d2ba0cfc27a2ad9765f23efb98fb80d80234Rodolfo Giometti } 127eae9d2ba0cfc27a2ad9765f23efb98fb80d80234Rodolfo Giometti 1287f7cce74105adf714bdc9357da3b6f06e019958cAlexander Gordeev dev_info(pps->dev, "new PPS source %s\n", info->name); 129eae9d2ba0cfc27a2ad9765f23efb98fb80d80234Rodolfo Giometti 1305e196d34a776420278e4117b4742cd9d3f2350edAlexander Gordeev return pps; 131eae9d2ba0cfc27a2ad9765f23efb98fb80d80234Rodolfo Giometti 132eae9d2ba0cfc27a2ad9765f23efb98fb80d80234Rodolfo Giomettikfree_pps: 133eae9d2ba0cfc27a2ad9765f23efb98fb80d80234Rodolfo Giometti kfree(pps); 134eae9d2ba0cfc27a2ad9765f23efb98fb80d80234Rodolfo Giometti 135eae9d2ba0cfc27a2ad9765f23efb98fb80d80234Rodolfo Giomettipps_register_source_exit: 1367f7cce74105adf714bdc9357da3b6f06e019958cAlexander Gordeev pr_err("%s: unable to register source\n", info->name); 137eae9d2ba0cfc27a2ad9765f23efb98fb80d80234Rodolfo Giometti 1385e196d34a776420278e4117b4742cd9d3f2350edAlexander Gordeev return NULL; 139eae9d2ba0cfc27a2ad9765f23efb98fb80d80234Rodolfo Giometti} 140eae9d2ba0cfc27a2ad9765f23efb98fb80d80234Rodolfo GiomettiEXPORT_SYMBOL(pps_register_source); 141eae9d2ba0cfc27a2ad9765f23efb98fb80d80234Rodolfo Giometti 142eae9d2ba0cfc27a2ad9765f23efb98fb80d80234Rodolfo Giometti/* pps_unregister_source - remove a PPS source from the system 1435e196d34a776420278e4117b4742cd9d3f2350edAlexander Gordeev * @pps: the PPS source 144eae9d2ba0cfc27a2ad9765f23efb98fb80d80234Rodolfo Giometti * 145eae9d2ba0cfc27a2ad9765f23efb98fb80d80234Rodolfo Giometti * This function is used to remove a previously registered PPS source from 146eae9d2ba0cfc27a2ad9765f23efb98fb80d80234Rodolfo Giometti * the system. 147eae9d2ba0cfc27a2ad9765f23efb98fb80d80234Rodolfo Giometti */ 148eae9d2ba0cfc27a2ad9765f23efb98fb80d80234Rodolfo Giometti 1495e196d34a776420278e4117b4742cd9d3f2350edAlexander Gordeevvoid pps_unregister_source(struct pps_device *pps) 150eae9d2ba0cfc27a2ad9765f23efb98fb80d80234Rodolfo Giometti{ 151717c033669ed3ceaee8df57d4562fafcc1a6267aAlexander Gordeev pps_kc_remove(pps); 1525e196d34a776420278e4117b4742cd9d3f2350edAlexander Gordeev pps_unregister_cdev(pps); 153eae9d2ba0cfc27a2ad9765f23efb98fb80d80234Rodolfo Giometti 154083e58666ff5b3c5750d9a5c0560018b03cfb4b2Alexander Gordeev /* don't have to kfree(pps) here because it will be done on 155083e58666ff5b3c5750d9a5c0560018b03cfb4b2Alexander Gordeev * device destruction */ 156eae9d2ba0cfc27a2ad9765f23efb98fb80d80234Rodolfo Giometti} 157eae9d2ba0cfc27a2ad9765f23efb98fb80d80234Rodolfo GiomettiEXPORT_SYMBOL(pps_unregister_source); 158eae9d2ba0cfc27a2ad9765f23efb98fb80d80234Rodolfo Giometti 159eae9d2ba0cfc27a2ad9765f23efb98fb80d80234Rodolfo Giometti/* pps_event - register a PPS event into the system 1605e196d34a776420278e4117b4742cd9d3f2350edAlexander Gordeev * @pps: the PPS device 161eae9d2ba0cfc27a2ad9765f23efb98fb80d80234Rodolfo Giometti * @ts: the event timestamp 162eae9d2ba0cfc27a2ad9765f23efb98fb80d80234Rodolfo Giometti * @event: the event type 163eae9d2ba0cfc27a2ad9765f23efb98fb80d80234Rodolfo Giometti * @data: userdef pointer 164eae9d2ba0cfc27a2ad9765f23efb98fb80d80234Rodolfo Giometti * 165eae9d2ba0cfc27a2ad9765f23efb98fb80d80234Rodolfo Giometti * This function is used by each PPS client in order to register a new 166eae9d2ba0cfc27a2ad9765f23efb98fb80d80234Rodolfo Giometti * PPS event into the system (it's usually called inside an IRQ handler). 167eae9d2ba0cfc27a2ad9765f23efb98fb80d80234Rodolfo Giometti * 1685e196d34a776420278e4117b4742cd9d3f2350edAlexander Gordeev * If an echo function is associated with the PPS device it will be called 169eae9d2ba0cfc27a2ad9765f23efb98fb80d80234Rodolfo Giometti * as: 1705e196d34a776420278e4117b4742cd9d3f2350edAlexander Gordeev * pps->info.echo(pps, event, data); 171eae9d2ba0cfc27a2ad9765f23efb98fb80d80234Rodolfo Giometti */ 1725e196d34a776420278e4117b4742cd9d3f2350edAlexander Gordeevvoid pps_event(struct pps_device *pps, struct pps_event_time *ts, int event, 1735e196d34a776420278e4117b4742cd9d3f2350edAlexander Gordeev void *data) 174eae9d2ba0cfc27a2ad9765f23efb98fb80d80234Rodolfo Giometti{ 175eae9d2ba0cfc27a2ad9765f23efb98fb80d80234Rodolfo Giometti unsigned long flags; 176276b282e904f690dc930f9bc946110651f297669Rodolfo Giometti int captured = 0; 17799b0d365e5ade293c5fa25a9f1a49ac764656670Alexander Gordeev struct pps_ktime ts_real = { .sec = 0, .nsec = 0, .flags = 0 }; 178eae9d2ba0cfc27a2ad9765f23efb98fb80d80234Rodolfo Giometti 17929f347c9faf53cfb953e4d529e6e632482214e62Alexander Gordeev /* check event type */ 18029f347c9faf53cfb953e4d529e6e632482214e62Alexander Gordeev BUG_ON((event & (PPS_CAPTUREASSERT | PPS_CAPTURECLEAR)) == 0); 181eae9d2ba0cfc27a2ad9765f23efb98fb80d80234Rodolfo Giometti 1825e196d34a776420278e4117b4742cd9d3f2350edAlexander Gordeev dev_dbg(pps->dev, "PPS event at %ld.%09ld\n", 1835e196d34a776420278e4117b4742cd9d3f2350edAlexander Gordeev ts->ts_real.tv_sec, ts->ts_real.tv_nsec); 1846f4229b51106cbc859e9d8209b22c8a2ec749e64Alexander Gordeev 1856f4229b51106cbc859e9d8209b22c8a2ec749e64Alexander Gordeev timespec_to_pps_ktime(&ts_real, ts->ts_real); 186eae9d2ba0cfc27a2ad9765f23efb98fb80d80234Rodolfo Giometti 187eae9d2ba0cfc27a2ad9765f23efb98fb80d80234Rodolfo Giometti spin_lock_irqsave(&pps->lock, flags); 188eae9d2ba0cfc27a2ad9765f23efb98fb80d80234Rodolfo Giometti 189eae9d2ba0cfc27a2ad9765f23efb98fb80d80234Rodolfo Giometti /* Must call the echo function? */ 190eae9d2ba0cfc27a2ad9765f23efb98fb80d80234Rodolfo Giometti if ((pps->params.mode & (PPS_ECHOASSERT | PPS_ECHOCLEAR))) 1915e196d34a776420278e4117b4742cd9d3f2350edAlexander Gordeev pps->info.echo(pps, event, data); 192eae9d2ba0cfc27a2ad9765f23efb98fb80d80234Rodolfo Giometti 193eae9d2ba0cfc27a2ad9765f23efb98fb80d80234Rodolfo Giometti /* Check the event */ 194eae9d2ba0cfc27a2ad9765f23efb98fb80d80234Rodolfo Giometti pps->current_mode = pps->params.mode; 195818b9eefe742cc29c6456e163e2c035cfb431e51Alexander Gordeev if (event & pps->params.mode & PPS_CAPTUREASSERT) { 196eae9d2ba0cfc27a2ad9765f23efb98fb80d80234Rodolfo Giometti /* We have to add an offset? */ 197eae9d2ba0cfc27a2ad9765f23efb98fb80d80234Rodolfo Giometti if (pps->params.mode & PPS_OFFSETASSERT) 1986f4229b51106cbc859e9d8209b22c8a2ec749e64Alexander Gordeev pps_add_offset(&ts_real, 1996f4229b51106cbc859e9d8209b22c8a2ec749e64Alexander Gordeev &pps->params.assert_off_tu); 200eae9d2ba0cfc27a2ad9765f23efb98fb80d80234Rodolfo Giometti 201eae9d2ba0cfc27a2ad9765f23efb98fb80d80234Rodolfo Giometti /* Save the time stamp */ 2026f4229b51106cbc859e9d8209b22c8a2ec749e64Alexander Gordeev pps->assert_tu = ts_real; 203eae9d2ba0cfc27a2ad9765f23efb98fb80d80234Rodolfo Giometti pps->assert_sequence++; 2045e196d34a776420278e4117b4742cd9d3f2350edAlexander Gordeev dev_dbg(pps->dev, "capture assert seq #%u\n", 2055e196d34a776420278e4117b4742cd9d3f2350edAlexander Gordeev pps->assert_sequence); 206276b282e904f690dc930f9bc946110651f297669Rodolfo Giometti 207276b282e904f690dc930f9bc946110651f297669Rodolfo Giometti captured = ~0; 208eae9d2ba0cfc27a2ad9765f23efb98fb80d80234Rodolfo Giometti } 209818b9eefe742cc29c6456e163e2c035cfb431e51Alexander Gordeev if (event & pps->params.mode & PPS_CAPTURECLEAR) { 210eae9d2ba0cfc27a2ad9765f23efb98fb80d80234Rodolfo Giometti /* We have to add an offset? */ 211eae9d2ba0cfc27a2ad9765f23efb98fb80d80234Rodolfo Giometti if (pps->params.mode & PPS_OFFSETCLEAR) 2126f4229b51106cbc859e9d8209b22c8a2ec749e64Alexander Gordeev pps_add_offset(&ts_real, 2136f4229b51106cbc859e9d8209b22c8a2ec749e64Alexander Gordeev &pps->params.clear_off_tu); 214eae9d2ba0cfc27a2ad9765f23efb98fb80d80234Rodolfo Giometti 215eae9d2ba0cfc27a2ad9765f23efb98fb80d80234Rodolfo Giometti /* Save the time stamp */ 2166f4229b51106cbc859e9d8209b22c8a2ec749e64Alexander Gordeev pps->clear_tu = ts_real; 217eae9d2ba0cfc27a2ad9765f23efb98fb80d80234Rodolfo Giometti pps->clear_sequence++; 2185e196d34a776420278e4117b4742cd9d3f2350edAlexander Gordeev dev_dbg(pps->dev, "capture clear seq #%u\n", 2195e196d34a776420278e4117b4742cd9d3f2350edAlexander Gordeev pps->clear_sequence); 220276b282e904f690dc930f9bc946110651f297669Rodolfo Giometti 221276b282e904f690dc930f9bc946110651f297669Rodolfo Giometti captured = ~0; 222eae9d2ba0cfc27a2ad9765f23efb98fb80d80234Rodolfo Giometti } 223eae9d2ba0cfc27a2ad9765f23efb98fb80d80234Rodolfo Giometti 224717c033669ed3ceaee8df57d4562fafcc1a6267aAlexander Gordeev pps_kc_event(pps, ts, event); 225717c033669ed3ceaee8df57d4562fafcc1a6267aAlexander Gordeev 2267a21a3cc0be92e70474cc2ab06cb074f6a7c3f09Alexander Gordeev /* Wake up if captured something */ 227276b282e904f690dc930f9bc946110651f297669Rodolfo Giometti if (captured) { 2283003d55b59aa98aeaff2773df69732b27c0cbf6aAlexander Gordeev pps->last_ev++; 2293003d55b59aa98aeaff2773df69732b27c0cbf6aAlexander Gordeev wake_up_interruptible_all(&pps->queue); 230eae9d2ba0cfc27a2ad9765f23efb98fb80d80234Rodolfo Giometti 231276b282e904f690dc930f9bc946110651f297669Rodolfo Giometti kill_fasync(&pps->async_queue, SIGIO, POLL_IN); 232276b282e904f690dc930f9bc946110651f297669Rodolfo Giometti } 233eae9d2ba0cfc27a2ad9765f23efb98fb80d80234Rodolfo Giometti 234eae9d2ba0cfc27a2ad9765f23efb98fb80d80234Rodolfo Giometti spin_unlock_irqrestore(&pps->lock, flags); 235eae9d2ba0cfc27a2ad9765f23efb98fb80d80234Rodolfo Giometti} 236eae9d2ba0cfc27a2ad9765f23efb98fb80d80234Rodolfo GiomettiEXPORT_SYMBOL(pps_event); 237