OpenWrt_Luci_Lua/1_6.h12_dev/ntp/timesync/client.c

#include <stdio.h>
#include <stdlib.h>
#include <stdint.h>
#include <unistd.h>
#include <sys/time.h> /* gettimeofday() */
#include <sys/types.h>
#include <sys/socket.h>
#include <netdb.h>
#include <netinet/in.h>
#include <arpa/inet.h>

#include <time.h> /* for time() and ctime() */

/*
 * rfc1305<EFBFBD><EFBFBD>ntpʱ<EFBFBD><EFBFBD><EFBFBD>У<EFBFBD>ʱ<EFBFBD><EFBFBD>Ϊ64bit<EFBFBD><EFBFBD><EFBFBD><EFBFBD>¼1900<EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>utc<EFBFBD><EFBFBD>ʽ<EFBFBD><EFBFBD>
 * <EFBFBD><EFBFBD>32λ<EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>֣<EFBFBD><EFBFBD><EFBFBD>32λ<EFBFBD><EFBFBD>С<EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>*/
#define UTC_NTP 2208988800U /* 1970 - 1900 */

/* get Timestamp for NTP in LOCAL ENDIAN */
void gettime64(uint32_t ts[])
{
	struct timeval tv;
	gettimeofday(&tv, NULL);

	ts[0] = tv.tv_sec + UTC_NTP;
	ts[1] = (4294*(tv.tv_usec)) + ((1981*(tv.tv_usec))>>11);
}

int die(const char *msg)
{
	fputs(msg, stderr);
	exit(-1);
}

int useage(const char *path)
{
	printf("Useage:\n\t%s <server address>\n", path);
	return 1;
}


//<2F><>ʼ<EFBFBD><CABC><EFBFBD>ӷ<EFBFBD><D3B7><EFBFBD><EFBFBD><EFBFBD>
int open_connect(const char* server)
{
	int s;
	struct addrinfo *saddr;

	/* printf("Connecting to server: %s\n", server); */
	s = socket(AF_INET, SOCK_DGRAM, 0);
	if (s == -1) {
		die("Can not create socket.\n");
	}

	if (0 != getaddrinfo(server, "123", NULL, &saddr)) {
		die("Server address not correct.\n");
	}

	if (connect(s, saddr->ai_addr, saddr->ai_addrlen) != 0) {
		die("Connect error\n");
	}

	freeaddrinfo(saddr);

	return s;
}

//<2F><><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
void request(int fd)
{
	unsigned char buf[48] = {0};
	uint32_t tts[2]; /* Transmit Timestamp */

	/* LI VN MODE = 00 100 011*/
    /* MODE<44><45>3<EFBFBD><33>ʾ<EFBFBD>ͻ<EFBFBD>ģʽ<C4A3><CABD>4<EFBFBD><34>ʾ<EFBFBD><CABE><EFBFBD><EFBFBD><EFBFBD><EFBFBD>ģʽ*/
	buf[0] = 0x23;

	gettime64(tts);
    //<2F>˴<EFBFBD><CBB4><EFBFBD>Originate Timestamp<6D><70><EFBFBD><EFBFBD><EFBFBD><EFBFBD>Transmit Timestamp<6D><70>
	(*(uint32_t *)&buf[40]) = htonl(tts[0]);
	(*(uint32_t *)&buf[44])= htonl(tts[1]);
	if (send(fd, buf, 48, 0) !=48 ) {
		die("Send error\n");
	}
}

//<2F><><EFBFBD><EFBFBD>NTPӦ<50><D3A6><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
void get_reply(int fd)
{
	unsigned char buf[48];
	uint32_t *pt;
	// uint32_t t_last_update[2]; /* Reference Timestamp @ Server */
	uint32_t t1[2]; /* t1 = Originate Timestamp,<2C><>NTP<54><50><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>뿪<EFBFBD><EBBFAA><EFBFBD>Ͷ<EFBFBD>ʱ<EFBFBD><CAB1><EFBFBD>Ͷ˵ı<CBB5><C4B1><EFBFBD>ʱ<EFBFBD><CAB1>  */
	uint32_t t2[2]; /* t2 = Receive Timestamp @ Server,<2C><>NTP<54><50><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>ĵ<EFBFBD><C4B5><EFBFBD><EFBFBD><EFBFBD><EFBFBD>ն<EFBFBD>ʱ<EFBFBD><CAB1><EFBFBD>ն˵ı<CBB5><C4B1><EFBFBD>ʱ<EFBFBD><CAB1> */
	uint32_t t3[2]; /* t3 = Transmit Timestamp @ Server,<2C><>Ӧ<EFBFBD><D3A6><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>뿪Ӧ<EBBFAA><D3A6><EFBFBD><EFBFBD>ʱӦ<CAB1><D3A6><EFBFBD>ߵı<DFB5><C4B1><EFBFBD>ʱ<EFBFBD><CAB1> */
	uint32_t t4[2]; /* t4 = Receive Timestamp @ Client */
	double T1, T2, T3, T4;
	double tfrac = 4294967296.0;
	time_t curr_time;
	time_t diff_sec;

	if (recv(fd, buf, 48, 0) < 48) {
		die("Receive error\n");
	}
	gettime64(t4);
	pt = (uint32_t *)&buf[24];

	t1[0] = htonl(*pt++);
	t1[1] = htonl(*pt++);

	t2[0] = htonl(*pt++);
	t2[1] = htonl(*pt++);

	t3[0] = htonl(*pt++);
	t3[1] = htonl(*pt++);

	/* t1 = Transmit Timestamp @ Client */
	/* 
	 * (Version=4, Mode=Server,
	 * 	Stratum = 0-15, etc.)*/

	T1 = t1[0] + t1[1]/tfrac;
	T2 = t2[0] + t2[1]/tfrac;
	T3 = t3[0] + t3[1]/tfrac;
	T4 = t4[0] + t4[1]/tfrac;

    //delay<61><79>NTP<54><50><EFBFBD>ĵ<EFBFBD><C4B5><EFBFBD><EFBFBD><EFBFBD>ʱ<EFBFBD><CAB1>
    //offset<65><74>client<6E><74>server<65><72>ʱ<EFBFBD><CAB1><EFBFBD><EFBFBD>
	printf( "\ndelay = %lf\n"
		"offset = %lf\n\n",
		(T4-T1) - (T3-T2),
		((T2 - T1) + (T3 - T4)) /2
	      );

	diff_sec = ((int32_t)(t2[0] - t1[0]) + (int32_t)(t3[0] - t4[0])) /2;
	curr_time = time(NULL) - diff_sec;
	printf("Current Time at Server:   %s\n", ctime(&curr_time));
	printf("Current TimeStamp at Server:   %d\n", (int)curr_time);
}

int client(const char* server)
{
	int fd;

	fd = open_connect(server);
	request(fd);
	get_reply(fd);
	close(fd);

	return 0;
}


int main(int argc, char *argv[], char **env)
{
    while(1)
    {
        if (argc < 2) 
        {
            return useage(argv[0]);
        }
        //return client(argv[1]);
        client(argv[1]);
        sleep(3);
    }
}