linuxptp源代码

/** * @file port.c * @note Copyright (C) 2011 Richard Cochran <richardcochran@gmail.com> * * 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. */ #include <arpa/inet.h> #include <errno.h> #include <malloc.h> #include <stdlib.h> #include <string.h> #include <unistd.h> #include <sys/queue.h> #include <net/if.h> #include "bmc.h" #include "clock.h" #include "filter.h" #include "missing.h" #include "msg.h" #include "phc.h" #include "port.h" #include "print.h" #include "rtnl.h" #include "sk.h" #include "tlv.h" #include "tmv.h" #include "tsproc.h" #include "util.h" #define ALLOWED_LOST_RESPONSES 3 #define ANNOUNCE_SPAN 1 enum syfu_state { SF_EMPTY, SF_HAVE_SYNC, SF_HAVE_FUP, }; enum syfu_event { SYNC_MISMATCH, SYNC_MATCH, FUP_MISMATCH, FUP_MATCH, }; enum link_state { LINK_DOWN = (1<<0), LINK_UP = (1<<1), LINK_STATE_CHANGED = (1<<3), TS_LABEL_CHANGED = (1<<4), }; struct nrate_estimator { double ratio; tmv_t origin1; tmv_t ingress1; unsigned int max_count; unsigned int count; int ratio_valid; }; struct port { LIST_ENTRY(port) list; char *name; struct interface *iface; struct clock *clock; struct transport *trp; enum timestamp_type timestamping; struct fdarray fda; int fault_fd; int phc_index; int jbod; struct foreign_clock *best; enum syfu_state syfu; struct ptp_message *last_syncfup; TAILQ_HEAD(delay_req, ptp_message) delay_req; struct ptp_message *peer_delay_req; struct ptp_message *peer_delay_resp; struct ptp_message *peer_delay_fup; int peer_portid_valid; struct PortIdentity peer_portid; struct { UInteger16 announce; UInteger16 delayreq; UInteger16 sync; } seqnum; tmv_t peer_delay; struct tsproc *tsproc; int log_sync_interval; struct nrate_estimator nrate; unsigned int pdr_missing; unsigned int multiple_seq_pdr_count; unsigned int multiple_pdr_detected; enum port_state (*state_machine)(enum port_state state, enum fsm_event event, int mdiff); /* portDS */ struct PortIdentity portIdentity; enum port_state state; /*portState*/ Integer64 asymmetry; int asCapable; Integer8 logMinDelayReqInterval; TimeInterval peerMeanPathDelay; Integer8 logAnnounceInterval; UInteger8 announceReceiptTimeout; int announce_span; UInteger8 syncReceiptTimeout; UInteger8 transportSpecific; Integer8 logSyncInterval; Enumeration8 delayMechanism; Integer8 logMinPdelayReqInterval; UInteger32 neighborPropDelayThresh; int follow_up_info; int freq_est_interval; int hybrid_e2e; int match_transport_specific; int min_neighbor_prop_delay; int net_sync_monitor; int path_trace_enabled; Integer64 rx_timestamp_offset; Integer64 tx_timestamp_offset; enum link_state link_status; struct fault_interval flt_interval_pertype[FT_CNT]; enum fault_type last_fault_type; unsigned int versionNumber; /*UInteger4*/ /* foreignMasterDS */ LIST_HEAD(fm, foreign_clock) foreign_masters; }; #define portnum(p) (p->portIdentity.portNumber) #define NSEC2SEC 1000000000LL static void flush_delay_req(struct port *p); static int port_capable(struct port *p); static int port_is_ieee8021as(struct port *p); static void port_nrate_initialize(struct port *p); static int announce_compare(struct ptp_message *m1, struct ptp_message *m2) { struct announce_msg *a = &m1->announce, *b = &m2->announce; int len = sizeof(a->grandmasterPriority1) + sizeof(a->grandmasterClockQuality) + sizeof(a->grandmasterPriority2) + sizeof(a->grandmasterIdentity) + sizeof(a->stepsRemoved); return memcmp(&a->grandmasterPriority1, &b->grandmasterPriority1, len); } static void announce_to_dataset(struct ptp_message *m, struct port *p, struct dataset *out) { struct announce_msg *a = &m->announce; out->priority1 = a->grandmasterPriority1; out->identity = a->grandmasterIdentity; out->quality = a->grandmasterClockQuality; out->priority2 = a->grandmasterPriority2; out->stepsRemoved = a->stepsRemoved; out->sender = m->header.sourcePortIdentity; out->receiver = p->portIdentity; } static int clear_fault_asap(struct fault_interval *faint) { switch (faint->type) { case FTMO_LINEAR_SECONDS: return faint->val == 0 ? 1 : 0; case FTMO_LOG2_SECONDS: return faint->val == FRI_ASAP ? 1 : 0; case FTMO_CNT: return 0; } return 0; } static void extract_address(struct ptp_message *m, struct PortAddress *paddr) { int len = 0; switch (paddr->networkProtocol) { case TRANS_UDP_IPV4: len = sizeof(m->address.sin.sin_addr.s_addr); memcpy(paddr->address, &m->address.sin.sin_addr.s_addr, len); break; case TRANS_UDP_IPV6: len = sizeof(m->address.sin6.sin6_addr.s6_addr); memcpy(paddr->address, &m->address.sin6.sin6_addr.s6_addr, len); break; case TRANS_IEEE_802_3: len = MAC_LEN; memcpy(paddr->address, &m->address.sll.sll_addr, len); break; default: return; } paddr->addressLength = len; } static int msg_current(struct ptp_message *m, struct timespec now) { int64_t t1, t2, tmo; t1 = m->ts.host.tv_sec * NSEC2SEC + m->ts.host.tv_nsec; t2 = now.tv_sec * NSEC2SEC + now.tv_nsec; if (m->header.logMessageInterval < -63) { tmo = 0; } else if (m->header.logMessageInterval > 31) { tmo = INT64_MAX; } else if (m->header.logMessageInterval < 0) { tmo = 4LL * NSEC2SEC / (1 << -m->header.logMessageInterval); } else { tmo = 4LL * (1 << m->header.logMessageInterval) * NSEC2SEC; } return t2 - t1 < tmo; } static int msg_source_equal(struct ptp_message *m1, struct foreign_clock *fc) { struct PortIdentity *id1, *id2; id1 = &m1->header.sourcePortIdentity; id2 = &fc->dataset.sender; return 0 == memcmp(id1, id2, sizeof(*id1)); } static int pid_eq(struct PortIdentity *a, struct PortIdentity *b) { return 0 == memcmp(a, b, sizeof(*a)); } static int source_pid_eq(struct ptp_message *m1, struct ptp_message *m2) { return pid_eq(&m1->header.sourcePortIdentity, &m2->header.sourcePortIdentity); } enum fault_type last_fault_type(struct port *port) { return port->last_fault_type; } void fault_interval(struct port *port, enum fault_type ft, struct fault_interval *i) { i->type = port->flt_interval_pertype[ft].type; i->val = port->flt_interval_pertype[ft].val; } int port_fault_fd(struct port *port) { return port->fault_fd; } struct fdarray *port_fda(struct port *port) { return &port->fda; } int set_tmo_log(int fd, unsigned int scale, int log_seconds) { struct itimerspec tmo = { {0, 0}, {0, 0} }; uint64_t ns; int i; if (log_seconds < 0) { log_seconds *= -1; for (i = 1, ns = scale * 500000000ULL; i < log_seconds; i++) { ns >>= 1; } tmo.it_value.tv_nsec = ns; while (tmo.it_value.tv_nsec >= NS_PER_SEC) { tmo.it_value.tv_nsec -= NS_PER_SEC; tmo.it_value.tv_sec++; } } else tmo.it_value.tv_sec = scale * (1 << log_seconds); return timerfd_settime(fd, 0, &tmo, NULL); } int set_tmo_lin(int fd, int seconds) { struct itimerspec tmo = { {0, 0}, {0, 0} }; tmo.it_value.tv_sec = seconds; return timerfd_settime(fd, 0, &tmo, NULL); } int set_tmo_random(int fd, int min, int span, int log_seconds) { uint64_t value_