[PATCH] Decode ptp ioctls
Stefan Sørensen
stefan.sorensen at spectralink.com
Fri Jan 31 11:01:01 UTC 2014
* defs.h (ptp_ioctl): New prototype.
* ioctl.c (ioctl_decode): Call ptp_ioctl when code is '='.
* Makefile.am (strace_SOURCES): Add ptp.c.
(EXTRA_DIST): Add linux/ptp_clock.h.
* ptp.c: New file.
* linux/ptp_clock.h: New file.
Signed-off-by: Stefan Sørensen <stefan.sorensen at spectralink.com>
---
Makefile.am | 2 ++
defs.h | 1 +
ioctl.c | 2 ++
linux/ptp_clock.h | 98 +++++++++++++++++++++++++++++++++++++++++++++++++++++++
ptp.c | 81 +++++++++++++++++++++++++++++++++++++++++++++
5 files changed, 184 insertions(+)
create mode 100644 linux/ptp_clock.h
create mode 100644 ptp.c
diff --git a/Makefile.am b/Makefile.am
index c98d8b9..90f333d 100644
--- a/Makefile.am
+++ b/Makefile.am
@@ -30,6 +30,7 @@ strace_SOURCES = \
net.c \
pathtrace.c \
process.c \
+ ptp.c \
quota.c \
resource.c \
scsi.c \
@@ -130,6 +131,7 @@ EXTRA_DIST = \
linux/powerpc/signalent1.h \
linux/powerpc/syscallent.h \
linux/powerpc/syscallent1.h \
+ linux/ptp_clock.h \
linux/s390/ioctlent.h.in \
linux/s390/syscallent.h \
linux/s390x/ioctlent.h.in \
diff --git a/defs.h b/defs.h
index 95d2571..330441f 100644
--- a/defs.h
+++ b/defs.h
@@ -703,6 +703,7 @@ extern int block_ioctl(struct tcb *, long, long);
extern int mtd_ioctl(struct tcb *, long, long);
extern int ubi_ioctl(struct tcb *, long, long);
extern int loop_ioctl(struct tcb *, long, long);
+extern int ptp_ioctl(struct tcb *, long, long);
extern int tv_nz(struct timeval *);
extern int tv_cmp(struct timeval *, struct timeval *);
diff --git a/ioctl.c b/ioctl.c
index 2280439..e9a503d 100644
--- a/ioctl.c
+++ b/ioctl.c
@@ -95,6 +95,8 @@ ioctl_decode(struct tcb *tcp, long code, long arg)
case 'o':
case 'O':
return ubi_ioctl(tcp, code, arg);
+ case '=':
+ return ptp_ioctl(tcp, code, arg);
default:
break;
}
diff --git a/linux/ptp_clock.h b/linux/ptp_clock.h
new file mode 100644
index 0000000..b65c834
--- /dev/null
+++ b/linux/ptp_clock.h
@@ -0,0 +1,98 @@
+/*
+ * PTP 1588 clock support - user space interface
+ *
+ * Copyright (C) 2010 OMICRON electronics GmbH
+ *
+ * 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 _PTP_CLOCK_H_
+#define _PTP_CLOCK_H_
+
+#include <linux/ioctl.h>
+#include <linux/types.h>
+
+/* PTP_xxx bits, for the flags field within the request structures. */
+#define PTP_ENABLE_FEATURE (1<<0)
+#define PTP_RISING_EDGE (1<<1)
+#define PTP_FALLING_EDGE (1<<2)
+
+/*
+ * struct ptp_clock_time - represents a time value
+ *
+ * The sign of the seconds field applies to the whole value. The
+ * nanoseconds field is always unsigned. The reserved field is
+ * included for sub-nanosecond resolution, should the demand for
+ * this ever appear.
+ *
+ */
+struct ptp_clock_time {
+ __s64 sec; /* seconds */
+ __u32 nsec; /* nanoseconds */
+ __u32 reserved;
+};
+
+struct ptp_clock_caps {
+ int max_adj; /* Maximum frequency adjustment in parts per billon. */
+ int n_alarm; /* Number of programmable alarms. */
+ int n_ext_ts; /* Number of external time stamp channels. */
+ int n_per_out; /* Number of programmable periodic signals. */
+ int pps; /* Whether the clock supports a PPS callback. */
+ int rsv[15]; /* Reserved for future use. */
+};
+
+struct ptp_extts_request {
+ unsigned int index; /* Which channel to configure. */
+ unsigned int flags; /* Bit field for PTP_xxx flags. */
+ unsigned int rsv[2]; /* Reserved for future use. */
+};
+
+struct ptp_perout_request {
+ struct ptp_clock_time start; /* Absolute start time. */
+ struct ptp_clock_time period; /* Desired period, zero means disable. */
+ unsigned int index; /* Which channel to configure. */
+ unsigned int flags; /* Reserved for future use. */
+ unsigned int rsv[4]; /* Reserved for future use. */
+};
+
+#define PTP_MAX_SAMPLES 25 /* Maximum allowed offset measurement samples. */
+
+struct ptp_sys_offset {
+ unsigned int n_samples; /* Desired number of measurements. */
+ unsigned int rsv[3]; /* Reserved for future use. */
+ /*
+ * Array of interleaved system/phc time stamps. The kernel
+ * will provide 2*n_samples + 1 time stamps, with the last
+ * one as a system time stamp.
+ */
+ struct ptp_clock_time ts[2 * PTP_MAX_SAMPLES + 1];
+};
+
+#define PTP_CLK_MAGIC '='
+
+#define PTP_CLOCK_GETCAPS _IOR(PTP_CLK_MAGIC, 1, struct ptp_clock_caps)
+#define PTP_EXTTS_REQUEST _IOW(PTP_CLK_MAGIC, 2, struct ptp_extts_request)
+#define PTP_PEROUT_REQUEST _IOW(PTP_CLK_MAGIC, 3, struct ptp_perout_request)
+#define PTP_ENABLE_PPS _IOW(PTP_CLK_MAGIC, 4, int)
+#define PTP_SYS_OFFSET _IOW(PTP_CLK_MAGIC, 5, struct ptp_sys_offset)
+
+struct ptp_extts_event {
+ struct ptp_clock_time t; /* Time event occured. */
+ unsigned int index; /* Which channel produced the event. */
+ unsigned int flags; /* Reserved for future use. */
+ unsigned int rsv[2]; /* Reserved for future use. */
+};
+
+#endif
diff --git a/ptp.c b/ptp.c
new file mode 100644
index 0000000..127e0a4
--- /dev/null
+++ b/ptp.c
@@ -0,0 +1,81 @@
+#include "defs.h"
+#include <sys/ioctl.h>
+#include <linux/ptp_clock.h>
+
+static const struct xlat ptp_flags_options[] = {
+ { PTP_ENABLE_FEATURE, "PTP_ENABLE_FEATURE" },
+ { PTP_RISING_EDGE, "PTP_RISING_EDGE" },
+ { PTP_FALLING_EDGE, "PTP_FALLING_EDGE" },
+ { 0, NULL },
+};
+
+
+int ptp_ioctl(struct tcb *tcp, long code, long arg)
+{
+ struct ptp_clock_caps caps;
+ struct ptp_extts_request extts;
+ struct ptp_perout_request perout;
+ struct ptp_sys_offset sysoffset;
+ int i;
+
+ if (entering(tcp))
+ return 0;
+
+ switch (code) {
+ case PTP_CLOCK_GETCAPS:
+ if (!verbose(tcp) || umove(tcp, arg, &caps) < 0)
+ return 0;
+
+ tprintf(", {max_adj=%d, n_alarm=%d, n_ext_ts=%d, n_per_out=%d, pps=%d}",
+ caps.max_adj, caps.n_alarm, caps.n_ext_ts, caps.n_per_out, caps.pps);
+ return 1;
+
+ case PTP_EXTTS_REQUEST:
+ if (!verbose(tcp) || umove(tcp, arg, &extts) < 0)
+ return 0;
+
+ tprintf(", {index=%d, flags=", extts.index);
+ printflags(ptp_flags_options, extts.flags, "PTP_???");
+ tprintf("}");
+ return 1;
+
+ case PTP_PEROUT_REQUEST:
+ if (!verbose(tcp) || umove(tcp, arg, &perout) < 0)
+ return 0;
+
+ tprintf(", {start={%" PRId64 ", %" PRIu32 "}",
+ (uint64_t)perout.start.sec, perout.start.nsec);
+ tprintf(", period={%" PRId64 ", %" PRIu32 "}",
+ (uint64_t)perout.period.sec, perout.period.nsec);
+ tprintf(", index=%d", perout.index);
+ tprints(", flags=");
+ printflags(ptp_flags_options, perout.flags, "PTP_???");
+ tprints("}");
+ return 1;
+
+ case PTP_ENABLE_PPS:
+ if (!verbose(tcp) || umove(tcp, arg, &i) < 0)
+ return 0;
+
+ tprintf(", [%d]", i);
+ return 1;
+
+ case PTP_SYS_OFFSET:
+ if (!verbose(tcp) || umove(tcp, arg, &sysoffset) < 0)
+ return 0;
+
+ tprintf(", {n_samples=%u, ts={", sysoffset.n_samples);
+ for (i = 0; i < 2*sysoffset.n_samples+1; i++) {
+ if (i)
+ tprintf(", ");
+ tprintf("{%" PRId64 ", %" PRIu32 "}",
+ (uint64_t)sysoffset.ts[i].sec, sysoffset.ts[i].nsec);
+ }
+ tprintf("}}");
+ return 1;
+
+
+ default:
+ return 0;
+ }
+}
--
1.8.5.3
More information about the Strace-devel
mailing list