/* Receive raw data */
int
recvdata(
SOCKET rsock,
sockaddr_u *sender,
char *rdata,
int rdata_length
)
{
GETSOCKNAME_SOCKLEN_TYPE slen;
int recvc;
#ifdef DEBUG
printf("sntp recvdata: Trying to receive data from...\n");
#endif
slen = sizeof(*sender);
recvc = recvfrom(rsock, rdata, rdata_length, 0,
&sender->sa, &slen);
#ifdef DEBUG
if (recvc > 0) {
printf("Received %d bytes from %s:\n", recvc, stoa(sender));
pkt_output((struct pkt *) rdata, recvc, stdout);
} else {
int saved_errno = errno;
printf("recvfrom error %d (%s)\n", errno, strerror(errno));
errno = saved_errno;
}
#endif
return recvc;
}
/* Send a packet */
void
sendpkt (
SOCKET rsock,
sockaddr_u *dest,
struct pkt *pkt,
int len
)
{
int cc;
#ifdef DEBUG
printf("sntp sendpkt: Packet data:\n");
pkt_output(pkt, len, stdout);
#endif
if (ENABLED_OPT(NORMALVERBOSE)) {
getnameinfo(&dest->sa, SOCKLEN(dest), adr_buf, sizeof(adr_buf), NULL, 0, NI_NUMERICHOST);
printf("sntp sendpkt: Sending packet to %s... ", adr_buf);
}
cc = sendto(rsock, (void *)pkt, len, 0, &dest->sa, SOCKLEN(dest));
if (cc == SOCKET_ERROR) {
#ifdef DEBUG
printf("\n sntp sendpkt: Socket error: %i. Couldn't send packet!\n", cc);
#endif
if (errno != EWOULDBLOCK && errno != ENOBUFS) {
/* oh well */
}
} else if (ENABLED_OPT(NORMALVERBOSE)) {
printf("Packet sent.\n");
}
}
/* Send a packet */
int
sendpkt (
SOCKET rsock,
sockaddr_u *dest,
struct pkt *pkt,
int len
)
{
int cc;
#ifdef DEBUG
if (debug > 2) {
printf("sntp sendpkt: Packet data:\n");
pkt_output(pkt, len, stdout);
}
#endif
TRACE(1, ("sntp sendpkt: Sending packet to %s ...\n",
sptoa(dest)));
cc = sendto(rsock, (void *)pkt, len, 0, &dest->sa,
SOCKLEN(dest));
if (cc == SOCKET_ERROR) {
msyslog(LOG_ERR, "Send to %s failed, %m",
sptoa(dest));
return FALSE;
}
TRACE(1, ("Packet sent.\n"));
return TRUE;
}
/* Send a packet */
int
sendpkt (
SOCKET rsock,
sockaddr_u *dest,
struct pkt *pkt,
int len
)
{
int cc;
#ifdef DEBUG
printf("sntp sendpkt: Packet data:\n");
pkt_output(pkt, len, stdout);
#endif
if (ENABLED_OPT(NORMALVERBOSE)) {
getnameinfo(&dest->sa, SOCKLEN(dest), adr_buf, sizeof(adr_buf), NULL, 0, NI_NUMERICHOST);
printf("sntp sendpkt: Sending packet to %s... ", adr_buf);
}
cc = sendto(rsock, (void *)pkt, len, 0, &dest->sa, SOCKLEN(dest));
if (cc == SOCKET_ERROR) {
printf("\n sntp sendpkt: sendto error: %s. Couldn't send packet!\n", strerror(errno));
return -1;
} else if (ENABLED_OPT(NORMALVERBOSE))
printf("Packet sent.\n");
return 0;
}
/* Receive raw data */
int
recvdata (
SOCKET rsock,
sockaddr_u *sender,
char *rdata,
int rdata_length
)
{
struct timeval timeout_tv = { 0 };
fd_set recv_fd;
GETSOCKNAME_SOCKLEN_TYPE slen;
int recvc;
#ifdef DEBUG
printf("sntp recvdata: Trying to receive data from...\n");
#endif
// Is the socket ready?
FD_ZERO(&recv_fd);
FD_SET(rsock, &recv_fd);
if(ENABLED_OPT(TIMEOUT)) {
timeout_tv.tv_sec = (int) OPT_ARG(TIMEOUT);
} else {
timeout_tv.tv_sec = 15;
}
switch(select(rsock + 1, &recv_fd, 0, 0, &timeout_tv)) {
case 0:
if(ENABLED_OPT(NORMALVERBOSE))
printf("sntp recvdata: select() reached timeout (%u sec), aborting.\n",
(unsigned)timeout_tv.tv_sec);
return SERVER_UNUSEABLE;
case -1:
return SERVER_UNUSEABLE;
default:
slen = sizeof(sender->sas);
recvc = recvfrom(rsock, rdata, rdata_length, 0,
&sender->sa, &slen);
#ifdef DEBUG
if (recvc > 0) {
printf("Received %d bytes from %s:\n", recvc, stoa(sender));
pkt_output((struct pkt *) rdata, recvc, stdout);
} else {
saved_errno = errno;
printf("recvfrom error %d (%s)\n", errno, strerror(errno));
errno = saved_errno;
}
#endif
}
return recvc;
}
void test_PktOutput() {
char * filename = "debug-output-pkt";//CreatePath("debug-output-pkt", OUTPUT_DIR);
InitDebugTest(filename);
struct pkt testpkt;
memset(&testpkt, 0, sizeof(struct pkt));
testpkt.li_vn_mode = PKT_LI_VN_MODE(LEAP_NOWARNING,
NTP_VERSION,
MODE_SERVER);
l_fp test;
test.l_ui = 8;
test.l_uf = 2147483647; // Lots of ones.
HTONL_FP(&test, &testpkt.xmt);
pkt_output(&testpkt, LEN_PKT_NOMAC, outputFile);
FinishDebugTest(CreatePath("debug-input-pkt", INPUT_DIR), filename);
}
/* Receive raw data */
int
recvdata(
SOCKET rsock,
sockaddr_u * sender,
void * rdata,
int rdata_length
)
{
GETSOCKNAME_SOCKLEN_TYPE slen;
int recvc;
slen = sizeof(*sender);
recvc = recvfrom(rsock, rdata, rdata_length, 0,
&sender->sa, &slen);
if (recvc < 0)
return recvc;
#ifdef DEBUG
if (debug > 2) {
printf("Received %d bytes from %s:\n", recvc, sptoa(sender));
pkt_output((struct pkt *)rdata, recvc, stdout);
}
#endif
return recvc;
}
void
offset_calculation (
struct pkt *rpkt,
int rpktl,
struct timeval *tv_dst,
double *offset,
double *precision,
double *root_dispersion
)
{
l_fp p_rec, p_xmt, p_ref, p_org, tmp, dst;
u_fp p_rdly, p_rdsp;
double t21, t34, delta;
/* Convert timestamps from network to host byte order */
p_rdly = NTOHS_FP(rpkt->rootdelay);
p_rdsp = NTOHS_FP(rpkt->rootdisp);
NTOHL_FP(&rpkt->reftime, &p_ref);
NTOHL_FP(&rpkt->org, &p_org);
NTOHL_FP(&rpkt->rec, &p_rec);
NTOHL_FP(&rpkt->xmt, &p_xmt);
*precision = LOGTOD(rpkt->precision);
#ifdef DEBUG
printf("sntp precision: %f\n", *precision);
#endif /* DEBUG */
*root_dispersion = FPTOD(p_rdsp);
#ifdef DEBUG
printf("sntp rootdelay: %f\n", FPTOD(p_rdly));
printf("sntp rootdisp: %f\n", *root_dispersion);
pkt_output(rpkt, rpktl, stdout);
printf("sntp offset_calculation: rpkt->reftime:\n");
l_fp_output(&(rpkt->reftime), stdout);
printf("sntp offset_calculation: rpkt->org:\n");
l_fp_output(&(rpkt->org), stdout);
printf("sntp offset_calculation: rpkt->rec:\n");
l_fp_output(&(rpkt->rec), stdout);
printf("sntp offset_calculation: rpkt->rec:\n");
l_fp_output_bin(&(rpkt->rec), stdout);
printf("sntp offset_calculation: rpkt->rec:\n");
l_fp_output_dec(&(rpkt->rec), stdout);
printf("sntp offset_calculation: rpkt->xmt:\n");
l_fp_output(&(rpkt->xmt), stdout);
#endif
/* Compute offset etc. */
tmp = p_rec;
L_SUB(&tmp, &p_org);
LFPTOD(&tmp, t21);
TVTOTS(tv_dst, &dst);
dst.l_ui += JAN_1970;
tmp = p_xmt;
L_SUB(&tmp, &dst);
LFPTOD(&tmp, t34);
*offset = (t21 + t34) / 2.;
delta = t21 - t34;
if (ENABLED_OPT(NORMALVERBOSE))
printf("sntp offset_calculation:\tt21: %.6f\t\t t34: %.6f\n\t\tdelta: %.6f\t offset: %.6f\n",
t21, t34, delta, *offset);
}
void
offset_calculation(
struct pkt *rpkt,
int rpktl,
struct timeval *tv_dst,
double *offset,
double *precision,
double *synch_distance
)
{
l_fp p_rec, p_xmt, p_ref, p_org, tmp, dst;
u_fp p_rdly, p_rdsp;
double t21, t34, delta;
/* Convert timestamps from network to host byte order */
p_rdly = NTOHS_FP(rpkt->rootdelay);
p_rdsp = NTOHS_FP(rpkt->rootdisp);
NTOHL_FP(&rpkt->reftime, &p_ref);
NTOHL_FP(&rpkt->org, &p_org);
NTOHL_FP(&rpkt->rec, &p_rec);
NTOHL_FP(&rpkt->xmt, &p_xmt);
*precision = LOGTOD(rpkt->precision);
TRACE(3, ("offset_calculation: LOGTOD(rpkt->precision): %f\n", *precision));
/* Compute offset etc. */
tmp = p_rec;
L_SUB(&tmp, &p_org);
LFPTOD(&tmp, t21);
TVTOTS(tv_dst, &dst);
dst.l_ui += JAN_1970;
tmp = p_xmt;
L_SUB(&tmp, &dst);
LFPTOD(&tmp, t34);
*offset = (t21 + t34) / 2.;
delta = t21 - t34;
// synch_distance is:
// (peer->delay + peer->rootdelay) / 2 + peer->disp
// + peer->rootdisp + clock_phi * (current_time - peer->update)
// + peer->jitter;
//
// and peer->delay = fabs(peer->offset - p_offset) * 2;
// and peer->offset needs history, so we're left with
// p_offset = (t21 + t34) / 2.;
// peer->disp = 0; (we have no history to augment this)
// clock_phi = 15e-6;
// peer->jitter = LOGTOD(sys_precision); (we have no history to augment this)
// and ntp_proto.c:set_sys_tick_precision() should get us sys_precision.
//
// so our answer seems to be:
//
// (fabs(t21 + t34) + peer->rootdelay) / 3.
// + 0 (peer->disp)
// + peer->rootdisp
// + 15e-6 (clock_phi)
// + LOGTOD(sys_precision)
INSIST( FPTOD(p_rdly) >= 0. );
#if 1
*synch_distance = (fabs(t21 + t34) + FPTOD(p_rdly)) / 3.
+ 0.
+ FPTOD(p_rdsp)
+ 15e-6
+ 0. /* LOGTOD(sys_precision) when we can get it */
;
INSIST( *synch_distance >= 0. );
#else
*synch_distance = (FPTOD(p_rdly) + FPTOD(p_rdsp))/2.0;
#endif
#ifdef DEBUG
if (debug > 3) {
printf("sntp rootdelay: %f\n", FPTOD(p_rdly));
printf("sntp rootdisp: %f\n", FPTOD(p_rdsp));
printf("sntp syncdist: %f\n", *synch_distance);
pkt_output(rpkt, rpktl, stdout);
printf("sntp offset_calculation: rpkt->reftime:\n");
l_fp_output(&p_ref, stdout);
printf("sntp offset_calculation: rpkt->org:\n");
l_fp_output(&p_org, stdout);
printf("sntp offset_calculation: rpkt->rec:\n");
l_fp_output(&p_rec, stdout);
printf("sntp offset_calculation: rpkt->xmt:\n");
l_fp_output(&p_xmt, stdout);
}
#endif
TRACE(3, ("sntp offset_calculation:\trec - org t21: %.6f\n"
"\txmt - dst t34: %.6f\tdelta: %.6f\toffset: %.6f\n",
t21, t34, delta, *offset));
return;
}
