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-2018 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 "print_fields.h"
38 # include "xlat/ptp_flags_options.h"
39
40 int
ptp_ioctl(struct tcb * const tcp,const unsigned int code,const kernel_ulong_t arg)41 ptp_ioctl(struct tcb *const tcp, const unsigned int code,
42 const kernel_ulong_t arg)
43 {
44 if (!verbose(tcp))
45 return RVAL_DECODED;
46
47 switch (code) {
48 case PTP_EXTTS_REQUEST: {
49 struct ptp_extts_request extts;
50
51 tprints(", ");
52 if (umove_or_printaddr(tcp, arg, &extts))
53 break;
54
55 PRINT_FIELD_D("{", extts, index);
56 PRINT_FIELD_FLAGS(", ", extts, flags, ptp_flags_options, "PTP_???");
57 tprints("}");
58 break;
59 }
60
61 case PTP_PEROUT_REQUEST: {
62 struct ptp_perout_request perout;
63
64 tprints(", ");
65 if (umove_or_printaddr(tcp, arg, &perout))
66 break;
67
68 PRINT_FIELD_D("{start={", perout.start, sec);
69 PRINT_FIELD_U(", ", perout.start, nsec);
70 PRINT_FIELD_D("}, period={", perout.period, sec);
71 PRINT_FIELD_U(", ", perout.period, nsec);
72 PRINT_FIELD_D("}, ", perout, index);
73 PRINT_FIELD_FLAGS(", ", perout, flags, ptp_flags_options, "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 PRINT_FIELD_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 PRINT_FIELD_D("{", sysoff.ts[i], sec);
113 PRINT_FIELD_U(", ", sysoff.ts[i], nsec);
114 tprints("}");
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 PRINT_FIELD_D("{", caps, max_adj);
133 PRINT_FIELD_D(", ", caps, n_alarm);
134 PRINT_FIELD_D(", ", caps, n_ext_ts);
135 PRINT_FIELD_D(", ", caps, n_per_out);
136 PRINT_FIELD_D(", ", caps, pps);
137 tprints("}");
138 break;
139 }
140
141 default:
142 return RVAL_DECODED;
143 }
144
145 return RVAL_IOCTL_DECODED;
146 }
147
148 #endif /* HAVE_STRUCT_PTP_SYS_OFFSET */
149