/** * @file msg.h * @brief Implements the various PTP message types. * @note Copyright (C) 2011 Richard Cochran * * This program is free software; you can redistribute it and/or modify * it under the terms of the GNU General Public License as published by * the Free Software Foundation; either version 2 of the License, or * (at your option) any later version. * * This program is distributed in the hope that it will be useful, * but WITHOUT ANY WARRANTY; without even the implied warranty of * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the * GNU General Public License for more details. * * You should have received a copy of the GNU General Public License along * with this program; if not, write to the Free Software Foundation, Inc., * 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA. */ #ifndef HAVE_MSG_H #define HAVE_MSG_H #include #include #include #include "address.h" #include "ddt.h" #include "tlv.h" #include "tmv.h" #define PTP_VERSION 2 /* Values for the messageType field */ #define SYNC 0x0 #define DELAY_REQ 0x1 #define PDELAY_REQ 0x2 #define PDELAY_RESP 0x3 #define FOLLOW_UP 0x8 #define DELAY_RESP 0x9 #define PDELAY_RESP_FOLLOW_UP 0xA #define ANNOUNCE 0xB #define SIGNALING 0xC #define MANAGEMENT 0xD /* Bits for flagField[0] */ #define ALT_MASTER (1<<0) #define TWO_STEP (1<<1) #define UNICAST (1<<2) /* Bits for flagField[1] */ #define LEAP_61 (1<<0) #define LEAP_59 (1<<1) #define UTC_OFF_VALID (1<<2) #define PTP_TIMESCALE (1<<3) #define TIME_TRACEABLE (1<<4) #define FREQ_TRACEABLE (1<<5) enum timestamp_type { TS_SOFTWARE, TS_HARDWARE, TS_LEGACY_HW, TS_ONESTEP, TS_P2P1STEP, }; struct hw_timestamp { enum timestamp_type type; tmv_t ts; tmv_t sw; }; enum controlField { CTL_SYNC, CTL_DELAY_REQ, CTL_FOLLOW_UP, CTL_DELAY_RESP, CTL_MANAGEMENT, CTL_OTHER, }; struct ptp_header { uint8_t tsmt; /* transportSpecific | messageType */ uint8_t ver; /* reserved | versionPTP */ UInteger16 messageLength; UInteger8 domainNumber; Octet reserved1; Octet flagField[2]; Integer64 correction; UInteger32 reserved2; struct PortIdentity sourcePortIdentity; UInteger16 sequenceId; UInteger8 control; Integer8 logMessageInterval; } PACKED; struct announce_msg { struct ptp_header hdr; struct Timestamp originTimestamp; Integer16 currentUtcOffset; Octet reserved; UInteger8 grandmasterPriority1; struct ClockQuality grandmasterClockQuality; UInteger8 grandmasterPriority2; struct ClockIdentity grandmasterIdentity; UInteger16 stepsRemoved; Enumeration8 timeSource; uint8_t suffix[0]; } PACKED; struct sync_msg { struct ptp_header hdr; struct Timestamp originTimestamp; } PACKED; struct delay_req_msg { struct ptp_header hdr; struct Timestamp originTimestamp; uint8_t suffix[0]; } PACKED; struct follow_up_msg { struct ptp_header hdr; struct Timestamp preciseOriginTimestamp; uint8_t suffix[0]; } PACKED; struct delay_resp_msg { struct ptp_header hdr; struct Timestamp receiveTimestamp; struct PortIdentity requestingPortIdentity; uint8_t suffix[0]; } PACKED; struct pdelay_req_msg { struct ptp_header hdr; struct Timestamp originTimestamp; struct PortIdentity reserved; } PACKED; struct pdelay_resp_msg { struct ptp_header hdr; struct Timestamp requestReceiptTimestamp; struct PortIdentity requestingPortIdentity; } PACKED; struct pdelay_resp_fup_msg { struct ptp_header hdr; struct Timestamp responseOriginTimestamp; struct PortIdentity requestingPortIdentity; uint8_t suffix[0]; } PACKED; struct signaling_msg { struct ptp_header hdr; struct PortIdentity targetPortIdentity; uint8_t suffix[0]; } PACKED; struct management_msg { struct ptp_header hdr; struct PortIdentity targetPortIdentity; UInteger8 startingBoundaryHops; UInteger8 boundaryHops; uint8_t flags; /* reserved | actionField */ uint8_t reserved; uint8_t suffix[0]; } PACKED; struct message_data { uint8_t buffer[1500]; } PACKED; struct ptp_message { union { struct ptp_header header; struct announce_msg announce; struct sync_msg sync; struct delay_req_msg delay_req; struct follow_up_msg follow_up; struct delay_resp_msg delay_resp; struct pdelay_req_msg pdelay_req; struct pdelay_resp_msg pdelay_resp; struct pdelay_resp_fup_msg pdelay_resp_fup; struct signaling_msg signaling; struct management_msg management; struct message_data data; } PACKED; /**/ int tail_room; int refcnt; TAILQ_ENTRY(ptp_message) list; struct { /** * Contains the time stamp from the packet data in a * native binary format for the host machine. The * exact source of the time stamp's value depends on * the message type: * * - announce originTimestamp * - follow_up preciseOriginTimestamp * - sync originTimestamp * - delay_req originTimestamp * - pdelay_resp requestReceiptTimestamp * - pdelay_resp_fup responseOriginTimestamp */ struct timestamp pdu; /** * Approximate ingress time stamp using the relative * CLOCK_MONOTONIC. Used to determine when announce * messages have expired. */ struct timespec host; } ts; /** * Contains the ingress time stamp obtained by the * SO_TIMESTAMPING socket option. */ struct hw_timestamp hwts; /** * Contains the address this message was received from or should be * sent to. */ struct address address; /** * List of TLV descriptors. Each item in the list contains * pointers to the appended TLVs. */ TAILQ_HEAD(tlv_list, tlv_extra) tlv_list; }; /** * Obtain the action field from a management message. * @param m A management message. * @return The value of the action field. */ static inline uint8_t management_action(struct ptp_message *m) { return m->management.flags & 0x0f; } /** * Test a given bit in a message's flag field. * @param m Message to test. * @param index Index into flag field, either 0 or 1. * @param bit Bit mask of one bit to test. * @return One if bit is set, zero otherwise. */ static inline Boolean field_is_set(struct ptp_message *m, int index, Octet bit) { return m->header.flagField[index] & bit ? TRUE : FALSE; } /** * Append a new TLV onto a message for transmission. * * This is a high level API designed for the transmit path. The * function allocates a new descriptor, initializes its .tlv field, * and ensures that the TLV will fit into the message buffer. This * function increments the message length field by 'length' before * returning. * * @param msg A message obtained using msg_allocate(). At a mininum, * the message type and length fields must set by the caller. * @param length The length of the TLV to append. * @return A pointer to a TLV descriptor on success or NULL otherwise. */ struct tlv_extra *msg_tlv_append(struct ptp_message *msg, int length); /** * Place a TLV descriptor into a message's list of TLVs. * * @param msg A message obtained using msg_allocate(). * @param extra The TLV to be added to the list. */ void msg_tlv_attach(struct ptp_message *msg, struct tlv_extra *extra); /* * Return the number of TLVs attached to a message. * @param msg A message obtained using @ref msg_allocate(). * @return The number of attached TLVs. */ int msg_tlv_count(struct ptp_message *msg); /** * Obtain the transportSpecific field from a message. * @param m Message to test. * @return The value of the transportSpecific field. Note that the * value is returned unshifted, in the upper nibble. */ static inline UInteger8 msg_transport_specific(struct ptp_message *m) { return m->header.tsmt & 0xf0; } /** * Obtain the message type. * @param m Message to test. * @return The value of the messageType field. */ static inline int msg_type(struct ptp_message *m) { return m->header.tsmt & 0x0f; } /** * Allocate a new message instance. * * Messages are reference counted, and newly allocated messages have a * reference count of one. Allocated messages are freed using the * function @ref msg_put(). * * @return Pointer to a message on success, NULL otherwise. */ struct ptp_message *msg_allocate(void); /** * Release all of the memory in the message cache. */ void msg_cleanup(void); /** * Duplicate a message instance. * * This function accepts a message in network byte order and returns a * duplicate in host byte. * * Messages are reference counted, and newly allocated messages have a * reference count of one. Allocated messages are freed using the * function @ref msg_put(). * * @param msg A message obtained using @ref msg_allocate(). * The passed message must be in network byte order, not * having been passed to @ref msg_post_recv(). * * @return Pointer to a message on success, NULL otherwise. * The returned message will be in host byte order, having * been passed to @ref msg_post_recv(). */ struct ptp_message *msg_duplicate(struct ptp_message *msg, int cnt); /** * Obtain a reference to a message, increasing its reference count by one. * @param m A message obtained using @ref msg_allocate(). */ void msg_get(struct ptp_message *m); /** * Process messages after reception. * @param m A message obtained using @ref msg_allocate(). * @param cnt The size of 'm' in bytes. * @return Zero on success, non-zero if the message is invalid. */ int msg_post_recv(struct ptp_message *m, int cnt); /** * Prepare messages for transmission. * @param m A message obtained using @ref msg_allocate(). * @return Zero on success, non-zero if the message is invalid. */ int msg_pre_send(struct ptp_message *m); /** * Print messages for debugging purposes. * @param type Value of the messageType field as returned by @ref msg_type(). * @return String describing the message type. */ const char *msg_type_string(int type); /** * Print messages for debugging purposes. * @param m A message obtained using @ref msg_allocate(). * @param fp An open file pointer. */ void msg_print(struct ptp_message *m, FILE *fp); /** * Release a reference to a message, decreasing its reference count by one. * @param m A message obtained using @ref msg_allocate(). */ void msg_put(struct ptp_message *m); /** * Test whether an event message received a valid SO_TIMESTAMPING time stamp. * @param m Message to test. * @return One if the message is an event without a time stamp, zero otherwise. */ int msg_sots_missing(struct ptp_message *m); /** * Test whether a message has a valid SO_TIMESTAMPING time stamp. * @param m Message to test. * @return One if the message has a valid time stamp, zero otherwise. */ static inline int msg_sots_valid(struct ptp_message *m) { return !tmv_is_zero(m->hwts.ts); } /** * Test whether a message is a unicast message. * @param m Message to test. * @return One if the message is unicast, zero otherwise. */ static inline Boolean msg_unicast(struct ptp_message *m) { return field_is_set(m, 0, UNICAST); } /** * Work around buggy 802.1AS switches. */ extern int assume_two_step; /** * Test whether a message is one-step message. * @param m Message to test. * @return One if the message is a one-step, zero otherwise. */ static inline Boolean one_step(struct ptp_message *m) { if (assume_two_step) return 0; return !field_is_set(m, 0, TWO_STEP); } /** * Convert a 64 bit word into network byte order. */ int64_t host2net64(int64_t val); /** * Convert a 64 bit word into host byte order. */ int64_t net2host64(int64_t val); #endif