/* * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that: (1) source code * distributions retain the above copyright notice and this paragraph * in its entirety, and (2) distributions including binary code include * the above copyright notice and this paragraph in its entirety in * the documentation or other materials provided with the distribution. * THIS SOFTWARE IS PROVIDED ``AS IS'' AND * WITHOUT ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, WITHOUT * LIMITATION, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS * FOR A PARTICULAR PURPOSE. * * Original code by Partha S. Ghosh (psglinux dot gmail dot com) */ /* \summary: Precision Time Protocol (PTP) printer */ /* specification: https://standards.ieee.org/findstds/standard/1588-2008.html*/ #include #include "netdissect-stdinc.h" #include "netdissect.h" #include "extract.h" /* * PTP header * 0 1 2 3 * 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 * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+ * | R | |msgtype| version | Msg Len | * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+ * | domain No | rsvd1 | flag Field | * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+ * | Correction NS | * + +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+ * | | Correction Sub NS | * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+ * | Reserved2 | * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+ * | Clock Identity | * | | * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+ * | Port Identity | Sequence ID | * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+ * | control | log msg int | * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+ * 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 * 0 1 2 3 * * Announce Message (msg type=0xB) * 0 1 2 3 * 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 * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+ * | | * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+ + * | Seconds | * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+ * | Nano Seconds | * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+ * | Origin Cur UTC Offset | Reserved | GM Prio 1 | * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+ * |GM Clock Class | GM Clock Accu | GM Clock Variance | * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+ * | GM Prio 2 | | * +-+-+-+-+-+-+-+-+ + * | GM Clock Identity | * + +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+ * | | Steps Removed | Time Source | * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+ * 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 * 0 1 2 3 * * Sync Message (msg type=0x0) * 0 1 2 3 * 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 * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+ * | | * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+ + * | Seconds | * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+ * | Nano Seconds | * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+ * * Delay Request Message (msg type=0x1) * 0 1 2 3 * 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 * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+ * | | * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+ + * | Origin Time Stamp Seconds | * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+ * | Nano Seconds | * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+ * * Followup Message (msg type=0x8) * 0 1 2 3 * 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 * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+ * | | * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+ + * | Precise Origin Time Stamp Seconds | * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+ * | Nano Seconds | * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+ * * Delay Resp Message (msg type=0x9) * 0 1 2 3 * 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 * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+ * | | * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+ + * | Seconds | * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+ * | Nano Seconds | * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+ * | Port Identity | * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+ * * PDelay Request Message (msg type=0x2) * 0 1 2 3 * 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 * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+ * | | * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+ + * | Origin Time Stamp Seconds | * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+ * | Origin Time Stamp Nano Seconds | * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+ * | Port Identity | * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+ * * PDelay Response Message (msg type=0x3) * 0 1 2 3 * 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 * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+ * | | * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+ + * | Request receipt Time Stamp Seconds | * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+ * | Nano Seconds | * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+ * | Requesting Port Identity | * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+ * * PDelay Resp Follow up Message (msg type=0xA) * 0 1 2 3 * 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 * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+ * | | * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+ + * | Response Origin Time Stamp Seconds | * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+ * | Nano Seconds | * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+ * | Requesting Port Identity | * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+ * * Signaling Message (msg type=0xC) * 0 1 2 3 * 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 * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+ * | Requesting Port Identity | * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+ * * Management Message (msg type=0xD) * 0 1 2 3 * 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 * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+ * | Requesting Port Identity | * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+ * |Start Bndry Hps| Boundary Hops | flags | Reserved | * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+ * */ /* Values from IEEE1588-2008: 13.3.2.2 messageType (Enumeration4) */ #define M_SYNC 0x0 #define M_DELAY_REQ 0x1 #define M_PDELAY_REQ 0x2 #define M_PDELAY_RESP 0x3 #define M_FOLLOW_UP 0x8 #define M_DELAY_RESP 0x9 #define M_PDELAY_RESP_FOLLOW_UP 0xA #define M_ANNOUNCE 0xB #define M_SIGNALING 0xC #define M_MANAGEMENT 0xD static const struct tok ptp_msg_type[] = { { M_SYNC, "sync msg"}, { M_DELAY_REQ, "delay req msg"}, { M_PDELAY_REQ, "peer delay req msg"}, { M_PDELAY_RESP, "peer delay resp msg"}, { M_FOLLOW_UP, "follow up msg"}, { M_DELAY_RESP, "delay resp msg"}, { M_PDELAY_RESP_FOLLOW_UP, "pdelay resp fup msg"}, { M_ANNOUNCE, "announce msg"}, { M_SIGNALING, "signaling msg"}, { M_MANAGEMENT, "management msg"}, { 0, NULL} }; /* Values from IEEE1588-2008: 13.3.2.10 controlField (UInteger8) */ /* * The use of this field by the receiver is deprecated. * NOTE-This field is provided for compatibility with hardware designed * to conform to version 1 of this standard. */ #define C_SYNC 0x0 #define C_DELAY_REQ 0x1 #define C_FOLLOW_UP 0x2 #define C_DELAY_RESP 0x3 #define C_MANAGEMENT 0x4 #define C_OTHER 0x5 static const struct tok ptp_control_field[] = { { C_SYNC, "Sync"}, { C_DELAY_REQ, "Delay_Req"}, { C_FOLLOW_UP, "Follow_Up"}, { C_DELAY_RESP, "Delay_Resp"}, { C_MANAGEMENT, "Management"}, { C_OTHER, "Other"}, { 0, NULL} }; #define PTP_TRUE 1 #define PTP_FALSE !PTP_TRUE #define PTP_HDR_LEN 0x22 /* mask based on the first byte */ #define PTP_MAJOR_VERS_MASK 0x0F #define PTP_MINOR_VERS_MASK 0xF0 #define PTP_MAJOR_SDO_ID_MASK 0xF0 #define PTP_MSG_TYPE_MASK 0x0F /*mask based 2byte */ #define PTP_DOMAIN_MASK 0xFF00 #define PTP_RSVD1_MASK 0xFF #define PTP_CONTROL_MASK 0xFF #define PTP_LOGMSG_MASK 0xFF /* mask based on the flags 2 bytes */ #define PTP_L161_MASK 0x1 #define PTP_L1_59_MASK 0x2 #define PTP_UTC_REASONABLE_MASK 0x4 #define PTP_TIMESCALE_MASK 0x8 #define PTP_TIME_TRACABLE_MASK 0x10 #define PTP_FREQUENCY_TRACABLE_MASK 0x20 #define PTP_ALTERNATE_MASTER_MASK 0x100 #define PTP_TWO_STEP_MASK 0x200 #define PTP_UNICAST_MASK 0x400 #define PTP_PROFILE_SPEC_1_MASK 0x1000 #define PTP_PROFILE_SPEC_2_MASK 0x2000 #define PTP_SECURITY_MASK 0x4000 #define PTP_FLAGS_UNKNOWN_MASK 0x18C0 static const struct tok ptp_flag_values[] = { { PTP_L161_MASK, "l1 61"}, { PTP_L1_59_MASK, "l1 59"}, { PTP_UTC_REASONABLE_MASK, "utc reasonable"}, { PTP_TIMESCALE_MASK, "timescale"}, { PTP_TIME_TRACABLE_MASK, "time tracable"}, { PTP_FREQUENCY_TRACABLE_MASK, "frequency tracable"}, { PTP_ALTERNATE_MASTER_MASK, "alternate master"}, { PTP_TWO_STEP_MASK, "two step"}, { PTP_UNICAST_MASK, "unicast"}, { PTP_PROFILE_SPEC_1_MASK, "profile specific 1"}, { PTP_PROFILE_SPEC_2_MASK, "profile specific 2"}, { PTP_SECURITY_MASK, "security mask"}, { PTP_FLAGS_UNKNOWN_MASK, "unknown"}, {0, NULL} }; static const char *p_porigin_ts = "preciseOriginTimeStamp"; static const char *p_origin_ts = "originTimeStamp"; static const char *p_recv_ts = "receiveTimeStamp"; #define PTP_VER_1 0x1 #define PTP_VER_2 0x2 #define PTP_UCHAR_LEN sizeof(uint8_t) #define PTP_UINT16_LEN sizeof(uint16_t) #define PTP_UINT32_LEN sizeof(uint32_t) #define PTP_6BYTES_LEN sizeof(uint32_t)+sizeof(uint16_t) #define PTP_UINT64_LEN sizeof(uint64_t) static void ptp_print_1(netdissect_options *ndo); static void ptp_print_2(netdissect_options *ndo, const u_char *bp, u_int len); static void ptp_print_timestamp(netdissect_options *ndo, const u_char *bp, u_int *len, const char *stype); static void ptp_print_timestamp_identity(netdissect_options *ndo, const u_char *bp, u_int *len, const char *ttype); static void ptp_print_announce_msg(netdissect_options *ndo, const u_char *bp, u_int *len); static void ptp_print_port_id(netdissect_options *ndo, const u_char *bp, u_int *len); static void ptp_print_mgmt_msg(netdissect_options *ndo, const u_char *bp, u_int *len); static void print_field(netdissect_options *ndo, const char *st, uint32_t flen, const u_char *bp, u_int *len, uint8_t hex) { uint8_t u8_val; uint16_t u16_val; uint32_t u32_val; uint64_t u64_val; switch(flen) { case PTP_UCHAR_LEN: u8_val = GET_U_1(bp); ND_PRINT(", %s", st); if (hex) ND_PRINT(" 0x%x", u8_val); else ND_PRINT(" %u", u8_val); *len -= 1; bp += 1; break; case PTP_UINT16_LEN: u16_val = GET_BE_U_2(bp); ND_PRINT(", %s", st); if (hex) ND_PRINT(" 0x%x", u16_val); else ND_PRINT(" %u", u16_val); *len -= 2; bp += 2; break; case PTP_UINT32_LEN: u32_val = GET_BE_U_4(bp); ND_PRINT(", %s", st); if (hex) ND_PRINT(" 0x%x", u32_val); else ND_PRINT(" %u", u32_val); *len -= 4; bp += 4; break; case PTP_UINT64_LEN: u64_val = GET_BE_U_8(bp); ND_PRINT(", %s", st); if (hex) ND_PRINT(" 0x%"PRIx64, u64_val); else ND_PRINT(" 0x%"PRIu64, u64_val); *len -= 8; bp += 8; break; default: break; } } static void ptp_print_1(netdissect_options *ndo) { ND_PRINT(" (not implemented)"); } static void ptp_print_2(netdissect_options *ndo, const u_char *bp, u_int length) { u_int len = length; uint16_t msg_len, flags, port_id, seq_id; uint8_t foct, domain_no, msg_type, major_sdo_id, rsvd1, lm_int, control; uint64_t ns_corr; uint16_t sns_corr; uint32_t rsvd2; uint64_t clk_id; foct = GET_U_1(bp); major_sdo_id = (foct & PTP_MAJOR_SDO_ID_MASK) >> 4; ND_PRINT(", majorSdoId : 0x%x", major_sdo_id); msg_type = foct & PTP_MSG_TYPE_MASK; ND_PRINT(", msg type : %s", tok2str(ptp_msg_type, "Reserved", msg_type)); /* msg length */ len -= 2; bp += 2; msg_len = GET_BE_U_2(bp); ND_PRINT(", length : %u", msg_len); /* domain */ len -= 2; bp += 2; domain_no = (GET_BE_U_2(bp) & PTP_DOMAIN_MASK) >> 8; ND_PRINT(", domain : %u", domain_no); /* rsvd 1*/ rsvd1 = GET_BE_U_2(bp) & PTP_RSVD1_MASK; ND_PRINT(", reserved1 : %u", rsvd1); /* flags */ len -= 2; bp += 2; flags = GET_BE_U_2(bp); ND_PRINT(", Flags [%s]", bittok2str(ptp_flag_values, "none", flags)); /* correction NS (48 bits) */ len -= 2; bp += 2; ns_corr = GET_BE_U_6(bp); ND_PRINT(", NS correction : %"PRIu64, ns_corr); /* correction sub NS (16 bits) */ len -= 6; bp += 6; sns_corr = GET_BE_U_2(bp); ND_PRINT(", sub NS correction : %u", sns_corr); /* Reserved 2 */ len -= 2; bp += 2; rsvd2 = GET_BE_U_4(bp); ND_PRINT(", reserved2 : %u", rsvd2); /* clock identity */ len -= 4; bp += 4; clk_id = GET_BE_U_8(bp); ND_PRINT(", clock identity : 0x%"PRIx64, clk_id); /* port identity */ len -= 8; bp += 8; port_id = GET_BE_U_2(bp); ND_PRINT(", port id : %u", port_id); /* sequence ID */ len -= 2; bp += 2; seq_id = GET_BE_U_2(bp); ND_PRINT(", seq id : %u", seq_id); /* control */ len -= 2; bp += 2; control = GET_U_1(bp) ; ND_PRINT(", control : %u (%s)", control, tok2str(ptp_control_field, "Reserved", control)); /* log message interval */ lm_int = GET_BE_U_2(bp) & PTP_LOGMSG_MASK; ND_PRINT(", log message interval : %u", lm_int); len -= 2; bp += 2; switch(msg_type) { case M_SYNC: ptp_print_timestamp(ndo, bp, &len, p_origin_ts); break; case M_DELAY_REQ: ptp_print_timestamp(ndo, bp, &len, p_origin_ts); break; case M_PDELAY_REQ: ptp_print_timestamp_identity(ndo, bp, &len, p_porigin_ts); break; case M_PDELAY_RESP: ptp_print_timestamp_identity(ndo, bp, &len, p_recv_ts); break; case M_FOLLOW_UP: ptp_print_timestamp(ndo, bp, &len, p_porigin_ts); break; case M_DELAY_RESP: ptp_print_timestamp_identity(ndo, bp, &len, p_recv_ts); break; case M_PDELAY_RESP_FOLLOW_UP: ptp_print_timestamp_identity(ndo, bp, &len, p_porigin_ts); break; case M_ANNOUNCE: ptp_print_announce_msg(ndo, bp, &len); break; case M_SIGNALING: ptp_print_port_id(ndo, bp, &len); break; case M_MANAGEMENT: ptp_print_mgmt_msg(ndo, bp, &len); break; default: break; } } /* * PTP general message */ void ptp_print(netdissect_options *ndo, const u_char *bp, u_int length) { u_int major_vers; u_int minor_vers; /* In 1588-2019, a minorVersionPTP field has been created in the common PTP * message header, from a previously reserved field. Implementations * compatible to the 2019 edition shall indicate a versionPTP field value * of 2 and minorVersionPTP field value of 1, indicating that this is PTP * version 2.1. */ ndo->ndo_protocol = "ptp"; ND_ICHECK_U(length, <, PTP_HDR_LEN); major_vers = GET_BE_U_2(bp) & PTP_MAJOR_VERS_MASK; minor_vers = (GET_BE_U_2(bp) & PTP_MINOR_VERS_MASK) >> 4; if (minor_vers) ND_PRINT("PTPv%u.%u", major_vers, minor_vers); else ND_PRINT("PTPv%u", major_vers); switch(major_vers) { case PTP_VER_1: ptp_print_1(ndo); break; case PTP_VER_2: ptp_print_2(ndo, bp, length); break; default: //ND_PRINT("ERROR: unknown-version\n"); break; } return; invalid: nd_print_invalid(ndo); } static void ptp_print_timestamp(netdissect_options *ndo, const u_char *bp, u_int *len, const char *stype) { uint64_t secs; uint32_t nsecs; ND_PRINT(", %s :", stype); /* sec time stamp 6 bytes */ secs = GET_BE_U_6(bp); ND_PRINT(" %"PRIu64" seconds,", secs); *len -= 6; bp += 6; /* NS time stamp 4 bytes */ nsecs = GET_BE_U_4(bp); ND_PRINT(" %u nanoseconds", nsecs); *len -= 4; bp += 4; } static void ptp_print_timestamp_identity(netdissect_options *ndo, const u_char *bp, u_int *len, const char *ttype) { uint64_t secs; uint32_t nsecs; uint16_t port_id; uint64_t port_identity; ND_PRINT(", %s :", ttype); /* sec time stamp 6 bytes */ secs = GET_BE_U_6(bp); ND_PRINT(" %"PRIu64" seconds,", secs); *len -= 6; bp += 6; /* NS time stamp 4 bytes */ nsecs = GET_BE_U_4(bp); ND_PRINT(" %u nanoseconds", nsecs); *len -= 4; bp += 4; /* port identity*/ port_identity = GET_BE_U_8(bp); ND_PRINT(", port identity : 0x%"PRIx64, port_identity); *len -= 8; bp += 8; /* port id */ port_id = GET_BE_U_2(bp); ND_PRINT(", port id : %u", port_id); *len -= 2; bp += 2; } static void ptp_print_announce_msg(netdissect_options *ndo, const u_char *bp, u_int *len) { uint8_t rsvd, gm_prio_1, gm_prio_2, gm_clk_cls, gm_clk_acc, time_src; uint16_t origin_cur_utc, gm_clk_var, steps_removed; uint64_t gm_clock_id; uint64_t secs; uint32_t nsecs; ND_PRINT(", %s :", p_origin_ts); /* sec time stamp 6 bytes */ secs = GET_BE_U_6(bp); ND_PRINT(" %"PRIu64" seconds", secs); *len -= 6; bp += 6; /* NS time stamp 4 bytes */ nsecs = GET_BE_U_4(bp); ND_PRINT(" %u nanoseconds", nsecs); *len -= 4; bp += 4; /* origin cur utc */ origin_cur_utc = GET_BE_U_2(bp); ND_PRINT(", origin cur utc :%u", origin_cur_utc); *len -= 2; bp += 2; /* rsvd */ rsvd = GET_U_1(bp); ND_PRINT(", rsvd : %u", rsvd); *len -= 1; bp += 1; /* gm prio */ gm_prio_1 = GET_U_1(bp); ND_PRINT(", gm priority_1 : %u", gm_prio_1); *len -= 1; bp += 1; /* GM clock class */ gm_clk_cls = GET_U_1(bp); ND_PRINT(", gm clock class : %u", gm_clk_cls); *len -= 1; bp += 1; /* GM clock accuracy */ gm_clk_acc = GET_U_1(bp); ND_PRINT(", gm clock accuracy : %u", gm_clk_acc); *len -= 1; bp += 1; /* GM clock variance */ gm_clk_var = GET_BE_U_2(bp); ND_PRINT(", gm clock variance : %u", gm_clk_var); *len -= 2; bp += 2; /* GM Prio 2 */ gm_prio_2 = GET_U_1(bp); ND_PRINT(", gm priority_2 : %u", gm_prio_2); *len -= 1; bp += 1; /* GM Clock Identity */ gm_clock_id = GET_BE_U_8(bp); ND_PRINT(", gm clock id : 0x%"PRIx64, gm_clock_id); *len -= 8; bp += 8; /* steps removed */ steps_removed = GET_BE_U_2(bp); ND_PRINT(", steps removed : %u", steps_removed); *len -= 2; bp += 2; /* Time source */ time_src = GET_U_1(bp); ND_PRINT(", time source : 0x%x", time_src); *len -= 1; bp += 1; } static void ptp_print_port_id(netdissect_options *ndo, const u_char *bp, u_int *len) { uint16_t port_id; uint64_t port_identity; /* port identity*/ port_identity = GET_BE_U_8(bp); ND_PRINT(", port identity : 0x%"PRIx64, port_identity); *len -= 8; bp += 8; /* port id */ port_id = GET_BE_U_2(bp); ND_PRINT(", port id : %u", port_id); *len -= 2; bp += 2; } static void ptp_print_mgmt_msg(netdissect_options *ndo, const u_char *bp, u_int *len) { ptp_print_port_id(ndo, bp, len); print_field(ndo, ", start boundary hops ", PTP_UCHAR_LEN, bp, len, PTP_FALSE); print_field(ndo, ", boundary hops ", PTP_UCHAR_LEN, bp, len, PTP_FALSE); print_field(ndo, ", flags ", PTP_UCHAR_LEN, bp, len, PTP_TRUE); print_field(ndo, ", reserved ", PTP_UCHAR_LEN, bp, len, PTP_TRUE); }