]> The Tcpdump Group git mirrors - tcpdump/blob - print-ptp.c
projects / tcpdump / blob
summary | shortlog | log | commit | commitdiff | tree
history | raw | HEAD
PTP: Print the protocol name before any check
[tcpdump] / print-ptp.c
1 /*
2 * Redistribution and use in source and binary forms, with or without
3 * modification, are permitted provided that: (1) source code
4 * distributions retain the above copyright notice and this paragraph
5 * in its entirety, and (2) distributions including binary code include
6 * the above copyright notice and this paragraph in its entirety in
7 * the documentation or other materials provided with the distribution.
8 * THIS SOFTWARE IS PROVIDED ``AS IS'' AND
9 * WITHOUT ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, WITHOUT
10 * LIMITATION, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS
11 * FOR A PARTICULAR PURPOSE.
12 *
13 * Original code by Partha S. Ghosh (psglinux dot gmail dot com)
14 */
15
16 /* \summary: Precision Time Protocol (PTP) printer */
17
18 /* specification: https://standards.ieee.org/findstds/standard/1588-2008.html*/
19
20 #ifdef HAVE_CONFIG_H
21 #include <config.h>
22 #endif
23
24 #include "netdissect-stdinc.h"
25 #include "netdissect.h"
26 #include "extract.h"
27
28 /*
29 * PTP header
30 * 0 1 2 3
31 * 0 1 2 3 4 5 6 7 8 9 0 1 2 3 4 5 6 7 8 9 0 1 2 3 4 5 6 7 8 9 0 1
32 * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
33 * | R | |msgtype| version | Msg Len |
34 * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
35 * | domain No | rsvd1 | flag Field |
36 * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
37 * | Correction NS |
38 * + +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
39 * | | Correction Sub NS |
40 * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
41 * | Reserved2 |
42 * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
43 * | Clock Identity |
44 * | |
45 * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
46 * | Port Identity | Sequence ID |
47 * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
48 * | control | log msg int |
49 * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
50 * 0 1 2 3 4 5 6 7 8 9 0 1 2 3 4 5 6 7 8 9 0 1 2 3 4 5 6 7 8 9 0 1
51 * 0 1 2 3
52 *
53 * Announce Message (msg type=0xB)
54 * 0 1 2 3
55 * 0 1 2 3 4 5 6 7 8 9 0 1 2 3 4 5 6 7 8 9 0 1 2 3 4 5 6 7 8 9 0 1
56 * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
57 * | |
58 * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+ +
59 * | Seconds |
60 * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
61 * | Nano Seconds |
62 * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
63 * | Origin Cur UTC Offset | Reserved | GM Prio 1 |
64 * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
65 * |GM Clock Class | GM Clock Accu | GM Clock Variance |
66 * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
67 * | GM Prio 2 | |
68 * +-+-+-+-+-+-+-+-+ +
69 * | GM Clock Identity |
70 * + +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
71 * | | Steps Removed | Time Source |
72 * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
73 * 0 1 2 3 4 5 6 7 8 9 0 1 2 3 4 5 6 7 8 9 0 1 2 3 4 5 6 7 8 9 0 1
74 * 0 1 2 3
75 *
76 * Sync Message (msg type=0x0)
77 * 0 1 2 3
78 * 0 1 2 3 4 5 6 7 8 9 0 1 2 3 4 5 6 7 8 9 0 1 2 3 4 5 6 7 8 9 0 1
79 * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
80 * | |
81 * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+ +
82 * | Seconds |
83 * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
84 * | Nano Seconds |
85 * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
86 *
87 * Delay Request Message (msg type=0x1)
88 * 0 1 2 3
89 * 0 1 2 3 4 5 6 7 8 9 0 1 2 3 4 5 6 7 8 9 0 1 2 3 4 5 6 7 8 9 0 1
90 * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
91 * | |
92 * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+ +
93 * | Origin Time Stamp Seconds |
94 * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
95 * | Nano Seconds |
96 * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
97 *
98 * Followup Message (msg type=0x8)
99 * 0 1 2 3
100 * 0 1 2 3 4 5 6 7 8 9 0 1 2 3 4 5 6 7 8 9 0 1 2 3 4 5 6 7 8 9 0 1
101 * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
102 * | |
103 * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+ +
104 * | Precise Origin Time Stamp Seconds |
105 * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
106 * | Nano Seconds |
107 * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
108 *
109 * Delay Resp Message (msg type=0x9)
110 * 0 1 2 3
111 * 0 1 2 3 4 5 6 7 8 9 0 1 2 3 4 5 6 7 8 9 0 1 2 3 4 5 6 7 8 9 0 1
112 * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
113 * | |
114 * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+ +
115 * | Seconds |
116 * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
117 * | Nano Seconds |
118 * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
119 * | Port Identity |
120 * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
121 *
122 * PDelay Request Message (msg type=0x2)
123 * 0 1 2 3
124 * 0 1 2 3 4 5 6 7 8 9 0 1 2 3 4 5 6 7 8 9 0 1 2 3 4 5 6 7 8 9 0 1
125 * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
126 * | |
127 * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+ +
128 * | Origin Time Stamp Seconds |
129 * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
130 * | Origin Time Stamp Nano Seconds |
131 * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
132 * | Port Identity |
133 * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
134 *
135 * PDelay Response Message (msg type=0x3)
136 * 0 1 2 3
137 * 0 1 2 3 4 5 6 7 8 9 0 1 2 3 4 5 6 7 8 9 0 1 2 3 4 5 6 7 8 9 0 1
138 * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
139 * | |
140 * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+ +
141 * | Request receipt Time Stamp Seconds |
142 * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
143 * | Nano Seconds |
144 * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
145 * | Requesting Port Identity |
146 * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
147 *
148 * PDelay Resp Follow up Message (msg type=0xA)
149 * 0 1 2 3
150 * 0 1 2 3 4 5 6 7 8 9 0 1 2 3 4 5 6 7 8 9 0 1 2 3 4 5 6 7 8 9 0 1
151 * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
152 * | |
153 * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+ +
154 * | Response Origin Time Stamp Seconds |
155 * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
156 * | Nano Seconds |
157 * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
158 * | Requesting Port Identity |
159 * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
160 *
161 * Signaling Message (msg type=0xC)
162 * 0 1 2 3
163 * 0 1 2 3 4 5 6 7 8 9 0 1 2 3 4 5 6 7 8 9 0 1 2 3 4 5 6 7 8 9 0 1
164 * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
165 * | Requesting Port Identity |
166 * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
167 *
168 * Management Message (msg type=0xD)
169 * 0 1 2 3
170 * 0 1 2 3 4 5 6 7 8 9 0 1 2 3 4 5 6 7 8 9 0 1 2 3 4 5 6 7 8 9 0 1
171 * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
172 * | Requesting Port Identity |
173 * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
174 * |Start Bndry Hps| Boundary Hops | flags | Reserved |
175 * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
176 *
177 */
178
179 /* Values from IEEE1588-2008: 13.3.2.2 messageType (Enumeration4) */
180 #define M_SYNC 0x0
181 #define M_DELAY_REQ 0x1
182 #define M_PDELAY_REQ 0x2
183 #define M_PDELAY_RESP 0x3
184 #define M_FOLLOW_UP 0x8
185 #define M_DELAY_RESP 0x9
186 #define M_PDELAY_RESP_FOLLOW_UP 0xA
187 #define M_ANNOUNCE 0xB
188 #define M_SIGNALING 0xC
189 #define M_MANAGEMENT 0xD
190
191 static const struct tok ptp_msg_type[] = {
192 { M_SYNC, "sync msg"},
193 { M_DELAY_REQ, "delay req msg"},
194 { M_PDELAY_REQ, "peer delay req msg"},
195 { M_PDELAY_RESP, "peer delay resp msg"},
196 { M_FOLLOW_UP, "follow up msg"},
197 { M_DELAY_RESP, "delay resp msg"},
198 { M_PDELAY_RESP_FOLLOW_UP, "pdelay resp fup msg"},
199 { M_ANNOUNCE, "announce msg"},
200 { M_SIGNALING, "signaling msg"},
201 { M_MANAGEMENT, "management msg"},
202 { 0, NULL}
203 };
204
205 /* Values from IEEE1588-2008: 13.3.2.10 controlField (UInteger8) */
206 /*
207 * The use of this field by the receiver is deprecated.
208 * NOTE-This field is provided for compatibility with hardware designed
209 * to conform to version 1 of this standard.
210 */
211 #define C_SYNC 0x0
212 #define C_DELAY_REQ 0x1
213 #define C_FOLLOW_UP 0x2
214 #define C_DELAY_RESP 0x3
215 #define C_MANAGEMENT 0x4
216 #define C_OTHER 0x5
217
218 static const struct tok ptp_control_field[] = {
219 { C_SYNC, "Sync"},
220 { C_DELAY_REQ, "Delay_Req"},
221 { C_FOLLOW_UP, "Follow_Up"},
222 { C_DELAY_RESP, "Delay_Resp"},
223 { C_MANAGEMENT, "Management"},
224 { C_OTHER, "Other"},
225 { 0, NULL}
226 };
227
228 #define PTP_TRUE 1
229 #define PTP_FALSE !PTP_TRUE
230
231 #define PTP_HDR_LEN 0x22
232
233 /* mask based on the first byte */
234 #define PTP_MAJOR_VERS_MASK 0x0F
235 #define PTP_MINOR_VERS_MASK 0xF0
236 #define PTP_MAJOR_SDO_ID_MASK 0xF0
237 #define PTP_MSG_TYPE_MASK 0x0F
238
239 /*mask based 2byte */
240 #define PTP_DOMAIN_MASK 0xFF00
241 #define PTP_RSVD1_MASK 0xFF
242 #define PTP_CONTROL_MASK 0xFF
243 #define PTP_LOGMSG_MASK 0xFF
244
245 /* mask based on the flags 2 bytes */
246
247 #define PTP_L161_MASK 0x1
248 #define PTP_L1_59_MASK 0x2
249 #define PTP_UTC_REASONABLE_MASK 0x4
250 #define PTP_TIMESCALE_MASK 0x8
251 #define PTP_TIME_TRACABLE_MASK 0x10
252 #define PTP_FREQUENCY_TRACABLE_MASK 0x20
253 #define PTP_ALTERNATE_MASTER_MASK 0x100
254 #define PTP_TWO_STEP_MASK 0x200
255 #define PTP_UNICAST_MASK 0x400
256 #define PTP_PROFILE_SPEC_1_MASK 0x1000
257 #define PTP_PROFILE_SPEC_2_MASK 0x2000
258 #define PTP_SECURITY_MASK 0x4000
259 #define PTP_FLAGS_UNKNOWN_MASK 0x18C0
260
261 static const struct tok ptp_flag_values[] = {
262 { PTP_L161_MASK, "l1 61"},
263 { PTP_L1_59_MASK, "l1 59"},
264 { PTP_UTC_REASONABLE_MASK, "utc reasonable"},
265 { PTP_TIMESCALE_MASK, "timescale"},
266 { PTP_TIME_TRACABLE_MASK, "time tracable"},
267 { PTP_FREQUENCY_TRACABLE_MASK, "frequency tracable"},
268 { PTP_ALTERNATE_MASTER_MASK, "alternate master"},
269 { PTP_TWO_STEP_MASK, "two step"},
270 { PTP_UNICAST_MASK, "unicast"},
271 { PTP_PROFILE_SPEC_1_MASK, "profile specific 1"},
272 { PTP_PROFILE_SPEC_2_MASK, "profile specific 2"},
273 { PTP_SECURITY_MASK, "security mask"},
274 { PTP_FLAGS_UNKNOWN_MASK, "unknown"},
275 {0, NULL}
276 };
277
278 static const char *p_porigin_ts = "preciseOriginTimeStamp";
279 static const char *p_origin_ts = "originTimeStamp";
280 static const char *p_recv_ts = "receiveTimeStamp";
281
282 #define PTP_VER_1 0x1
283 #define PTP_VER_2 0x2
284
285 #define PTP_UCHAR_LEN sizeof(uint8_t)
286 #define PTP_UINT16_LEN sizeof(uint16_t)
287 #define PTP_UINT32_LEN sizeof(uint32_t)
288 #define PTP_6BYTES_LEN sizeof(uint32_t)+sizeof(uint16_t)
289 #define PTP_UINT64_LEN sizeof(uint64_t)
290
291 static void ptp_print_1(netdissect_options *ndo);
292 static void ptp_print_2(netdissect_options *ndo, const u_char *bp, u_int len);
293
294 static void ptp_print_timestamp(netdissect_options *ndo, const u_char *bp, u_int *len, const char *stype);
295 static void ptp_print_timestamp_identity(netdissect_options *ndo, const u_char *bp, u_int *len, const char *ttype);
296 static void ptp_print_announce_msg(netdissect_options *ndo, const u_char *bp, u_int *len);
297 static void ptp_print_port_id(netdissect_options *ndo, const u_char *bp, u_int *len);
298 static void ptp_print_mgmt_msg(netdissect_options *ndo, const u_char *bp, u_int *len);
299
300 static void
301 print_field(netdissect_options *ndo, const char *st, uint32_t flen,
302 const u_char *bp, u_int *len, uint8_t hex)
303 {
304 uint8_t u8_val;
305 uint16_t u16_val;
306 uint32_t u32_val;
307 uint64_t u64_val;
308
309 switch(flen) {
310 case PTP_UCHAR_LEN:
311 u8_val = GET_U_1(bp);
312 ND_PRINT(", %s", st);
313 if (hex)
314 ND_PRINT(" 0x%x", u8_val);
315 else
316 ND_PRINT(" %u", u8_val);
317 *len -= 1; bp += 1;
318 break;
319 case PTP_UINT16_LEN:
320 u16_val = GET_BE_U_2(bp);
321 ND_PRINT(", %s", st);
322 if (hex)
323 ND_PRINT(" 0x%x", u16_val);
324 else
325 ND_PRINT(" %u", u16_val);
326 *len -= 2; bp += 2;
327 break;
328 case PTP_UINT32_LEN:
329 u32_val = GET_BE_U_4(bp);
330 ND_PRINT(", %s", st);
331 if (hex)
332 ND_PRINT(" 0x%x", u32_val);
333 else
334 ND_PRINT(" %u", u32_val);
335 *len -= 4; bp += 4;
336 break;
337 case PTP_UINT64_LEN:
338 u64_val = GET_BE_U_8(bp);
339 ND_PRINT(", %s", st);
340 if (hex)
341 ND_PRINT(" 0x%"PRIx64, u64_val);
342 else
343 ND_PRINT(" 0x%"PRIu64, u64_val);
344 *len -= 8; bp += 8;
345 break;
346 default:
347 break;
348 }
349 }
350
351 static void
352 ptp_print_1(netdissect_options *ndo)
353 {
354 ND_PRINT(" (not implemented)");
355 }
356
357 static void
358 ptp_print_2(netdissect_options *ndo, const u_char *bp, u_int length)
359 {
360 u_int len = length;
361 uint16_t msg_len, flags, port_id, seq_id;
362 uint8_t foct, domain_no, msg_type, major_sdo_id, rsvd1, lm_int, control;
363 uint64_t ns_corr;
364 uint16_t sns_corr;
365 uint32_t rsvd2;
366 uint64_t clk_id;
367
368 foct = GET_U_1(bp);
369 major_sdo_id = (foct & PTP_MAJOR_SDO_ID_MASK) >> 4;
370 ND_PRINT(", majorSdoId : 0x%x", major_sdo_id);
371 msg_type = foct & PTP_MSG_TYPE_MASK;
372 ND_PRINT(", msg type : %s", tok2str(ptp_msg_type, "Reserved", msg_type));
373
374 /* msg length */
375 len -= 2; bp += 2; msg_len = GET_BE_U_2(bp); ND_PRINT(", length : %u", msg_len);
376
377 /* domain */
378 len -= 2; bp += 2; domain_no = (GET_BE_U_2(bp) & PTP_DOMAIN_MASK) >> 8; ND_PRINT(", domain : %u", domain_no);
379
380 /* rsvd 1*/
381 rsvd1 = GET_BE_U_2(bp) & PTP_RSVD1_MASK;
382 ND_PRINT(", reserved1 : %u", rsvd1);
383
384 /* flags */
385 len -= 2; bp += 2; flags = GET_BE_U_2(bp); ND_PRINT(", Flags [%s]", bittok2str(ptp_flag_values, "none", flags));
386
387 /* correction NS (48 bits) */
388 len -= 2; bp += 2; ns_corr = GET_BE_U_6(bp); ND_PRINT(", NS correction : %"PRIu64, ns_corr);
389
390 /* correction sub NS (16 bits) */
391 len -= 6; bp += 6; sns_corr = GET_BE_U_2(bp); ND_PRINT(", sub NS correction : %u", sns_corr);
392
393 /* Reserved 2 */
394 len -= 2; bp += 2; rsvd2 = GET_BE_U_4(bp); ND_PRINT(", reserved2 : %u", rsvd2);
395
396 /* clock identity */
397 len -= 4; bp += 4; clk_id = GET_BE_U_8(bp); ND_PRINT(", clock identity : 0x%"PRIx64, clk_id);
398
399 /* port identity */
400 len -= 8; bp += 8; port_id = GET_BE_U_2(bp); ND_PRINT(", port id : %u", port_id);
401
402 /* sequence ID */
403 len -= 2; bp += 2; seq_id = GET_BE_U_2(bp); ND_PRINT(", seq id : %u", seq_id);
404
405 /* control */
406 len -= 2; bp += 2; control = GET_U_1(bp) ;
407 ND_PRINT(", control : %u (%s)", control, tok2str(ptp_control_field, "Reserved", control));
408
409 /* log message interval */
410 lm_int = GET_BE_U_2(bp) & PTP_LOGMSG_MASK; ND_PRINT(", log message interval : %u", lm_int); len -= 2; bp += 2;
411
412 switch(msg_type) {
413 case M_SYNC:
414 ptp_print_timestamp(ndo, bp, &len, p_origin_ts);
415 break;
416 case M_DELAY_REQ:
417 ptp_print_timestamp(ndo, bp, &len, p_origin_ts);
418 break;
419 case M_PDELAY_REQ:
420 ptp_print_timestamp_identity(ndo, bp, &len, p_porigin_ts);
421 break;
422 case M_PDELAY_RESP:
423 ptp_print_timestamp_identity(ndo, bp, &len, p_recv_ts);
424 break;
425 case M_FOLLOW_UP:
426 ptp_print_timestamp(ndo, bp, &len, p_porigin_ts);
427 break;
428 case M_DELAY_RESP:
429 ptp_print_timestamp_identity(ndo, bp, &len, p_recv_ts);
430 break;
431 case M_PDELAY_RESP_FOLLOW_UP:
432 ptp_print_timestamp_identity(ndo, bp, &len, p_porigin_ts);
433 break;
434 case M_ANNOUNCE:
435 ptp_print_announce_msg(ndo, bp, &len);
436 break;
437 case M_SIGNALING:
438 ptp_print_port_id(ndo, bp, &len);
439 break;
440 case M_MANAGEMENT:
441 ptp_print_mgmt_msg(ndo, bp, &len);
442 break;
443 default:
444 break;
445 }
446 }
447 /*
448 * PTP general message
449 */
450 void
451 ptp_print(netdissect_options *ndo, const u_char *bp, u_int length)
452 {
453 u_int major_vers;
454 u_int minor_vers;
455
456 /* In 1588-2019, a minorVersionPTP field has been created in the common PTP
457 * message header, from a previously reserved field. Implementations
458 * compatible to the 2019 edition shall indicate a versionPTP field value
459 * of 2 and minorVersionPTP field value of 1, indicating that this is PTP
460 * version 2.1.
461 */
462 ndo->ndo_protocol = "ptp";
463 nd_print_protocol_caps(ndo);
464 ND_ICHECK_U(length, <, PTP_HDR_LEN);
465 major_vers = GET_BE_U_2(bp) & PTP_MAJOR_VERS_MASK;
466 minor_vers = (GET_BE_U_2(bp) & PTP_MINOR_VERS_MASK) >> 4;
467 if (minor_vers)
468 ND_PRINT("v%u.%u", major_vers, minor_vers);
469 else
470 ND_PRINT("v%u", major_vers);
471
472 switch(major_vers) {
473 case PTP_VER_1:
474 ptp_print_1(ndo);
475 break;
476 case PTP_VER_2:
477 ptp_print_2(ndo, bp, length);
478 break;
479 default:
480 ND_PRINT(" (unsupported)");
481 break;
482 }
483 return;
484
485 invalid:
486 nd_print_invalid(ndo);
487 }
488
489 static void
490 ptp_print_timestamp(netdissect_options *ndo, const u_char *bp, u_int *len, const char *stype)
491 {
492 uint64_t secs;
493 uint32_t nsecs;
494
495 ND_PRINT(", %s :", stype);
496 /* sec time stamp 6 bytes */
497 secs = GET_BE_U_6(bp);
498 ND_PRINT(" %"PRIu64" seconds,", secs);
499 *len -= 6;
500 bp += 6;
501
502 /* NS time stamp 4 bytes */
503 nsecs = GET_BE_U_4(bp);
504 ND_PRINT(" %u nanoseconds", nsecs);
505 *len -= 4;
506 bp += 4;
507 }
508 static void
509 ptp_print_timestamp_identity(netdissect_options *ndo,
510 const u_char *bp, u_int *len, const char *ttype)
511 {
512 uint64_t secs;
513 uint32_t nsecs;
514 uint16_t port_id;
515 uint64_t port_identity;
516
517 ND_PRINT(", %s :", ttype);
518 /* sec time stamp 6 bytes */
519 secs = GET_BE_U_6(bp);
520 ND_PRINT(" %"PRIu64" seconds,", secs);
521 *len -= 6;
522 bp += 6;
523
524 /* NS time stamp 4 bytes */
525 nsecs = GET_BE_U_4(bp);
526 ND_PRINT(" %u nanoseconds", nsecs);
527 *len -= 4;
528 bp += 4;
529
530 /* port identity*/
531 port_identity = GET_BE_U_8(bp);
532 ND_PRINT(", port identity : 0x%"PRIx64, port_identity);
533 *len -= 8;
534 bp += 8;
535
536 /* port id */
537 port_id = GET_BE_U_2(bp);
538 ND_PRINT(", port id : %u", port_id);
539 *len -= 2;
540 bp += 2;
541 }
542 static void
543 ptp_print_announce_msg(netdissect_options *ndo, const u_char *bp, u_int *len)
544 {
545 uint8_t rsvd, gm_prio_1, gm_prio_2, gm_clk_cls, gm_clk_acc, time_src;
546 uint16_t origin_cur_utc, gm_clk_var, steps_removed;
547 uint64_t gm_clock_id;
548 uint64_t secs;
549 uint32_t nsecs;
550
551 ND_PRINT(", %s :", p_origin_ts);
552 /* sec time stamp 6 bytes */
553 secs = GET_BE_U_6(bp);
554 ND_PRINT(" %"PRIu64" seconds", secs);
555 *len -= 6;
556 bp += 6;
557
558 /* NS time stamp 4 bytes */
559 nsecs = GET_BE_U_4(bp);
560 ND_PRINT(" %u nanoseconds", nsecs);
561 *len -= 4;
562 bp += 4;
563
564 /* origin cur utc */
565 origin_cur_utc = GET_BE_U_2(bp);
566 ND_PRINT(", origin cur utc :%u", origin_cur_utc);
567 *len -= 2;
568 bp += 2;
569
570 /* rsvd */
571 rsvd = GET_U_1(bp);
572 ND_PRINT(", rsvd : %u", rsvd);
573 *len -= 1;
574 bp += 1;
575
576 /* gm prio */
577 gm_prio_1 = GET_U_1(bp);
578 ND_PRINT(", gm priority_1 : %u", gm_prio_1);
579 *len -= 1;
580 bp += 1;
581
582 /* GM clock class */
583 gm_clk_cls = GET_U_1(bp);
584 ND_PRINT(", gm clock class : %u", gm_clk_cls);
585 *len -= 1;
586 bp += 1;
587 /* GM clock accuracy */
588 gm_clk_acc = GET_U_1(bp);
589 ND_PRINT(", gm clock accuracy : %u", gm_clk_acc);
590 *len -= 1;
591 bp += 1;
592 /* GM clock variance */
593 gm_clk_var = GET_BE_U_2(bp);
594 ND_PRINT(", gm clock variance : %u", gm_clk_var);
595 *len -= 2;
596 bp += 2;
597 /* GM Prio 2 */
598 gm_prio_2 = GET_U_1(bp);
599 ND_PRINT(", gm priority_2 : %u", gm_prio_2);
600 *len -= 1;
601 bp += 1;
602
603 /* GM Clock Identity */
604 gm_clock_id = GET_BE_U_8(bp);
605 ND_PRINT(", gm clock id : 0x%"PRIx64, gm_clock_id);
606 *len -= 8;
607 bp += 8;
608 /* steps removed */
609 steps_removed = GET_BE_U_2(bp);
610 ND_PRINT(", steps removed : %u", steps_removed);
611 *len -= 2;
612 bp += 2;
613 /* Time source */
614 time_src = GET_U_1(bp);
615 ND_PRINT(", time source : 0x%x", time_src);
616 *len -= 1;
617 bp += 1;
618
619 }
620 static void
621 ptp_print_port_id(netdissect_options *ndo, const u_char *bp, u_int *len)
622 {
623 uint16_t port_id;
624 uint64_t port_identity;
625
626 /* port identity*/
627 port_identity = GET_BE_U_8(bp);
628 ND_PRINT(", port identity : 0x%"PRIx64, port_identity);
629 *len -= 8;
630 bp += 8;
631
632 /* port id */
633 port_id = GET_BE_U_2(bp);
634 ND_PRINT(", port id : %u", port_id);
635 *len -= 2;
636 bp += 2;
637
638 }
639
640 static void
641 ptp_print_mgmt_msg(netdissect_options *ndo, const u_char *bp, u_int *len)
642 {
643 ptp_print_port_id(ndo, bp, len);
644 print_field(ndo, ", start boundary hops ", PTP_UCHAR_LEN, bp, len, PTP_FALSE);
645 print_field(ndo, ", boundary hops ", PTP_UCHAR_LEN, bp, len, PTP_FALSE);
646 print_field(ndo, ", flags ", PTP_UCHAR_LEN, bp, len, PTP_TRUE);
647 print_field(ndo, ", reserved ", PTP_UCHAR_LEN, bp, len, PTP_TRUE);
648 }
[mirror] the TCPdump network dissector