URL
https://opencores.org/ocsvn/or1k/or1k/trunk
Subversion Repositories or1k
[/] [or1k/] [trunk/] [rtems-20020807/] [cpukit/] [libnetworking/] [lib/] [rtems_bsdnet_ntp.c] - Rev 1774
Go to most recent revision | Compare with Previous | Blame | View Log
/* * Synchronize with an NTP server * * This program may be distributed and used for any purpose. * I ask only that you: * 1. Leave this author information intact. * 2. Document any changes you make. * * W. Eric Norum * Canadian Light Source * University of Saskatchewan * Saskatoon, Saskatchewan, CANADA * eric@cls.usask.ca * * rtems_bsdnet_ntp.c,v 1.5 2001/04/24 21:02:03 joel Exp */ #include <stdio.h> #include <string.h> #include <errno.h> #include <time.h> #include <limits.h> #include <rtems.h> #include <rtems/rtems_bsdnet.h> #include <rtems/error.h> #include <sys/types.h> #include <sys/socket.h> #include <netinet/in.h> /* * RTEMS base: 1988, January 1 * UNIX base: 1970, January 1 * NTP base: 1900, January 1 */ #define UNIX_BASE_TO_NTP_BASE (((70UL*365UL)+17UL) * (24*60*60)) struct timestamp { rtems_unsigned32 integer; rtems_unsigned32 fraction; }; struct ntpPacketSmall { rtems_unsigned8 li_vn_mode; rtems_unsigned8 stratum; rtems_signed8 poll_interval; rtems_signed8 precision; rtems_signed32 root_delay; rtems_signed32 root_dispersion; char reference_identifier[4]; struct timestamp reference_timestamp; struct timestamp originate_timestamp; struct timestamp receive_timestamp; struct timestamp transmit_timestamp; }; struct ntpPacket { struct ntpPacketSmall ntp; char authenticator[96]; }; static int processPacket (struct ntpPacketSmall *p) { time_t tbuf; struct tm *lt; rtems_time_of_day rt; rtems_interval ticks_per_second; if (((p->li_vn_mode & (0x7 << 3)) != (3 << 3)) || ((p->transmit_timestamp.integer == 0) && (p->transmit_timestamp.fraction == 0))) return 0; rtems_clock_get (RTEMS_CLOCK_GET_TICKS_PER_SECOND, &ticks_per_second); tbuf = ntohl (p->transmit_timestamp.integer) - UNIX_BASE_TO_NTP_BASE - rtems_bsdnet_timeoffset; lt = gmtime (&tbuf); rt.year = lt->tm_year + 1900; rt.month = lt->tm_mon + 1; rt.day = lt->tm_mday; rt.hour = lt->tm_hour; rt.minute = lt->tm_min; rt.second = lt->tm_sec; rt.ticks = ntohl (p->transmit_timestamp.fraction) / (ULONG_MAX / ticks_per_second); if (rt.ticks >= ticks_per_second) rt.ticks = ticks_per_second - 1; rtems_clock_set (&rt); return 1; } static int tryServer (int i, int s) { int l; struct timeval tv; int farlen; struct sockaddr_in farAddr; struct ntpPacketSmall packet; if (i < 0) tv.tv_sec = 80; else tv.tv_sec = 5; tv.tv_usec = 0; if (setsockopt (s, SOL_SOCKET, SO_RCVTIMEO, (char *)&tv, sizeof tv) < 0) { printf ("Can't set socket receive timeout: %s\n", strerror (errno)); close (s); return -1; } if (i >= 0) { memset (&farAddr, 0, sizeof farAddr); farAddr.sin_family = AF_INET; farAddr.sin_port = htons (123); farAddr.sin_addr = rtems_bsdnet_ntpserver[i]; memset (&packet, 0, sizeof packet); packet.li_vn_mode = (3 << 3) | 3; /* NTP version 3, client */ l = sendto (s, &packet, sizeof packet, 0, (struct sockaddr *)&farAddr, sizeof farAddr); if (l != sizeof packet) { printf ("Can't send: %s\n", strerror (errno)); return -1; } } farlen = sizeof farAddr; i = recvfrom (s, &packet, sizeof packet, 0, (struct sockaddr *)&farAddr, &farlen); if (i == 0) printf ("Unexpected EOF"); if (i < 0) { if ((errno == EWOULDBLOCK) || (errno == EAGAIN)) return -1; printf ("Can't receive: %s\n", strerror (errno)); } if ((i >= sizeof packet) && processPacket (&packet)) return 0; return -1; } int rtems_bsdnet_synchronize_ntp (int interval, rtems_task_priority priority) { int s; int i; int retry; struct sockaddr_in myAddr; int reuseFlag; int ret; if (interval != 0) { printf ("Daemon-mode note yet supported.\n"); errno = EINVAL; return -1; } s = socket (AF_INET, SOCK_DGRAM, 0); if (s < 0) { printf ("Can't create socket: %s\n", strerror (errno)); return -1; } reuseFlag = 1; if (setsockopt (s, SOL_SOCKET, SO_REUSEADDR, (char *)&reuseFlag, sizeof reuseFlag) < 0) { printf ("Can't set socket reuse: %s\n", strerror (errno)); close (s); return -1; } memset (&myAddr, 0, sizeof myAddr); myAddr.sin_family = AF_INET; myAddr.sin_port = htons (123); myAddr.sin_addr.s_addr = htonl (INADDR_ANY); if (bind (s, (struct sockaddr *)&myAddr, sizeof myAddr) < 0) { printf ("Can't bind socket: %s\n", strerror (errno)); close (s); return -1; } ret = -1; for (retry = 0 ; (ret == -1) && (retry < 5) ; retry++) { /* * If there's no server we just have to wait * and hope that there's an NTP broadcast * server out there somewhere. */ if (rtems_bsdnet_ntpserver_count < 0) { ret = tryServer (-1, s); } else { for (i = 0 ; (ret == -1) && (i < rtems_bsdnet_ntpserver_count) ; i++) { ret = tryServer (i, s); } } } close (s); return ret; }
Go to most recent revision | Compare with Previous | Blame | View Log