| /* | |
| * pps-ktimer.c -- kernel timer test client | |
| * | |
| * | |
| * Copyright (C) 2005-2006 Rodolfo Giometti <giometti@linux.it> | |
| * | |
| * This program is free software; you can redistribute it and/or modify | |
| * it under the terms of the GNU General Public License as published by | |
| * the Free Software Foundation; either version 2 of the License, or | |
| * (at your option) any later version. | |
| * | |
| * This program is distributed in the hope that it will be useful, | |
| * but WITHOUT ANY WARRANTY; without even the implied warranty of | |
| * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the | |
| * GNU General Public License for more details. | |
| * | |
| * You should have received a copy of the GNU General Public License | |
| * along with this program; if not, write to the Free Software | |
| * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA. | |
| */ | |
| #include <linux/kernel.h> | |
| #include <linux/module.h> | |
| #include <linux/init.h> | |
| #include <linux/time.h> | |
| #include <linux/timer.h> | |
| #include <linux/pps_kernel.h> | |
| /* | |
| * Global variables | |
| */ | |
| static int source; | |
| static struct timer_list ktimer; | |
| /* | |
| * The kernel timer | |
| */ | |
| static void pps_ktimer_event(unsigned long ptr) | |
| { | |
| struct timespec __ts; | |
| struct pps_ktime ts; | |
| /* First of all we get the time stamp... */ | |
| getnstimeofday(&__ts); | |
| pr_info("PPS event at %lu\n", jiffies); | |
| /* ... and translate it to PPS time data struct */ | |
| ts.sec = __ts.tv_sec; | |
| ts.nsec = __ts.tv_nsec; | |
| pps_event(source, &ts, PPS_CAPTUREASSERT, NULL); | |
| mod_timer(&ktimer, jiffies + HZ); | |
| } | |
| /* | |
| * The echo function | |
| */ | |
| static void pps_ktimer_echo(int source, int event, void *data) | |
| { | |
| pr_info("echo %s %s for source %d\n", | |
| event & PPS_CAPTUREASSERT ? "assert" : "", | |
| event & PPS_CAPTURECLEAR ? "clear" : "", | |
| source); | |
| } | |
| /* | |
| * The PPS info struct | |
| */ | |
| static struct pps_source_info pps_ktimer_info = { | |
| .name = "ktimer", | |
| .path = "", | |
| .mode = PPS_CAPTUREASSERT | PPS_OFFSETASSERT | | |
| PPS_ECHOASSERT | | |
| PPS_CANWAIT | PPS_TSFMT_TSPEC, | |
| .echo = pps_ktimer_echo, | |
| .owner = THIS_MODULE, | |
| }; | |
| /* | |
| * Module staff | |
| */ | |
| static void __exit pps_ktimer_exit(void) | |
| { | |
| del_timer_sync(&ktimer); | |
| pps_unregister_source(source); | |
| pr_info("ktimer PPS source unregistered\n"); | |
| } | |
| static int __init pps_ktimer_init(void) | |
| { | |
| int ret; | |
| ret = pps_register_source(&pps_ktimer_info, | |
| PPS_CAPTUREASSERT | PPS_OFFSETASSERT); | |
| if (ret < 0) { | |
| printk(KERN_ERR "cannot register ktimer source\n"); | |
| return ret; | |
| } | |
| source = ret; | |
| setup_timer(&ktimer, pps_ktimer_event, 0); | |
| mod_timer(&ktimer, jiffies + HZ); | |
| pr_info("ktimer PPS source registered at %d\n", source); | |
| return 0; | |
| } | |
| module_init(pps_ktimer_init); | |
| module_exit(pps_ktimer_exit); | |
| MODULE_AUTHOR("Rodolfo Giometti <giometti@linux.it>"); | |
| MODULE_DESCRIPTION("dummy PPS source by using a kernel timer (just for debug)"); | |
| MODULE_LICENSE("GPL"); |