ntp(network time protocol)

#include <string.h> #include <stdlib.h> #include "lwiplib.h" #include "lwip/tcp.h" #include "lwip/netdb.h" #include "ntp_task.h" #define NTP_SYNC_INTERVAL (5*1000) #define NTP_RECV_TIMEOUT_SEC 1 #define NTP_RECV_TIMEOUT_MS (NTP_RECV_TIMEOUT_SEC*1000) #define NTP_PORT 123 /* Local port to listen for UDP packets */ #define NTP_PACKET_SIZE 48 /* NTP time stamp is in the first 48 bytes of the message */ #define LOCAL_ADDRESS 0xFFFFFFFF /* "255.255.255.255" */ #define LOCAL_PORT 7890 /* Local port to listen for UDP packets */ #define GMT_TIME_SERVER_HOST "pool.ntp.org" #define KR_TIME_SERVER_HOST "kr.pool.ntp.org" #define TIMEZONE_SEOUL 9 #define RECV_PACKET_MAX 100 #define SECS_OF_MIN 60 #define SECS_OF_HOUR (60*SECS_OF_MIN) #define SECS_OF_DAY (24*SECS_OF_HOUR) #define SECS_OF_YEAR (365*SECS_OF_DAY) #define SECS_OF_1970 (2208988800UL) //static xSemaphoreHandle ntp_sem; static uint32_t ntp_server_ip = 0; static struct hostent* host_ip=NULL; static int8_t ntp_query_packet [NTP_PACKET_SIZE]; static uint8_t recv_buffer[RECV_PACKET_MAX]; uint8_t days_of_month[] ={31, 28, 31, 30, 31, 30, 31, 31, 30, 31, 30, 31}; //static date_time_t seoul_time = {0,}; static uint32_t synced_gmt_time_secs=0, synced_device_time_secs=0; static uint8_t sync_sleep = 0; static uint32_t sleep_time = NTP_SYNC_INTERVAL; extern uint8_t dhcp_done; extern uint32_t local_ip_addr; void convert_time(uint32_t gmt_since_1900_time, int8_t diff_hour/*timezone*/, date_time_t* dt) { /* Now convert NTP time into everyday time. * Unix time starts on Jan 1 1970. In seconds, that's 2208988800. * Subtract seventy years. */ int year, month, day, hour, min, sec; int leap_year_count=0, days_from_this_year; //a number of leap year uint32_t secsSince1900 = gmt_since_1900_time+(SECS_OF_HOUR*diff_hour); uint32_t epoch = (secsSince1900 > SECS_OF_1970) ? (secsSince1900 - SECS_OF_1970) : secsSince1900; /* Print the hour, minute and second. * GMT is the time at Greenwich Meridian. */ year = 1900+(secsSince1900/SECS_OF_YEAR); leap_year_count = ((secsSince1900/SECS_OF_YEAR)/4); days_from_this_year = ((secsSince1900 % SECS_OF_YEAR) / SECS_OF_DAY)-leap_year_count; if((secsSince1900%SECS_OF_YEAR) > 0){ days_from_this_year++; } if((year%4)==0){ days_of_month[1] = 29; } printf("convert_time - epoch(%lu), secsSince1900(%lu), days_of_year(%d)\r\n", epoch, secsSince1900, days_from_this_year); for(month=0; month<sizeof(days_of_month); month++){ if(days_from_this_year > days_of_month[month]){ days_from_this_year -= days_of_month[month]; }else{ break; } } month++; day = days_from_this_year; hour = (epoch % SECS_OF_DAY) / SECS_OF_HOUR; /* hour (86400 equals secs per day) */ min = (epoch % SECS_OF_HOUR) / SECS_OF_MIN; /* minute (3600 equals secs per minute) */ sec = epoch % SECS_OF_MIN; /* second */ if(dt){ dt->year = year; dt->month = month; dt->day = day; dt->hour = hour; dt->min = min; dt->sec = sec; } } void get_local_time(date_time_t* dt) { if(dt){ get_local_time_ntp_sync_sleep(dt); //memcpy(dt, &seoul_time, sizeof(seoul_time)); printf("get_local_time sync_sleep(%d) - %04d/%02d/%02d - %02d:%02d:%02d\r\n", sync_sleep, dt->year, dt->month, dt->day, dt->hour, dt->min, dt->sec); } } void get_local_time_ntp_sync_sleep(date_time_t* dt) { if(dt){ date_time_t local_time = {0,}; uint32_t sys_now_secs = (get_sys_now()/1000); uint32_t cur_time_secs = synced_gmt_time_secs+(sys_now_secs-synced_device_time_secs); //printf("get_local_time_ntp_sync_sleep - synced_gmt_time_secs(%lu), synced_device_time_secs(%lu), sys_now(%lu)\r\n", synced_gmt_time_secs, synced_device_time_secs, sys_now_secs); convert_time(cur_time_secs, TIMEZONE_SEOUL, dt); //printf("get_local_time_ntp_sync_sleep - %04d/%02d/%02d - %02d:%02d:%02d\r\n", dt->year, dt->month, dt->day, dt->hour, dt->min, dt->sec); } } /* * Send an NTP request to the time server at the given address. */ static void fill_ntp_request (char *buffer, int buff_size) { /* Set all bytes in the buffer to 0. */ memset (buffer, 0, buff_size); buffer[0] = '\x1b'; /* time query */ /* / * Initialize values needed to form NTP request * (see URL above for details on the packets). * / buffer[0] = 0b11100011; / * LI, Version, Mode * / buffer[1] = 0; / * Stratum, or type of clock * / buffer[2] = 6; / * Polling Interval * / buffer[3] = 0xEC; / * Peer Clock Precision * / / * 8 bytes of zero for Root Delay & Root Dispersion. * / buffer[12] = 49; buffer[13] = 0x4E; buffer[14] = 49; buffer[15] = 52; */ } uint8_t sync_time(void) { int udp_socket = -1; struct sockaddr_in ntp_sock_addr; int opt_reuse_addr = 1; #if LWIP_SO_SNDRCVTIMEO_NONSTANDARD int timeout = NTP_RECV_TIMEOUT_MS; #else struct timeval timeout = {.tv_sec=NTP_RECV_TIMEOUT_SEC, .tv_usec=0}; #endif int ret=0; uint32_t secsSince1900=0; socklen_t sock_addr_size = sizeof(ntp_sock_addr); printf("sync_time() dhcp_done(%d)\r\n", dhcp_done); if(dhcp_done){ if(ntp_server_ip==0){ host_ip = lwip_gethostbyname(GMT_TIME_SERVER_HOST); if(host_ip!=NULL){ ip_addr_t *ip = (ip_addr_t*)host_ip->h_addr_list[0]; ntp_server_ip = ip->addr; printf("ntp_task - ntp_server_ip=0x%08x, %s\r\n", ntp_server_ip, ip_ntoa(ip)); }else{ return 0; } } udp_socket = socket(AF_INET, SOCK_DGRAM, IPPROTO_UDP); if (udp_socket < 0) { printf("ntp_task - socket creation failed.\r\n"); return 0; } opt_reuse_addr = 1; if (setsockopt(udp_socket, SOL_SOCKET, SO_REUSEADDR, (const void *)&opt_reuse_addr, sizeof(opt_reuse_addr)) != 0){ printf("ntp_task - setsockopt SO_REUSEADDR failed.\r\n"); close(udp_socket); udp_socket = -1; return 0; } if(setsockopt(udp_socket, SOL_SOCKET, SO_RCVTIMEO, (const void *)&timeout, sizeof(timeout)) != 0){ printf("ntp_task - setsockopt SO_RCVTIMEO failed.\r\n"); close(udp_socket); udp_socket = -1; return 0; } /* Initialize default socket address structure. */ ntp_sock_addr.sin_family = AF_INET; ntp_sock_addr.sin_addr.s_addr = local_ip_addr; //htonl(LOCAL_ADDRESS); //set local ip address ntp_sock_addr.sin_port = htons(LOCAL_PORT); if (bind(udp_socket, (const struct sockaddr*)&ntp_sock_addr, sock_addr_size) != 0){ printf("ntp_task - socket bind failed.\r\n"); close(udp_socket); udp_socket = -1; return 0; } //printf("ntp_task - bind OK. local ip(0x%08x), sock_addr_size=%d\r\n", local_ip_addr, sock_addr_size); /*Send an NTP time query to the NTP server*/ /* Initialize default socket address structure. */ ntp_sock_addr.sin_family = AF_INET; ntp_sock_addr.sin_addr.s_addr = ntp_server_ip; ntp_sock_addr.sin_port = htons(NTP_PORT); if(connect(udp_socket, (struct sockaddr *)&ntp_sock_addr, sock_addr_size) != 0){ printf("ntp_task - socket connect failed.\r\n"); close(udp_socket); udp_socket = -1; return 0; } //printf("ntp_task - connect OK.\r\n"); if((ret=sendto(udp_socket, (int8_t *)&ntp_query_packet, sizeof(ntp_query_packet), 0, (struct sockaddr *)&ntp_sock_addr, sock_addr_size)) < 0){ printf("ntp_task - request query failed. server addr(0x%08x), ret(%d)\r\n", ntp_sock_addr.sin_addr.s_addr, ret); close(udp_socket); udp_socket = -1; return 0; } //printf("ntp_task - query sent. (%d), sock_addr_size=%d\r\n", ret, sock_addr_size); memset(recv_buffer, 0, RECV_PACKET_MAX); if((ret = recvfrom(udp_socket, recv_buffer, RECV_PACKET_MAX, 0, (struct sockaddr *)&ntp_sock_addr, &sock_addr_size)) > 0){ secsSince1900 = (uint32_t)(recv_buffer[40] << 24) | (uint32_t)(recv_buffer[41] << 16) | (uint32_t)(recv_buffer[42] << 8) | (uint32_t)recv_buffer[43]; synced_gmt_time_secs = secsSince1900; synced_device_time_secs = (get_sys_now()/1000); //convert_time(secsSince1900, TIMEZONE_SEOUL, &seoul_time); printf("ntp_task - synced_gmt_time_secs(%lu), synced_device_time_secs(%lu)\r\n", synced_gmt_time_secs, synced_device_time_secs); } close(udp_socket); udp_socket = -1; return 1; } return 0; } /** * \brief http main function. */ void ntp_task(void *argument) { //vSemaphoreCreateBinary(ntp_sem); //xSemaphoreTake(ntp_sem, portMAX_DELAY); fill_ntp_request(ntp_query_packet, NTP_PACKET_SIZE); printf("ntp_task - started.\r\n"); while(1){ //xSemaphoreTake(ntp_sem, portMAX_DELAY); sync_sleep = 0; if(sync_time()){ sleep_time = NTP_SYNC_INTERVAL; sync_sleep = 1; }else{ sleep_time = 200; } //printf("ntp_task - sleep(%lu ms)\r\n", sleep_time); vTaskDelay(sleep_time); } }