481 lines
12 KiB
Diff
481 lines
12 KiB
Diff
|
diff --git a/Makefile b/Makefile
|
||
|
new file mode 100644
|
||
|
index 0000000..a2660a2
|
||
|
--- /dev/null
|
||
|
+++ b/Makefile
|
||
|
@@ -0,0 +1,27 @@
|
||
|
+TARGETS = ppstest ppsctl
|
||
|
+
|
||
|
+CFLAGS += -Wall -O2 -D_GNU_SOURCE
|
||
|
+CFLAGS += -I .
|
||
|
+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}
|
||
|
diff --git a/ppsctl.c b/ppsctl.c
|
||
|
new file mode 100644
|
||
|
index 0000000..83fd08a
|
||
|
--- /dev/null
|
||
|
+++ b/ppsctl.c
|
||
|
@@ -0,0 +1,62 @@
|
||
|
+#include <stdio.h>
|
||
|
+#include <unistd.h>
|
||
|
+#include <stdlib.h>
|
||
|
+#include <errno.h>
|
||
|
+#include <sys/ioctl.h>
|
||
|
+#include <sys/types.h>
|
||
|
+#include <sys/stat.h>
|
||
|
+#include <fcntl.h>
|
||
|
+#include <string.h>
|
||
|
+#include <linux/serial.h>
|
||
|
+
|
||
|
+void usage(char *name)
|
||
|
+{
|
||
|
+ fprintf(stderr, "usage: %s <ttyS> [enable|disable]\n", name);
|
||
|
+
|
||
|
+ exit(EXIT_FAILURE);
|
||
|
+}
|
||
|
+
|
||
|
+int main(int argc, char *argv[])
|
||
|
+{
|
||
|
+ int fd;
|
||
|
+ int ret;
|
||
|
+ struct serial_struct ss;
|
||
|
+
|
||
|
+ if (argc < 2)
|
||
|
+ usage(argv[0]);
|
||
|
+
|
||
|
+ fd = open(argv[1], O_RDWR);
|
||
|
+ if (fd < 0) {
|
||
|
+ perror("open");
|
||
|
+ exit(EXIT_FAILURE);
|
||
|
+ }
|
||
|
+
|
||
|
+ ret = ioctl(fd, TIOCGSERIAL, &ss);
|
||
|
+ if (ret < 0) {
|
||
|
+ perror("ioctl(TIOCGSERIAL)");
|
||
|
+ exit(EXIT_FAILURE);
|
||
|
+ }
|
||
|
+
|
||
|
+ if (argc < 3) { /* just read PPS status */
|
||
|
+ printf("PPS is %sabled\n",
|
||
|
+ ss.flags & ASYNC_HARDPPS_CD ? "en" : "dis");
|
||
|
+ exit(EXIT_SUCCESS);
|
||
|
+ }
|
||
|
+
|
||
|
+ if (argv[2][0] == 'e' || argv[2][0] == '1')
|
||
|
+ ss.flags |= ASYNC_HARDPPS_CD;
|
||
|
+ else if (argv[2][0] == 'd' || argv[2][0] == '0')
|
||
|
+ ss.flags &= ~ASYNC_HARDPPS_CD;
|
||
|
+ else {
|
||
|
+ fprintf(stderr, "invalid state argument \"%s\"\n", argv[2]);
|
||
|
+ exit(EXIT_FAILURE);
|
||
|
+ }
|
||
|
+
|
||
|
+ ret = ioctl(fd, TIOCSSERIAL, &ss);
|
||
|
+ if (ret < 0) {
|
||
|
+ perror("ioctl(TIOCSSERIAL)");
|
||
|
+ exit(EXIT_FAILURE);
|
||
|
+ }
|
||
|
+
|
||
|
+ return 0;
|
||
|
+}
|
||
|
diff --git a/ppsfind b/ppsfind
|
||
|
new file mode 100755
|
||
|
index 0000000..93c0e17
|
||
|
--- /dev/null
|
||
|
+++ b/ppsfind
|
||
|
@@ -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
|
||
|
diff --git a/ppstest.c b/ppstest.c
|
||
|
new file mode 100644
|
||
|
index 0000000..d125ffa
|
||
|
--- /dev/null
|
||
|
+++ b/ppstest.c
|
||
|
@@ -0,0 +1,151 @@
|
||
|
+#include <stdio.h>
|
||
|
+#include <stdlib.h>
|
||
|
+#include <unistd.h>
|
||
|
+#include <errno.h>
|
||
|
+#include <string.h>
|
||
|
+#include <sys/types.h>
|
||
|
+#include <sys/stat.h>
|
||
|
+#include <fcntl.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;
|
||
|
+ 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;
|
||
|
+}
|
||
|
diff --git a/timepps.h b/timepps.h
|
||
|
new file mode 100644
|
||
|
index 0000000..28ebf4c
|
||
|
--- /dev/null
|
||
|
+++ b/timepps.h
|
||
|
@@ -0,0 +1,193 @@
|
||
|
+/*
|
||
|
+ * 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 <sys/syscall.h>
|
||
|
+#include <unistd.h>
|
||
|
+#include <errno.h>
|
||
|
+#include <linux/pps.h>
|
||
|
+
|
||
|
+/*
|
||
|
+ * 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;
|
||
|
+
|
||
|
+ if (!handle) {
|
||
|
+ errno = EINVAL;
|
||
|
+ return -1;
|
||
|
+ }
|
||
|
+
|
||
|
+ /* First we check if current device is a PPS valid PPS one...
|
||
|
+ */
|
||
|
+ ret = ioctl(source, PPS_CHECK);
|
||
|
+ 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_ */
|