1 /*
2 * Copyright (c) 2014 Stefan Sørensen <stefan.sorensen@spectralink.com>
3 * Copyright (c) 2014-2015 Dmitry V. Levin <ldv@altlinux.org>
4 * Copyright (c) 2014-2017 The strace developers.
5 * All rights reserved.
6 *
7 * Redistribution and use in source and binary forms, with or without
8 * modification, are permitted provided that the following conditions
9 * are met:
10 * 1. Redistributions of source code must retain the above copyright
11 * notice, this list of conditions and the following disclaimer.
12 * 2. Redistributions in binary form must reproduce the above copyright
13 * notice, this list of conditions and the following disclaimer in the
14 * documentation and/or other materials provided with the distribution.
15 * 3. The name of the author may not be used to endorse or promote products
16 * derived from this software without specific prior written permission.
17 *
18 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
19 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
20 * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
21 * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
22 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
23 * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
24 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
25 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
26 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
27 * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
28 */
29
30 #include "defs.h"
31
32 #ifdef HAVE_STRUCT_PTP_SYS_OFFSET
33
34 # include <linux/ioctl.h>
35 # include <linux/ptp_clock.h>
36
37 # include "xlat/ptp_flags_options.h"
38
39 int
ptp_ioctl(struct tcb * const tcp,const unsigned int code,const kernel_ulong_t arg)40 ptp_ioctl(struct tcb *const tcp, const unsigned int code,
41 const kernel_ulong_t arg)
42 {
43 if (!verbose(tcp))
44 return RVAL_DECODED;
45
46 switch (code) {
47 case PTP_EXTTS_REQUEST: {
48 struct ptp_extts_request extts;
49
50 tprints(", ");
51 if (umove_or_printaddr(tcp, arg, &extts))
52 break;
53
54 tprintf("{index=%d, flags=", extts.index);
55 printflags(ptp_flags_options, extts.flags, "PTP_???");
56 tprints("}");
57 break;
58 }
59
60 case PTP_PEROUT_REQUEST: {
61 struct ptp_perout_request perout;
62
63 tprints(", ");
64 if (umove_or_printaddr(tcp, arg, &perout))
65 break;
66
67 tprintf("{start={%" PRId64 ", %" PRIu32 "}"
68 ", period={%" PRId64 ", %" PRIu32 "}"
69 ", index=%d, flags=",
70 (int64_t)perout.start.sec, perout.start.nsec,
71 (int64_t)perout.period.sec, perout.period.nsec,
72 perout.index);
73 printflags(ptp_flags_options, perout.flags, "PTP_???");
74 tprints("}");
75 break;
76 }
77
78 case PTP_ENABLE_PPS:
79 tprintf(", %" PRI_kld, arg);
80 break;
81
82 case PTP_SYS_OFFSET: {
83 struct ptp_sys_offset sysoff;
84
85 if (entering(tcp)) {
86 tprints(", ");
87 if (umove_or_printaddr(tcp, arg, &sysoff))
88 break;
89
90 tprintf("{n_samples=%u", sysoff.n_samples);
91 return 0;
92 } else {
93 unsigned int n_samples, i;
94
95 if (syserror(tcp)) {
96 tprints("}");
97 break;
98 }
99
100 tprints(", ");
101 if (umove(tcp, arg, &sysoff) < 0) {
102 tprints("???}");
103 break;
104 }
105
106 tprints("ts=[");
107 n_samples = sysoff.n_samples > PTP_MAX_SAMPLES ?
108 PTP_MAX_SAMPLES : sysoff.n_samples;
109 for (i = 0; i < 2 * n_samples + 1; ++i) {
110 if (i > 0)
111 tprints(", ");
112 tprintf("{%" PRId64 ", %" PRIu32 "}",
113 (int64_t)sysoff.ts[i].sec,
114 sysoff.ts[i].nsec);
115 }
116 if (sysoff.n_samples > PTP_MAX_SAMPLES)
117 tprints(", ...");
118 tprints("]}");
119 break;
120 }
121 }
122 case PTP_CLOCK_GETCAPS: {
123 struct ptp_clock_caps caps;
124
125 if (entering(tcp))
126 return 0;
127
128 tprints(", ");
129 if (umove_or_printaddr(tcp, arg, &caps))
130 break;
131
132 tprintf("{max_adj=%d, n_alarm=%d, n_ext_ts=%d, n_per_out=%d, pps=%d}",
133 caps.max_adj, caps.n_alarm, caps.n_ext_ts,
134 caps.n_per_out, caps.pps);
135 break;
136 }
137
138 default:
139 return RVAL_DECODED;
140 }
141
142 return RVAL_IOCTL_DECODED;
143 }
144
145 #endif /* HAVE_STRUCT_PTP_SYS_OFFSET */
146