]> The Tcpdump Group git mirrors - tcpdump/blob - print-ptp.c
projects / tcpdump / blob
summary | shortlog | log | commit | commitdiff | tree
history | raw | HEAD
PTP: Fix the "not implemented" message for version 1
[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 #include <string.h>
28
29 /*
30 * PTP header
31 * 0 1 2 3
32 * 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
33 * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
34 * | R | |msgtype| version | Msg Len |
35 * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
36 * | domain No | rsvd1 | flag Field |
37 * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
38 * | Correction NS |
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 * Signalling 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 #define M_SYNC 0x0
180 #define M_DELAY_REQ 0x1
181 #define M_PDELAY_REQ 0x2
182 #define M_PDELAY_RESP 0x3
183 #define M_OTHER 0x5
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_SIGNALLING 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_OTHER, "Other"},
197 { M_FOLLOW_UP ,"follow up msg"},
198 { M_DELAY_RESP ,"delay resp msg"},
199 { M_PDELAY_RESP_FOLLOW_UP ,"pdelay resp fup msg"},
200 { M_ANNOUNCE ,"announce msg"},
201 { M_SIGNALLING ,"signalling msg"},
202 { M_MANAGEMENT ,"management msg"},
203 { 0, NULL}
204 };
205
206
207 #define PTP_TRUE 1
208 #define PTP_FALSE !PTP_TRUE
209
210 #define PTP_HDR_LEN 0x22
211
212 /* mask based on the first byte */
213 #define PTP_VERS_MASK 0xFF
214 #define PTP_V1_COMPAT 0x10
215 #define PTP_MSG_TYPE_MASK 0x0F
216
217 /*mask based 2byte */
218 #define PTP_DOMAIN_MASK 0xFF00
219 #define PTP_RSVD1_MASK 0xFF
220 #define PTP_CONTROL_MASK 0xFF
221 #define PTP_LOGMSG_MASK 0xFF
222
223 /* mask based on the flags 2 bytes */
224
225 #define PTP_L161_MASK 0x1
226 #define PTP_L1_59_MASK 0x2
227 #define PTP_UTC_REASONABLE_MASK 0x4
228 #define PTP_TIMESCALE_MASK 0x8
229 #define PTP_TIME_TRACABLE_MASK 0x10
230 #define PTP_FREQUENCY_TRACABLE_MASK 0x20
231 #define PTP_ALTERNATE_MASTER_MASK 0x100
232 #define PTP_TWO_STEP_MASK 0x200
233 #define PTP_UNICAST_MASK 0x400
234 #define PTP_PROFILE_SPEC_1_MASK 0x1000
235 #define PTP_PROFILE_SPEC_2_MASK 0x2000
236 #define PTP_SECURITY_MASK 0x4000
237 #define PTP_FLAGS_UNKNOWN_MASK 0x18C0
238
239
240 static const struct tok ptp_flag_values[] = {
241 { PTP_L161_MASK ,"l1 61"},
242 { PTP_L1_59_MASK ,"l1 59"},
243 { PTP_UTC_REASONABLE_MASK ,"utc reasonable"},
244 { PTP_TIMESCALE_MASK ,"timescale"},
245 { PTP_TIME_TRACABLE_MASK ,"time tracable"},
246 { PTP_FREQUENCY_TRACABLE_MASK ,"frequency tracable"},
247 { PTP_ALTERNATE_MASTER_MASK ,"alternate master"},
248 { PTP_TWO_STEP_MASK ,"two step"},
249 { PTP_UNICAST_MASK ,"unicast"},
250 { PTP_PROFILE_SPEC_1_MASK ,"profile specific 1"},
251 { PTP_PROFILE_SPEC_2_MASK ,"profile specific 2"},
252 { PTP_SECURITY_MASK ,"security mask"},
253 { PTP_FLAGS_UNKNOWN_MASK , "unknown"},
254 {0, NULL}
255 };
256
257 #define PTP_PRINT_MSG_TYPE(e) \
258 { \
259 ND_PRINT("(%s)", tok2str(ptp_msg_type, "unknown", e)); \
260 }
261
262 const char *p_porigin_ts = "preciseOriginTimeStamp";
263 const char *p_origin_ts = "originTimeStamp";
264 const char *p_recv_ts = "receiveTimeStamp";
265
266 #define PTP_VER_1 0x1
267 #define PTP_VER_2 0x2
268
269 #define PTP_UCHAR_LEN sizeof(uint8_t)
270 #define PTP_UINT16_LEN sizeof(uint16_t)
271 #define PTP_UINT32_LEN sizeof(uint32_t)
272 #define PTP_6BYTES_LEN sizeof(uint32_t)+sizeof(uint16_t)
273 #define PTP_UINT64_LEN sizeof(uint64_t)
274
275
276
277 static void ptp_print_1(netdissect_options *ndo);
278 static void ptp_print_2(netdissect_options *ndo, const u_char *bp, u_int len);
279
280 static void ptp_print_timestamp(netdissect_options *ndo, const u_char *bp, u_int *len, const char *stype);
281 static void ptp_print_timestamp_identity(netdissect_options *ndo, const u_char *bp, u_int *len, const char *ttype);
282 static void ptp_print_announce_msg(netdissect_options *ndo, const u_char *bp, u_int *len);
283 static void ptp_print_port_id(netdissect_options *ndo, const u_char *bp, u_int *len);
284 static void ptp_print_mgmt_msg(netdissect_options *ndo, const u_char *bp, u_int *len);
285
286 static void
287 print_field(netdissect_options *ndo, const char *st, uint32_t flen,
288 const u_char *bp, u_int *len, uint8_t hex)
289 {
290 uint8_t u8_val;
291 uint16_t u16_val;
292 uint32_t u32_val;
293 uint64_t u64_val;
294
295 switch(flen) {
296 case PTP_UCHAR_LEN:
297 u8_val = GET_U_1(bp);
298 ND_PRINT(", %s", st);
299 if (hex)
300 ND_PRINT(" 0x%x", u8_val);
301 else
302 ND_PRINT(" %u", u8_val);
303 *len -= 1; bp += 1;
304 break;
305 case PTP_UINT16_LEN:
306 u16_val = GET_BE_U_2(bp);
307 ND_PRINT(", %s", st);
308 if (hex)
309 ND_PRINT(" 0x%x", u16_val);
310 else
311 ND_PRINT(" %u", u16_val);
312 *len -= 2; bp += 2;
313 break;
314 case PTP_UINT32_LEN:
315 u32_val = GET_BE_U_4(bp);
316 ND_PRINT(", %s", st);
317 if (hex)
318 ND_PRINT(" 0x%x", u32_val);
319 else
320 ND_PRINT(" %u", u32_val);
321 *len -= 4; bp += 4;
322 break;
323 case PTP_UINT64_LEN:
324 u64_val = GET_BE_U_8(bp);
325 ND_PRINT(", %s", st);
326 if (hex)
327 ND_PRINT(" 0x%"PRIx64, u64_val);
328 else
329 ND_PRINT(" 0x%"PRIu64, u64_val);
330 *len -= 8; bp += 8;
331 break;
332 default:
333 break;
334 }
335 }
336
337 static void
338 ptp_print_1(netdissect_options *ndo)
339 {
340 ND_PRINT(" (not implemented)");
341 }
342
343 static void ptp_print_2(netdissect_options *ndo, const u_char *bp, u_int length)
344 {
345 u_int len = length;
346 uint16_t msg_len, flags, port_id, seq_id;
347 uint8_t foct, domain_no, msg_type, v1_compat, rsvd1, lm_int, control;
348 uint32_t ns_corr, sns_corr, rsvd2;
349 uint64_t clk_id;
350
351 foct = GET_U_1(bp);
352 v1_compat = foct & PTP_V1_COMPAT;
353 ND_PRINT(", v1 compat : %s", v1_compat?"yes":"no");
354 msg_type = foct & PTP_MSG_TYPE_MASK;
355 ND_PRINT(", msg type : %s", tok2str(ptp_msg_type, "none", msg_type));
356
357 /* msg length */
358 len -= 2; bp += 2; msg_len = GET_BE_U_2(bp); ND_PRINT(", length : %u", msg_len);
359
360 /* domain */
361 len -= 2; bp += 2; domain_no = GET_BE_U_2(bp) & PTP_DOMAIN_MASK; ND_PRINT(", domain : %u", domain_no);
362
363 /* rsvd 1*/
364 rsvd1 = GET_BE_U_2(bp) & PTP_RSVD1_MASK;
365 ND_PRINT(", reserved1 : %u", rsvd1);
366
367 /* flags */
368 len -= 2; bp += 2; flags = GET_BE_U_2(bp); ND_PRINT(", Flags [%s]", bittok2str(ptp_flag_values, "none", flags));
369
370 /* correction NS */
371 len -= 2; bp += 2; ns_corr = GET_BE_U_4(bp); ND_PRINT(", NS correction : %u", ns_corr);
372
373 /* correction sub NS */
374 len -= 4; bp += 4; sns_corr = GET_BE_U_4(bp); ND_PRINT(", sub NS correction : %u", sns_corr);
375
376 /* Reserved 2 */
377 len -= 4; bp += 4; rsvd2 = GET_BE_U_4(bp); ND_PRINT(", reserved2 : %u", rsvd2);
378
379 /* clock identity */
380 len -= 4; bp += 4; clk_id = GET_BE_U_8(bp); ND_PRINT(", clock identity : 0x%"PRIx64, clk_id);
381
382 /* port identity */
383 len -= 8; bp += 8; port_id = GET_BE_U_2(bp); ND_PRINT(", port id : %u", port_id);
384
385 /* sequence ID */
386 len -= 2; bp += 2; seq_id = GET_BE_U_2(bp); ND_PRINT(", seq id : %u", seq_id);
387
388 /* control */
389 len -= 2; bp += 2; control = GET_U_1(bp) ;
390 ND_PRINT(", control : %u (%s)", control, tok2str(ptp_msg_type, "none", control));
391
392 /* log message interval */
393 lm_int = GET_BE_U_2(bp) & PTP_LOGMSG_MASK; ND_PRINT(", log message interval : %u", lm_int); len -= 2; bp += 2;
394
395 switch(msg_type) {
396 case M_SYNC:
397 ptp_print_timestamp(ndo, bp, &len, p_origin_ts);
398 break;
399 case M_DELAY_REQ:
400 ptp_print_timestamp(ndo, bp, &len, p_origin_ts);
401 break;
402 case M_PDELAY_REQ:
403 ptp_print_timestamp_identity(ndo, bp, &len, p_porigin_ts);
404 break;
405 case M_PDELAY_RESP:
406 ptp_print_timestamp_identity(ndo, bp, &len, p_recv_ts);
407 break;
408 case M_FOLLOW_UP:
409 ptp_print_timestamp(ndo, bp, &len, p_porigin_ts);
410 break;
411 case M_DELAY_RESP:
412 ptp_print_timestamp_identity(ndo, bp, &len, p_recv_ts);
413 break;
414 case M_PDELAY_RESP_FOLLOW_UP:
415 ptp_print_timestamp_identity(ndo, bp, &len, p_porigin_ts);
416 break;
417 case M_ANNOUNCE:
418 ptp_print_announce_msg(ndo, bp, &len);
419 break;
420 case M_SIGNALLING:
421 ptp_print_port_id(ndo, bp, &len);
422 break;
423 case M_MANAGEMENT:
424 ptp_print_mgmt_msg(ndo, bp, &len);
425 break;
426 default:
427 break;
428 }
429 }
430 /*
431 * PTP general message
432 */
433 void
434 ptp_print(netdissect_options *ndo, const u_char *bp, u_int len)
435 {
436 u_int vers;
437
438 ndo->ndo_protocol = "ptp";
439 if (len < PTP_HDR_LEN) {
440 goto trunc;
441 }
442 vers = GET_BE_U_2(bp) & PTP_VERS_MASK;
443 ND_PRINT("PTPv%u",vers);
444 switch(vers) {
445 case PTP_VER_1:
446 ptp_print_1(ndo);
447 break;
448 case PTP_VER_2:
449 ptp_print_2(ndo, bp, len);
450 break;
451 default:
452 //ND_PRINT("ERROR: unknown-version\n");
453 break;
454 }
455 return;
456
457 trunc:
458 nd_print_trunc(ndo);
459 return;
460 }
461
462 static void
463 ptp_print_timestamp(netdissect_options *ndo, const u_char *bp, u_int *len, const char *stype)
464 {
465 uint64_t secs;
466 uint32_t nsecs;
467
468 ND_PRINT(", %s :", stype);
469 /* sec time stamp 6 bytes */
470 secs = GET_BE_U_2(bp) + GET_BE_U_4(bp+2);
471 ND_PRINT(" %"PRIu64" seconds,", secs);
472 *len -= 6;
473 bp += 6;
474
475 /* NS time stamp 4 bytes */
476 nsecs = GET_BE_U_4(bp);
477 ND_PRINT(" %u nanoseconds", nsecs);
478 *len -= 4;
479 bp += 4;
480 }
481 static void
482 ptp_print_timestamp_identity(netdissect_options *ndo,
483 const u_char *bp, u_int *len, const char *ttype)
484 {
485 uint64_t secs;
486 uint32_t nsecs;
487 uint16_t port_id;
488 uint64_t port_identity;
489
490 ND_PRINT(", %s :", ttype);
491 /* sec time stamp 6 bytes */
492 secs = GET_BE_U_2(bp) + GET_BE_U_4(bp+2);
493 ND_PRINT(" %"PRIu64" seconds,", secs);
494 *len -= 6;
495 bp += 6;
496
497 /* NS time stamp 4 bytes */
498 nsecs = GET_BE_U_4(bp);
499 ND_PRINT(" %u nanoseconds", nsecs);
500 *len -= 4;
501 bp += 4;
502
503 /* port identity*/
504 port_identity = GET_BE_U_8(bp);
505 ND_PRINT(", port identity : 0x%"PRIx64, port_identity);
506 *len -= 8;
507 bp += 8;
508
509 /* port id */
510 port_id = GET_BE_U_2(bp);
511 ND_PRINT(", port id : %u", port_id);
512 *len -= 2;
513 bp += 2;
514 }
515 static void
516 ptp_print_announce_msg(netdissect_options *ndo, const u_char *bp, u_int *len)
517 {
518 uint8_t rsvd, gm_prio_1, gm_prio_2, gm_clk_cls, gm_clk_acc, time_src;
519 uint16_t origin_cur_utc, gm_clk_var, steps_removed;
520 uint64_t gm_clock_id;
521 uint64_t secs;
522 uint32_t nsecs;
523
524 ND_PRINT(", %s :", p_origin_ts);
525 /* sec time stamp 6 bytes */
526 secs = GET_BE_U_2(bp) + GET_BE_U_4(bp+2);
527 ND_PRINT(" %"PRIu64" seconds", secs);
528 *len -= 6;
529 bp += 6;
530
531 /* NS time stamp 4 bytes */
532 nsecs = GET_BE_U_4(bp);
533 ND_PRINT(" %u nanoseconds", nsecs);
534 *len -= 4;
535 bp += 4;
536
537 /* origin cur utc */
538 origin_cur_utc = GET_BE_U_2(bp);
539 ND_PRINT(", origin cur utc :%u", origin_cur_utc);
540 *len -= 2;
541 bp += 2;
542
543 /* rsvd */
544 rsvd = GET_U_1(bp);
545 ND_PRINT(", rsvd : %u", rsvd);
546 *len -= 1;
547 bp += 1;
548
549 /* gm prio */
550 gm_prio_1 = GET_U_1(bp);
551 ND_PRINT(", gm priority_1 : %u", gm_prio_1);
552 *len -= 1;
553 bp += 1;
554
555 /* GM clock class */
556 gm_clk_cls = GET_U_1(bp);
557 ND_PRINT(", gm clock class : %u", gm_clk_cls);
558 *len -= 1;
559 bp += 1;
560 /* GM clock accuracy */
561 gm_clk_acc = GET_U_1(bp);
562 ND_PRINT(", gm clock accuracy : %u", gm_clk_acc);
563 *len -= 1;
564 bp += 1;
565 /* GM clock variance */
566 gm_clk_var = GET_BE_U_2(bp);
567 ND_PRINT(", gm clock variance : %u", gm_clk_var);
568 *len -= 2;
569 bp += 2;
570 /* GM Prio 2 */
571 gm_prio_2 = GET_U_1(bp);
572 ND_PRINT(", gm priority_2 : %u", gm_prio_2);
573 *len -= 1;
574 bp += 1;
575
576 /* GM Clock Identity */
577 gm_clock_id = GET_BE_U_8(bp);
578 ND_PRINT(", gm clock id : 0x%"PRIx64, gm_clock_id);
579 *len -= 8;
580 bp += 8;
581 /* steps removed */
582 steps_removed = GET_BE_U_2(bp);
583 ND_PRINT(", steps removed : %u", steps_removed);
584 *len -= 2;
585 bp += 2;
586 /* Time source */
587 time_src = GET_U_1(bp);
588 ND_PRINT(", time source : 0x%x", time_src);
589 *len -= 1;
590 bp += 1;
591
592 }
593 static void
594 ptp_print_port_id(netdissect_options *ndo, const u_char *bp, u_int *len)
595 {
596 uint16_t port_id;
597 uint64_t port_identity;
598
599 /* port identity*/
600 port_identity = GET_BE_U_8(bp);
601 ND_PRINT(", port identity : 0x%"PRIx64, port_identity);
602 *len -= 8;
603 bp += 8;
604
605 /* port id */
606 port_id = GET_BE_U_2(bp);
607 ND_PRINT(", port id : %u", port_id);
608 *len -= 2;
609 bp += 2;
610
611 }
612
613 static void
614 ptp_print_mgmt_msg(netdissect_options *ndo, const u_char *bp, u_int *len)
615 {
616 ptp_print_port_id(ndo, bp, len);
617 print_field(ndo, ", start boundary hops ", PTP_UCHAR_LEN, bp, len, PTP_FALSE);
618 print_field(ndo, ", boundary hops ", PTP_UCHAR_LEN, bp, len, PTP_FALSE);
619 print_field(ndo, ", flags ", PTP_UCHAR_LEN, bp, len, PTP_TRUE);
620 print_field(ndo, ", reserved ", PTP_UCHAR_LEN, bp, len, PTP_TRUE);
621 }
[mirror] the TCPdump network dissector