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