|
|
/* $OpenBSD: ntp_msg.c,v 1.1 2004/06/02 10:08:59 henning Exp $ */
|
|
|
|
|
|
/*
|
|
|
* Copyright (c) 2003, 2004 Henning Brauer <henning@openbsd.org>
|
|
|
* Copyright (c) 2004 Alexander Guy <alexander.guy@andern.org>
|
|
|
*
|
|
|
* Permission to use, copy, modify, and distribute this software for any
|
|
|
* purpose with or without fee is hereby granted, provided that the above
|
|
|
* copyright notice and this permission notice appear in all copies.
|
|
|
*
|
|
|
* THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
|
|
|
* WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
|
|
|
* MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
|
|
|
* ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
|
|
|
* WHATSOEVER RESULTING FROM LOSS OF MIND, USE, DATA OR PROFITS, WHETHER
|
|
|
* IN AN ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING
|
|
|
* OUT OF OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
|
|
|
*/
|
|
|
|
|
|
#include <sys/param.h>
|
|
|
#include <stdlib.h>
|
|
|
#include <string.h>
|
|
|
#include <unistd.h>
|
|
|
|
|
|
#include "ntpd.h"
|
|
|
#include "ntp.h"
|
|
|
|
|
|
int
|
|
|
ntp_getmsg(char *p, ssize_t len, struct ntp_msg *msg)
|
|
|
{
|
|
|
int auth, i;
|
|
|
|
|
|
if (len == NTP_MSGSIZE)
|
|
|
auth = 1;
|
|
|
else if (len == NTP_MSGSIZE_NOAUTH)
|
|
|
auth = 0;
|
|
|
else {
|
|
|
log_warnx("malformed packet received");
|
|
|
return (-1);
|
|
|
}
|
|
|
|
|
|
memcpy(&msg->status, p, sizeof(msg->status));
|
|
|
p += sizeof(msg->status);
|
|
|
memcpy(&msg->stratum, p, sizeof(msg->stratum));
|
|
|
p += sizeof(msg->stratum);
|
|
|
memcpy(&msg->ppoll, p, sizeof(msg->ppoll));
|
|
|
p += sizeof(msg->ppoll);
|
|
|
memcpy(&msg->precision, p, sizeof(msg->precision));
|
|
|
p += sizeof(msg->precision);
|
|
|
memcpy(&msg->distance.int_part, p, sizeof(msg->distance.int_part));
|
|
|
p += sizeof(msg->distance.int_part);
|
|
|
memcpy(&msg->distance.fraction, p, sizeof(msg->distance.fraction));
|
|
|
p += sizeof(msg->distance.fraction);
|
|
|
memcpy(&msg->dispersion.int_part, p, sizeof(msg->dispersion.int_part));
|
|
|
p += sizeof(msg->dispersion.int_part);
|
|
|
memcpy(&msg->dispersion.fraction, p, sizeof(msg->dispersion.fraction));
|
|
|
p += sizeof(msg->dispersion.fraction);
|
|
|
memcpy(&msg->refid, p, sizeof(msg->refid));
|
|
|
p += sizeof(msg->refid);
|
|
|
memcpy(&msg->reftime.int_part, p, sizeof(msg->reftime.int_part));
|
|
|
p += sizeof(msg->reftime.int_part);
|
|
|
memcpy(&msg->reftime.fraction, p, sizeof(msg->reftime.fraction));
|
|
|
p += sizeof(msg->reftime.fraction);
|
|
|
memcpy(&msg->orgtime.int_part, p, sizeof(msg->orgtime.int_part));
|
|
|
p += sizeof(msg->orgtime.int_part);
|
|
|
memcpy(&msg->orgtime.fraction, p, sizeof(msg->orgtime.fraction));
|
|
|
p += sizeof(msg->orgtime.fraction);
|
|
|
memcpy(&msg->rectime.int_part, p, sizeof(msg->rectime.int_part));
|
|
|
p += sizeof(msg->rectime.int_part);
|
|
|
memcpy(&msg->rectime.fraction, p, sizeof(msg->rectime.fraction));
|
|
|
p += sizeof(msg->rectime.fraction);
|
|
|
memcpy(&msg->xmttime.int_part, p, sizeof(msg->xmttime.int_part));
|
|
|
p += sizeof(msg->xmttime.int_part);
|
|
|
memcpy(&msg->xmttime.fraction, p, sizeof(msg->xmttime.fraction));
|
|
|
p += sizeof(msg->xmttime.fraction);
|
|
|
|
|
|
if (auth) {
|
|
|
memcpy(&msg->keyid, p, sizeof(msg->keyid));
|
|
|
p += sizeof(msg->refid);
|
|
|
for (i = 0; i < NTP_DIGESTSIZE; i++) {
|
|
|
memcpy(&msg->digest[i], p, sizeof(msg->digest[i]));
|
|
|
p += sizeof(msg->digest[i]);
|
|
|
}
|
|
|
|
|
|
/* XXX check auth */
|
|
|
}
|
|
|
|
|
|
return (0);
|
|
|
}
|
|
|
|
|
|
int
|
|
|
ntp_sendmsg(int fd, struct sockaddr *sa, struct ntp_msg *msg, ssize_t len,
|
|
|
int auth)
|
|
|
{
|
|
|
char buf[NTP_MSGSIZE];
|
|
|
char *p;
|
|
|
|
|
|
p = buf;
|
|
|
memcpy(p, &msg->status, sizeof(msg->status));
|
|
|
p += sizeof(msg->status);
|
|
|
memcpy(p, &msg->stratum, sizeof(msg->stratum));
|
|
|
p += sizeof(msg->stratum);
|
|
|
memcpy(p, &msg->ppoll, sizeof(msg->ppoll));
|
|
|
p += sizeof(msg->ppoll);
|
|
|
memcpy(p, &msg->precision, sizeof(msg->precision));
|
|
|
p += sizeof(msg->precision);
|
|
|
memcpy(p, &msg->distance.int_part, sizeof(msg->distance.int_part));
|
|
|
p += sizeof(msg->distance.int_part);
|
|
|
memcpy(p, &msg->distance.fraction, sizeof(msg->distance.fraction));
|
|
|
p += sizeof(msg->distance.fraction);
|
|
|
memcpy(p, &msg->dispersion.int_part, sizeof(msg->dispersion.int_part));
|
|
|
p += sizeof(msg->dispersion.int_part);
|
|
|
memcpy(p, &msg->dispersion.fraction, sizeof(msg->dispersion.fraction));
|
|
|
p += sizeof(msg->dispersion.fraction);
|
|
|
memcpy(p, &msg->refid, sizeof(msg->refid));
|
|
|
p += sizeof(msg->refid);
|
|
|
memcpy(p, &msg->reftime.int_part, sizeof(msg->reftime.int_part));
|
|
|
p += sizeof(msg->reftime.int_part);
|
|
|
memcpy(p, &msg->reftime.fraction, sizeof(msg->reftime.fraction));
|
|
|
p += sizeof(msg->reftime.fraction);
|
|
|
memcpy(p, &msg->orgtime.int_part, sizeof(msg->orgtime.int_part));
|
|
|
p += sizeof(msg->orgtime.int_part);
|
|
|
memcpy(p, &msg->orgtime.fraction, sizeof(msg->orgtime.fraction));
|
|
|
p += sizeof(msg->orgtime.fraction);
|
|
|
memcpy(p, &msg->rectime.int_part, sizeof(msg->rectime.int_part));
|
|
|
p += sizeof(msg->rectime.int_part);
|
|
|
memcpy(p, &msg->rectime.fraction, sizeof(msg->rectime.fraction));
|
|
|
p += sizeof(msg->rectime.fraction);
|
|
|
memcpy(p, &msg->xmttime.int_part, sizeof(msg->xmttime.int_part));
|
|
|
p += sizeof(msg->xmttime.int_part);
|
|
|
memcpy(p, &msg->xmttime.fraction, sizeof(msg->xmttime.fraction));
|
|
|
p += sizeof(msg->xmttime.fraction);
|
|
|
|
|
|
if (auth) {
|
|
|
/* XXX */
|
|
|
}
|
|
|
|
|
|
if (sendto(fd, &buf, len, 0, sa, sa->sa_len) != len)
|
|
|
fatal("sendto");
|
|
|
|
|
|
return (0);
|
|
|
}
|
|
|
|
|
|
void
|
|
|
get_ts(struct l_fixedpt *t)
|
|
|
{
|
|
|
struct timeval tv;
|
|
|
|
|
|
gettimeofday(&tv, NULL);
|
|
|
t->int_part = tv.tv_sec + JAN_1970;
|
|
|
t->fraction = ((float)tv.tv_usec)/1000000 * UINT_MAX;
|
|
|
}
|