forked from redlab-i/pps-tools
Commit
This commit does not belong to any branch on this repository, and may belong to a fork outside of the repository.
These files has been taken directly form LinuxPPS repository before removing them from kernel code. Signed-off-by: Rodolfo Giometti <giometti@linux.it>
- Loading branch information
Rodolfo Giometti
committed
Feb 22, 2010
0 parents
commit 5980a04
Showing
4 changed files
with
392 additions
and
0 deletions.
There are no files selected for viewing
This file contains bidirectional Unicode text that may be interpreted or compiled differently than what appears below. To review, open the file in an editor that reveals hidden Unicode characters.
Learn more about bidirectional Unicode characters
Original file line number | Diff line number | Diff line change |
---|---|---|
@@ -0,0 +1,27 @@ | ||
TARGETS = ppstest | ||
|
||
CFLAGS += -Wall -O2 -D_GNU_SOURCE | ||
CFLAGS += -I . -I ../../include/ | ||
CFLAGS += -ggdb | ||
|
||
# -- Actions section -- | ||
|
||
.PHONY : all depend dep | ||
|
||
all : .depend $(TARGETS) | ||
|
||
.depend depend dep : | ||
$(CC) $(CFLAGS) -M $(TARGETS:=.c) > .depend | ||
|
||
ifeq (.depend,$(wildcard .depend)) | ||
include .depend | ||
endif | ||
|
||
|
||
# -- Clean section -- | ||
|
||
.PHONY : clean | ||
|
||
clean : | ||
rm -f *.o *~ core .depend | ||
rm -f ${TARGETS} |
This file contains bidirectional Unicode text that may be interpreted or compiled differently than what appears below. To review, open the file in an editor that reveals hidden Unicode characters.
Learn more about bidirectional Unicode characters
Original file line number | Diff line number | Diff line change |
---|---|---|
@@ -0,0 +1,17 @@ | ||
#!/bin/sh | ||
|
||
SYS="/sys/class/pps/" | ||
|
||
if [ $# -lt 1 ] ; then | ||
echo "usage: ppsfind <name>" >&2 | ||
exit 1 | ||
fi | ||
|
||
for d in $(ls $SYS) ; do | ||
if grep $1 $SYS/$d/name >& /dev/null || \ | ||
grep $1 $SYS/$d/path >& /dev/null ; then | ||
echo "$d: name=$(cat $SYS/$d/name) path=$(cat $SYS/$d/path)" | ||
fi | ||
done | ||
|
||
exit 0 |
This file contains bidirectional Unicode text that may be interpreted or compiled differently than what appears below. To review, open the file in an editor that reveals hidden Unicode characters.
Learn more about bidirectional Unicode characters
Original file line number | Diff line number | Diff line change |
---|---|---|
@@ -0,0 +1,150 @@ | ||
#include <stdio.h> | ||
#include <stdlib.h> | ||
#include <unistd.h> | ||
#include <fcntl.h> | ||
#include <sys/types.h> | ||
#include <sys/stat.h> | ||
|
||
#include <timepps.h> | ||
|
||
int find_source(char *path, pps_handle_t *handle, int *avail_mode) | ||
{ | ||
pps_params_t params; | ||
int ret; | ||
|
||
printf("trying PPS source \"%s\"\n", path); | ||
|
||
/* Try to find the source by using the supplied "path" name */ | ||
ret = open(path, O_RDWR); | ||
if (ret < 0) { | ||
fprintf(stderr, "unable to open device \"%s\" (%m)\n", path); | ||
return ret; | ||
} | ||
|
||
/* Open the PPS source (and check the file descriptor) */ | ||
ret = time_pps_create(ret, handle); | ||
if (ret < 0) { | ||
fprintf(stderr, "cannot create a PPS source from device " | ||
"\"%s\" (%m)\n", path); | ||
return -1; | ||
} | ||
printf("found PPS source \"%s\"\n", path); | ||
|
||
/* Find out what features are supported */ | ||
ret = time_pps_getcap(*handle, avail_mode); | ||
if (ret < 0) { | ||
fprintf(stderr, "cannot get capabilities (%m)\n"); | ||
return -1; | ||
} | ||
if ((*avail_mode & PPS_CAPTUREASSERT) == 0) { | ||
fprintf(stderr, "cannot CAPTUREASSERT\n"); | ||
return -1; | ||
} | ||
if ((*avail_mode & PPS_OFFSETASSERT) == 0) { | ||
fprintf(stderr, "cannot OFFSETASSERT\n"); | ||
return -1; | ||
} | ||
|
||
/* Capture assert timestamps, and compensate for a 675 nsec | ||
* propagation delay */ | ||
ret = time_pps_getparams(*handle, ¶ms); | ||
if (ret < 0) { | ||
fprintf(stderr, "cannot get parameters (%m)\n"); | ||
return -1; | ||
} | ||
params.assert_offset.tv_sec = 0; | ||
params.assert_offset.tv_nsec = 675; | ||
params.mode |= PPS_CAPTUREASSERT | PPS_OFFSETASSERT; | ||
params.mode &= ~(PPS_CAPTURECLEAR | PPS_OFFSETCLEAR); | ||
ret = time_pps_setparams(*handle, ¶ms); | ||
if (ret < 0) { | ||
fprintf(stderr, "cannot set parameters (%m)\n"); | ||
return -1; | ||
} | ||
|
||
return 0; | ||
} | ||
|
||
int fetch_source(int i, pps_handle_t *handle, int *avail_mode) | ||
{ | ||
struct timespec timeout; | ||
pps_info_t infobuf; | ||
int ret; | ||
|
||
/* create a zero-valued timeout */ | ||
timeout.tv_sec = 3; | ||
timeout.tv_nsec = 0; | ||
|
||
retry: | ||
if (*avail_mode & PPS_CANWAIT) /* waits for the next event */ | ||
ret = time_pps_fetch(*handle, PPS_TSFMT_TSPEC, &infobuf, | ||
&timeout); | ||
else { | ||
sleep(1); | ||
ret = time_pps_fetch(*handle, PPS_TSFMT_TSPEC, &infobuf, | ||
&timeout); | ||
} | ||
if (ret < 0) { | ||
if (ret == -EINTR) { | ||
fprintf(stderr, "time_pps_fetch() got a signal!\n"); | ||
goto retry; | ||
} | ||
|
||
fprintf(stderr, "time_pps_fetch() error %d (%m)\n", ret); | ||
return -1; | ||
} | ||
|
||
printf("source %d - " | ||
"assert %ld.%09ld, sequence: %ld - " | ||
"clear %ld.%09ld, sequence: %ld\n", | ||
i, | ||
infobuf.assert_timestamp.tv_sec, | ||
infobuf.assert_timestamp.tv_nsec, | ||
infobuf.assert_sequence, | ||
infobuf.clear_timestamp.tv_sec, | ||
infobuf.clear_timestamp.tv_nsec, infobuf.clear_sequence); | ||
|
||
return 0; | ||
} | ||
|
||
void usage(char *name) | ||
{ | ||
fprintf(stderr, "usage: %s <ppsdev> [<ppsdev> ...]\n", name); | ||
exit(EXIT_FAILURE); | ||
} | ||
|
||
int main(int argc, char *argv[]) | ||
{ | ||
int num; | ||
pps_handle_t handle[4]; | ||
int avail_mode[4]; | ||
int i = 0; | ||
int ret; | ||
|
||
/* Check the command line */ | ||
if (argc < 2) | ||
usage(argv[0]); | ||
|
||
for (i = 1; i < argc && i <= 4; i++) { | ||
ret = find_source(argv[i], &handle[i - 1], &avail_mode[i - 1]); | ||
if (ret < 0) | ||
exit(EXIT_FAILURE); | ||
} | ||
|
||
num = i - 1; | ||
printf("ok, found %d source(s), now start fetching data...\n", num); | ||
|
||
/* loop, printing the most recent timestamp every second or so */ | ||
while (1) { | ||
for (i = 0; i < num; i++) { | ||
ret = fetch_source(i, &handle[i], &avail_mode[i]); | ||
if (ret < 0 && errno != ETIMEDOUT) | ||
exit(EXIT_FAILURE); | ||
} | ||
} | ||
|
||
for (; i >= 0; i--) | ||
time_pps_destroy(handle[i]); | ||
|
||
return 0; | ||
} |
This file contains bidirectional Unicode text that may be interpreted or compiled differently than what appears below. To review, open the file in an editor that reveals hidden Unicode characters.
Learn more about bidirectional Unicode characters
Original file line number | Diff line number | Diff line change |
---|---|---|
@@ -0,0 +1,198 @@ | ||
/* | ||
* timepps.h -- PPS API main header | ||
* | ||
* Copyright (C) 2005-2007 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. | ||
*/ | ||
|
||
#ifndef _SYS_TIMEPPS_H_ | ||
#define _SYS_TIMEPPS_H_ | ||
|
||
#include <errno.h> | ||
#include <sys/time.h> | ||
#include <sys/ioctl.h> | ||
#include <linux/types.h> | ||
#include <linux/pps.h> | ||
|
||
#define LINUXPPS 1 /* signal we are using LinuxPPS */ | ||
|
||
/* | ||
* New data structures | ||
*/ | ||
|
||
struct ntp_fp { | ||
unsigned int integral; | ||
unsigned int fractional; | ||
}; | ||
|
||
union pps_timeu { | ||
struct timespec tspec; | ||
struct ntp_fp ntpfp; | ||
unsigned long longpad[3]; | ||
}; | ||
|
||
struct pps_info { | ||
unsigned long assert_sequence; /* seq. num. of assert event */ | ||
unsigned long clear_sequence; /* seq. num. of clear event */ | ||
union pps_timeu assert_tu; /* time of assert event */ | ||
union pps_timeu clear_tu; /* time of clear event */ | ||
int current_mode; /* current mode bits */ | ||
}; | ||
|
||
struct pps_params { | ||
int api_version; /* API version # */ | ||
int mode; /* mode bits */ | ||
union pps_timeu assert_off_tu; /* offset compensation for assert */ | ||
union pps_timeu clear_off_tu; /* offset compensation for clear */ | ||
}; | ||
|
||
typedef int pps_handle_t; /* represents a PPS source */ | ||
typedef unsigned long pps_seq_t; /* sequence number */ | ||
typedef struct ntp_fp ntp_fp_t; /* NTP-compatible time stamp */ | ||
typedef union pps_timeu pps_timeu_t; /* generic data type for time stamps */ | ||
typedef struct pps_info pps_info_t; | ||
typedef struct pps_params pps_params_t; | ||
|
||
#define assert_timestamp assert_tu.tspec | ||
#define clear_timestamp clear_tu.tspec | ||
|
||
#define assert_timestamp_ntpfp assert_tu.ntpfp | ||
#define clear_timestamp_ntpfp clear_tu.ntpfp | ||
|
||
#define assert_offset assert_off_tu.tspec | ||
#define clear_offset clear_off_tu.tspec | ||
|
||
#define assert_offset_ntpfp assert_off_tu.ntpfp | ||
#define clear_offset_ntpfp clear_off_tu.ntpfp | ||
|
||
/* | ||
* The PPS API | ||
*/ | ||
|
||
static __inline int time_pps_create(int source, pps_handle_t *handle) | ||
{ | ||
int ret; | ||
struct pps_kparams dummy; | ||
|
||
if (!handle) { | ||
errno = EINVAL; | ||
return -1; | ||
} | ||
|
||
/* First we check if current device is a valid PPS one by | ||
* doing a dummy PPS_GETPARAMS... | ||
*/ | ||
ret = ioctl(source, PPS_GETPARAMS, &dummy); | ||
if (ret) { | ||
errno = EOPNOTSUPP; | ||
return -1; | ||
} | ||
|
||
/* ... then since in LinuxPPS there are no differences between a | ||
* "PPS source" and a "PPS handle", we simply return the same value. | ||
*/ | ||
*handle = source; | ||
|
||
return 0; | ||
} | ||
|
||
static __inline int time_pps_destroy(pps_handle_t handle) | ||
{ | ||
return close(handle); | ||
} | ||
|
||
static __inline int time_pps_getparams(pps_handle_t handle, | ||
pps_params_t *ppsparams) | ||
{ | ||
int ret; | ||
struct pps_kparams __ppsparams; | ||
|
||
ret = ioctl(handle, PPS_GETPARAMS, &__ppsparams); | ||
|
||
ppsparams->api_version = __ppsparams.api_version; | ||
ppsparams->mode = __ppsparams.mode; | ||
ppsparams->assert_off_tu.tspec.tv_sec = __ppsparams.assert_off_tu.sec; | ||
ppsparams->assert_off_tu.tspec.tv_nsec = __ppsparams.assert_off_tu.nsec; | ||
ppsparams->clear_off_tu.tspec.tv_sec = __ppsparams.clear_off_tu.sec; | ||
ppsparams->clear_off_tu.tspec.tv_nsec = __ppsparams.clear_off_tu.nsec; | ||
|
||
return ret; | ||
} | ||
|
||
static __inline int time_pps_setparams(pps_handle_t handle, | ||
const pps_params_t *ppsparams) | ||
{ | ||
struct pps_kparams __ppsparams; | ||
|
||
__ppsparams.api_version = ppsparams->api_version; | ||
__ppsparams.mode = ppsparams->mode; | ||
__ppsparams.assert_off_tu.sec = ppsparams->assert_off_tu.tspec.tv_sec; | ||
__ppsparams.assert_off_tu.nsec = ppsparams->assert_off_tu.tspec.tv_nsec; | ||
__ppsparams.clear_off_tu.sec = ppsparams->clear_off_tu.tspec.tv_sec; | ||
__ppsparams.clear_off_tu.nsec = ppsparams->clear_off_tu.tspec.tv_nsec; | ||
|
||
return ioctl(handle, PPS_SETPARAMS, &__ppsparams); | ||
} | ||
|
||
/* Get capabilities for handle */ | ||
static __inline int time_pps_getcap(pps_handle_t handle, int *mode) | ||
{ | ||
return ioctl(handle, PPS_GETCAP, mode); | ||
} | ||
|
||
static __inline int time_pps_fetch(pps_handle_t handle, const int tsformat, | ||
pps_info_t *ppsinfobuf, | ||
const struct timespec *timeout) | ||
{ | ||
struct pps_fdata __fdata; | ||
int ret; | ||
|
||
/* Sanity checks */ | ||
if (tsformat != PPS_TSFMT_TSPEC) { | ||
errno = EINVAL; | ||
return -1; | ||
} | ||
|
||
if (timeout) { | ||
__fdata.timeout.sec = timeout->tv_sec; | ||
__fdata.timeout.nsec = timeout->tv_nsec; | ||
__fdata.timeout.flags = ~PPS_TIME_INVALID; | ||
} else | ||
__fdata.timeout.flags = PPS_TIME_INVALID; | ||
|
||
ret = ioctl(handle, PPS_FETCH, &__fdata); | ||
|
||
ppsinfobuf->assert_sequence = __fdata.info.assert_sequence; | ||
ppsinfobuf->clear_sequence = __fdata.info.clear_sequence; | ||
ppsinfobuf->assert_tu.tspec.tv_sec = __fdata.info.assert_tu.sec; | ||
ppsinfobuf->assert_tu.tspec.tv_nsec = __fdata.info.assert_tu.nsec; | ||
ppsinfobuf->clear_tu.tspec.tv_sec = __fdata.info.clear_tu.sec; | ||
ppsinfobuf->clear_tu.tspec.tv_nsec = __fdata.info.clear_tu.nsec; | ||
ppsinfobuf->current_mode = __fdata.info.current_mode; | ||
|
||
return ret; | ||
} | ||
|
||
static __inline int time_pps_kcbind(pps_handle_t handle, | ||
const int kernel_consumer, | ||
const int edge, const int tsformat) | ||
{ | ||
/* LinuxPPS doesn't implement kernel consumer feature */ | ||
errno = EOPNOTSUPP; | ||
return -1; | ||
} | ||
|
||
#endif /* _SYS_TIMEPPS_H_ */ |