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 #include <linux/ioctl.h>
32 #include <linux/ptp_clock.h>
33
34 #include "xlat/ptp_flags_options.h"
35
36 int
ptp_ioctl(struct tcb * const tcp,const unsigned int code,const kernel_ulong_t arg)37 ptp_ioctl(struct tcb *const tcp, const unsigned int code,
38 const kernel_ulong_t arg)
39 {
40 if (!verbose(tcp))
41 return RVAL_DECODED;
42
43 switch (code) {
44 case PTP_EXTTS_REQUEST: {
45 struct ptp_extts_request extts;
46
47 tprints(", ");
48 if (umove_or_printaddr(tcp, arg, &extts))
49 break;
50
51 tprintf("{index=%d, flags=", extts.index);
52 printflags(ptp_flags_options, extts.flags, "PTP_???");
53 tprints("}");
54 break;
55 }
56
57 case PTP_PEROUT_REQUEST: {
58 struct ptp_perout_request perout;
59
60 tprints(", ");
61 if (umove_or_printaddr(tcp, arg, &perout))
62 break;
63
64 tprintf("{start={%" PRId64 ", %" PRIu32 "}"
65 ", period={%" PRId64 ", %" PRIu32 "}"
66 ", index=%d, flags=",
67 (int64_t)perout.start.sec, perout.start.nsec,
68 (int64_t)perout.period.sec, perout.period.nsec,
69 perout.index);
70 printflags(ptp_flags_options, perout.flags, "PTP_???");
71 tprints("}");
72 break;
73 }
74
75 case PTP_ENABLE_PPS:
76 tprintf(", %" PRI_kld, arg);
77 break;
78
79 case PTP_SYS_OFFSET: {
80 struct ptp_sys_offset sysoff;
81
82 if (entering(tcp)) {
83 tprints(", ");
84 if (umove_or_printaddr(tcp, arg, &sysoff))
85 break;
86
87 tprintf("{n_samples=%u", sysoff.n_samples);
88 return 1;
89 } else {
90 unsigned int n_samples, i;
91
92 if (syserror(tcp)) {
93 tprints("}");
94 break;
95 }
96
97 tprints(", ");
98 if (umove(tcp, arg, &sysoff) < 0) {
99 tprints("???}");
100 break;
101 }
102
103 tprints("ts=[");
104 n_samples = sysoff.n_samples > PTP_MAX_SAMPLES ?
105 PTP_MAX_SAMPLES : sysoff.n_samples;
106 for (i = 0; i < 2 * n_samples + 1; ++i) {
107 if (i > 0)
108 tprints(", ");
109 tprintf("{%" PRId64 ", %" PRIu32 "}",
110 (int64_t)sysoff.ts[i].sec,
111 sysoff.ts[i].nsec);
112 }
113 if (sysoff.n_samples > PTP_MAX_SAMPLES)
114 tprints(", ...");
115 tprints("]}");
116 break;
117 }
118 }
119 case PTP_CLOCK_GETCAPS: {
120 struct ptp_clock_caps caps;
121
122 if (entering(tcp))
123 return 0;
124
125 tprints(", ");
126 if (umove_or_printaddr(tcp, arg, &caps))
127 break;
128
129 tprintf("{max_adj=%d, n_alarm=%d, n_ext_ts=%d, n_per_out=%d, pps=%d}",
130 caps.max_adj, caps.n_alarm, caps.n_ext_ts,
131 caps.n_per_out, caps.pps);
132 break;
133 }
134
135 default:
136 return RVAL_DECODED;
137 }
138
139 return RVAL_DECODED | 1;
140 }
141