xref: /minix3/minix/lib/liblwip/dist/src/apps/sntp/sntp.c (revision 5d5fbe79c1b60734f34c69330aec5496644e8651)
1*5d5fbe79SDavid van Moolenbroek /**
2*5d5fbe79SDavid van Moolenbroek  * @file
3*5d5fbe79SDavid van Moolenbroek  * SNTP client module
4*5d5fbe79SDavid van Moolenbroek  */
5*5d5fbe79SDavid van Moolenbroek 
6*5d5fbe79SDavid van Moolenbroek /*
7*5d5fbe79SDavid van Moolenbroek  * Copyright (c) 2007-2009 Frédéric Bernon, Simon Goldschmidt
8*5d5fbe79SDavid van Moolenbroek  * All rights reserved.
9*5d5fbe79SDavid van Moolenbroek  *
10*5d5fbe79SDavid van Moolenbroek  * Redistribution and use in source and binary forms, with or without modification,
11*5d5fbe79SDavid van Moolenbroek  * are permitted provided that the following conditions are met:
12*5d5fbe79SDavid van Moolenbroek  *
13*5d5fbe79SDavid van Moolenbroek  * 1. Redistributions of source code must retain the above copyright notice,
14*5d5fbe79SDavid van Moolenbroek  *    this list of conditions and the following disclaimer.
15*5d5fbe79SDavid van Moolenbroek  * 2. Redistributions in binary form must reproduce the above copyright notice,
16*5d5fbe79SDavid van Moolenbroek  *    this list of conditions and the following disclaimer in the documentation
17*5d5fbe79SDavid van Moolenbroek  *    and/or other materials provided with the distribution.
18*5d5fbe79SDavid van Moolenbroek  * 3. The name of the author may not be used to endorse or promote products
19*5d5fbe79SDavid van Moolenbroek  *    derived from this software without specific prior written permission.
20*5d5fbe79SDavid van Moolenbroek  *
21*5d5fbe79SDavid van Moolenbroek  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR IMPLIED
22*5d5fbe79SDavid van Moolenbroek  * WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
23*5d5fbe79SDavid van Moolenbroek  * MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT
24*5d5fbe79SDavid van Moolenbroek  * SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL,
25*5d5fbe79SDavid van Moolenbroek  * EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT
26*5d5fbe79SDavid van Moolenbroek  * OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
27*5d5fbe79SDavid van Moolenbroek  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
28*5d5fbe79SDavid van Moolenbroek  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING
29*5d5fbe79SDavid van Moolenbroek  * IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY
30*5d5fbe79SDavid van Moolenbroek  * OF SUCH DAMAGE.
31*5d5fbe79SDavid van Moolenbroek  *
32*5d5fbe79SDavid van Moolenbroek  * This file is part of the lwIP TCP/IP stack.
33*5d5fbe79SDavid van Moolenbroek  *
34*5d5fbe79SDavid van Moolenbroek  * Author: Frédéric Bernon, Simon Goldschmidt
35*5d5fbe79SDavid van Moolenbroek  */
36*5d5fbe79SDavid van Moolenbroek 
37*5d5fbe79SDavid van Moolenbroek 
38*5d5fbe79SDavid van Moolenbroek /**
39*5d5fbe79SDavid van Moolenbroek  * @defgroup sntp SNTP
40*5d5fbe79SDavid van Moolenbroek  * @ingroup apps
41*5d5fbe79SDavid van Moolenbroek  *
42*5d5fbe79SDavid van Moolenbroek  * This is simple "SNTP" client for the lwIP raw API.
43*5d5fbe79SDavid van Moolenbroek  * It is a minimal implementation of SNTPv4 as specified in RFC 4330.
44*5d5fbe79SDavid van Moolenbroek  *
45*5d5fbe79SDavid van Moolenbroek  * For a list of some public NTP servers, see this link :
46*5d5fbe79SDavid van Moolenbroek  * http://support.ntp.org/bin/view/Servers/NTPPoolServers
47*5d5fbe79SDavid van Moolenbroek  *
48*5d5fbe79SDavid van Moolenbroek  * @todo:
49*5d5fbe79SDavid van Moolenbroek  * - set/change servers at runtime
50*5d5fbe79SDavid van Moolenbroek  * - complete SNTP_CHECK_RESPONSE checks 3 and 4
51*5d5fbe79SDavid van Moolenbroek  */
52*5d5fbe79SDavid van Moolenbroek 
53*5d5fbe79SDavid van Moolenbroek #include "lwip/apps/sntp.h"
54*5d5fbe79SDavid van Moolenbroek 
55*5d5fbe79SDavid van Moolenbroek #include "lwip/opt.h"
56*5d5fbe79SDavid van Moolenbroek #include "lwip/timeouts.h"
57*5d5fbe79SDavid van Moolenbroek #include "lwip/udp.h"
58*5d5fbe79SDavid van Moolenbroek #include "lwip/dns.h"
59*5d5fbe79SDavid van Moolenbroek #include "lwip/ip_addr.h"
60*5d5fbe79SDavid van Moolenbroek #include "lwip/pbuf.h"
61*5d5fbe79SDavid van Moolenbroek #include "lwip/dhcp.h"
62*5d5fbe79SDavid van Moolenbroek 
63*5d5fbe79SDavid van Moolenbroek #include <string.h>
64*5d5fbe79SDavid van Moolenbroek #include <time.h>
65*5d5fbe79SDavid van Moolenbroek 
66*5d5fbe79SDavid van Moolenbroek #if LWIP_UDP
67*5d5fbe79SDavid van Moolenbroek 
68*5d5fbe79SDavid van Moolenbroek /* Handle support for more than one server via SNTP_MAX_SERVERS */
69*5d5fbe79SDavid van Moolenbroek #if SNTP_MAX_SERVERS > 1
70*5d5fbe79SDavid van Moolenbroek #define SNTP_SUPPORT_MULTIPLE_SERVERS 1
71*5d5fbe79SDavid van Moolenbroek #else /* NTP_MAX_SERVERS > 1 */
72*5d5fbe79SDavid van Moolenbroek #define SNTP_SUPPORT_MULTIPLE_SERVERS 0
73*5d5fbe79SDavid van Moolenbroek #endif /* NTP_MAX_SERVERS > 1 */
74*5d5fbe79SDavid van Moolenbroek 
75*5d5fbe79SDavid van Moolenbroek #if (SNTP_UPDATE_DELAY < 15000) && !defined(SNTP_SUPPRESS_DELAY_CHECK)
76*5d5fbe79SDavid van Moolenbroek #error "SNTPv4 RFC 4330 enforces a minimum update time of 15 seconds (define SNTP_SUPPRESS_DELAY_CHECK to disable this error)!"
77*5d5fbe79SDavid van Moolenbroek #endif
78*5d5fbe79SDavid van Moolenbroek 
79*5d5fbe79SDavid van Moolenbroek /* Configure behaviour depending on microsecond or second precision */
80*5d5fbe79SDavid van Moolenbroek #ifdef SNTP_SET_SYSTEM_TIME_US
81*5d5fbe79SDavid van Moolenbroek #define SNTP_CALC_TIME_US           1
82*5d5fbe79SDavid van Moolenbroek #define SNTP_RECEIVE_TIME_SIZE      2
83*5d5fbe79SDavid van Moolenbroek #else
84*5d5fbe79SDavid van Moolenbroek #define SNTP_SET_SYSTEM_TIME_US(sec, us)
85*5d5fbe79SDavid van Moolenbroek #define SNTP_CALC_TIME_US           0
86*5d5fbe79SDavid van Moolenbroek #define SNTP_RECEIVE_TIME_SIZE      1
87*5d5fbe79SDavid van Moolenbroek #endif
88*5d5fbe79SDavid van Moolenbroek 
89*5d5fbe79SDavid van Moolenbroek 
90*5d5fbe79SDavid van Moolenbroek /* the various debug levels for this file */
91*5d5fbe79SDavid van Moolenbroek #define SNTP_DEBUG_TRACE        (SNTP_DEBUG | LWIP_DBG_TRACE)
92*5d5fbe79SDavid van Moolenbroek #define SNTP_DEBUG_STATE        (SNTP_DEBUG | LWIP_DBG_STATE)
93*5d5fbe79SDavid van Moolenbroek #define SNTP_DEBUG_WARN         (SNTP_DEBUG | LWIP_DBG_LEVEL_WARNING)
94*5d5fbe79SDavid van Moolenbroek #define SNTP_DEBUG_WARN_STATE   (SNTP_DEBUG | LWIP_DBG_LEVEL_WARNING | LWIP_DBG_STATE)
95*5d5fbe79SDavid van Moolenbroek #define SNTP_DEBUG_SERIOUS      (SNTP_DEBUG | LWIP_DBG_LEVEL_SERIOUS)
96*5d5fbe79SDavid van Moolenbroek 
97*5d5fbe79SDavid van Moolenbroek #define SNTP_ERR_KOD                1
98*5d5fbe79SDavid van Moolenbroek 
99*5d5fbe79SDavid van Moolenbroek /* SNTP protocol defines */
100*5d5fbe79SDavid van Moolenbroek #define SNTP_MSG_LEN                48
101*5d5fbe79SDavid van Moolenbroek 
102*5d5fbe79SDavid van Moolenbroek #define SNTP_OFFSET_LI_VN_MODE      0
103*5d5fbe79SDavid van Moolenbroek #define SNTP_LI_MASK                0xC0
104*5d5fbe79SDavid van Moolenbroek #define SNTP_LI_NO_WARNING          0x00
105*5d5fbe79SDavid van Moolenbroek #define SNTP_LI_LAST_MINUTE_61_SEC  0x01
106*5d5fbe79SDavid van Moolenbroek #define SNTP_LI_LAST_MINUTE_59_SEC  0x02
107*5d5fbe79SDavid van Moolenbroek #define SNTP_LI_ALARM_CONDITION     0x03 /* (clock not synchronized) */
108*5d5fbe79SDavid van Moolenbroek 
109*5d5fbe79SDavid van Moolenbroek #define SNTP_VERSION_MASK           0x38
110*5d5fbe79SDavid van Moolenbroek #define SNTP_VERSION                (4/* NTP Version 4*/<<3)
111*5d5fbe79SDavid van Moolenbroek 
112*5d5fbe79SDavid van Moolenbroek #define SNTP_MODE_MASK              0x07
113*5d5fbe79SDavid van Moolenbroek #define SNTP_MODE_CLIENT            0x03
114*5d5fbe79SDavid van Moolenbroek #define SNTP_MODE_SERVER            0x04
115*5d5fbe79SDavid van Moolenbroek #define SNTP_MODE_BROADCAST         0x05
116*5d5fbe79SDavid van Moolenbroek 
117*5d5fbe79SDavid van Moolenbroek #define SNTP_OFFSET_STRATUM         1
118*5d5fbe79SDavid van Moolenbroek #define SNTP_STRATUM_KOD            0x00
119*5d5fbe79SDavid van Moolenbroek 
120*5d5fbe79SDavid van Moolenbroek #define SNTP_OFFSET_ORIGINATE_TIME  24
121*5d5fbe79SDavid van Moolenbroek #define SNTP_OFFSET_RECEIVE_TIME    32
122*5d5fbe79SDavid van Moolenbroek #define SNTP_OFFSET_TRANSMIT_TIME   40
123*5d5fbe79SDavid van Moolenbroek 
124*5d5fbe79SDavid van Moolenbroek /* number of seconds between 1900 and 1970 (MSB=1)*/
125*5d5fbe79SDavid van Moolenbroek #define DIFF_SEC_1900_1970         (2208988800UL)
126*5d5fbe79SDavid van Moolenbroek /* number of seconds between 1970 and Feb 7, 2036 (6:28:16 UTC) (MSB=0) */
127*5d5fbe79SDavid van Moolenbroek #define DIFF_SEC_1970_2036         (2085978496UL)
128*5d5fbe79SDavid van Moolenbroek 
129*5d5fbe79SDavid van Moolenbroek /**
130*5d5fbe79SDavid van Moolenbroek  * SNTP packet format (without optional fields)
131*5d5fbe79SDavid van Moolenbroek  * Timestamps are coded as 64 bits:
132*5d5fbe79SDavid van Moolenbroek  * - 32 bits seconds since Jan 01, 1970, 00:00
133*5d5fbe79SDavid van Moolenbroek  * - 32 bits seconds fraction (0-padded)
134*5d5fbe79SDavid van Moolenbroek  * For future use, if the MSB in the seconds part is set, seconds are based
135*5d5fbe79SDavid van Moolenbroek  * on Feb 07, 2036, 06:28:16.
136*5d5fbe79SDavid van Moolenbroek  */
137*5d5fbe79SDavid van Moolenbroek #ifdef PACK_STRUCT_USE_INCLUDES
138*5d5fbe79SDavid van Moolenbroek #  include "arch/bpstruct.h"
139*5d5fbe79SDavid van Moolenbroek #endif
140*5d5fbe79SDavid van Moolenbroek PACK_STRUCT_BEGIN
141*5d5fbe79SDavid van Moolenbroek struct sntp_msg {
142*5d5fbe79SDavid van Moolenbroek   PACK_STRUCT_FLD_8(u8_t  li_vn_mode);
143*5d5fbe79SDavid van Moolenbroek   PACK_STRUCT_FLD_8(u8_t  stratum);
144*5d5fbe79SDavid van Moolenbroek   PACK_STRUCT_FLD_8(u8_t  poll);
145*5d5fbe79SDavid van Moolenbroek   PACK_STRUCT_FLD_8(u8_t  precision);
146*5d5fbe79SDavid van Moolenbroek   PACK_STRUCT_FIELD(u32_t root_delay);
147*5d5fbe79SDavid van Moolenbroek   PACK_STRUCT_FIELD(u32_t root_dispersion);
148*5d5fbe79SDavid van Moolenbroek   PACK_STRUCT_FIELD(u32_t reference_identifier);
149*5d5fbe79SDavid van Moolenbroek   PACK_STRUCT_FIELD(u32_t reference_timestamp[2]);
150*5d5fbe79SDavid van Moolenbroek   PACK_STRUCT_FIELD(u32_t originate_timestamp[2]);
151*5d5fbe79SDavid van Moolenbroek   PACK_STRUCT_FIELD(u32_t receive_timestamp[2]);
152*5d5fbe79SDavid van Moolenbroek   PACK_STRUCT_FIELD(u32_t transmit_timestamp[2]);
153*5d5fbe79SDavid van Moolenbroek } PACK_STRUCT_STRUCT;
154*5d5fbe79SDavid van Moolenbroek PACK_STRUCT_END
155*5d5fbe79SDavid van Moolenbroek #ifdef PACK_STRUCT_USE_INCLUDES
156*5d5fbe79SDavid van Moolenbroek #  include "arch/epstruct.h"
157*5d5fbe79SDavid van Moolenbroek #endif
158*5d5fbe79SDavid van Moolenbroek 
159*5d5fbe79SDavid van Moolenbroek /* function prototypes */
160*5d5fbe79SDavid van Moolenbroek static void sntp_request(void *arg);
161*5d5fbe79SDavid van Moolenbroek 
162*5d5fbe79SDavid van Moolenbroek /** The operating mode */
163*5d5fbe79SDavid van Moolenbroek static u8_t sntp_opmode;
164*5d5fbe79SDavid van Moolenbroek 
165*5d5fbe79SDavid van Moolenbroek /** The UDP pcb used by the SNTP client */
166*5d5fbe79SDavid van Moolenbroek static struct udp_pcb* sntp_pcb;
167*5d5fbe79SDavid van Moolenbroek /** Names/Addresses of servers */
168*5d5fbe79SDavid van Moolenbroek struct sntp_server {
169*5d5fbe79SDavid van Moolenbroek #if SNTP_SERVER_DNS
170*5d5fbe79SDavid van Moolenbroek   char* name;
171*5d5fbe79SDavid van Moolenbroek #endif /* SNTP_SERVER_DNS */
172*5d5fbe79SDavid van Moolenbroek   ip_addr_t addr;
173*5d5fbe79SDavid van Moolenbroek };
174*5d5fbe79SDavid van Moolenbroek static struct sntp_server sntp_servers[SNTP_MAX_SERVERS];
175*5d5fbe79SDavid van Moolenbroek 
176*5d5fbe79SDavid van Moolenbroek #if SNTP_GET_SERVERS_FROM_DHCP
177*5d5fbe79SDavid van Moolenbroek static u8_t sntp_set_servers_from_dhcp;
178*5d5fbe79SDavid van Moolenbroek #endif /* SNTP_GET_SERVERS_FROM_DHCP */
179*5d5fbe79SDavid van Moolenbroek #if SNTP_SUPPORT_MULTIPLE_SERVERS
180*5d5fbe79SDavid van Moolenbroek /** The currently used server (initialized to 0) */
181*5d5fbe79SDavid van Moolenbroek static u8_t sntp_current_server;
182*5d5fbe79SDavid van Moolenbroek #else /* SNTP_SUPPORT_MULTIPLE_SERVERS */
183*5d5fbe79SDavid van Moolenbroek #define sntp_current_server 0
184*5d5fbe79SDavid van Moolenbroek #endif /* SNTP_SUPPORT_MULTIPLE_SERVERS */
185*5d5fbe79SDavid van Moolenbroek 
186*5d5fbe79SDavid van Moolenbroek #if SNTP_RETRY_TIMEOUT_EXP
187*5d5fbe79SDavid van Moolenbroek #define SNTP_RESET_RETRY_TIMEOUT() sntp_retry_timeout = SNTP_RETRY_TIMEOUT
188*5d5fbe79SDavid van Moolenbroek /** Retry time, initialized with SNTP_RETRY_TIMEOUT and doubled with each retry. */
189*5d5fbe79SDavid van Moolenbroek static u32_t sntp_retry_timeout;
190*5d5fbe79SDavid van Moolenbroek #else /* SNTP_RETRY_TIMEOUT_EXP */
191*5d5fbe79SDavid van Moolenbroek #define SNTP_RESET_RETRY_TIMEOUT()
192*5d5fbe79SDavid van Moolenbroek #define sntp_retry_timeout SNTP_RETRY_TIMEOUT
193*5d5fbe79SDavid van Moolenbroek #endif /* SNTP_RETRY_TIMEOUT_EXP */
194*5d5fbe79SDavid van Moolenbroek 
195*5d5fbe79SDavid van Moolenbroek #if SNTP_CHECK_RESPONSE >= 1
196*5d5fbe79SDavid van Moolenbroek /** Saves the last server address to compare with response */
197*5d5fbe79SDavid van Moolenbroek static ip_addr_t sntp_last_server_address;
198*5d5fbe79SDavid van Moolenbroek #endif /* SNTP_CHECK_RESPONSE >= 1 */
199*5d5fbe79SDavid van Moolenbroek 
200*5d5fbe79SDavid van Moolenbroek #if SNTP_CHECK_RESPONSE >= 2
201*5d5fbe79SDavid van Moolenbroek /** Saves the last timestamp sent (which is sent back by the server)
202*5d5fbe79SDavid van Moolenbroek  * to compare against in response */
203*5d5fbe79SDavid van Moolenbroek static u32_t sntp_last_timestamp_sent[2];
204*5d5fbe79SDavid van Moolenbroek #endif /* SNTP_CHECK_RESPONSE >= 2 */
205*5d5fbe79SDavid van Moolenbroek 
206*5d5fbe79SDavid van Moolenbroek /**
207*5d5fbe79SDavid van Moolenbroek  * SNTP processing of received timestamp
208*5d5fbe79SDavid van Moolenbroek  */
209*5d5fbe79SDavid van Moolenbroek static void
sntp_process(u32_t * receive_timestamp)210*5d5fbe79SDavid van Moolenbroek sntp_process(u32_t *receive_timestamp)
211*5d5fbe79SDavid van Moolenbroek {
212*5d5fbe79SDavid van Moolenbroek   /* convert SNTP time (1900-based) to unix GMT time (1970-based)
213*5d5fbe79SDavid van Moolenbroek    * if MSB is 0, SNTP time is 2036-based!
214*5d5fbe79SDavid van Moolenbroek    */
215*5d5fbe79SDavid van Moolenbroek   u32_t rx_secs = lwip_ntohl(receive_timestamp[0]);
216*5d5fbe79SDavid van Moolenbroek   int is_1900_based = ((rx_secs & 0x80000000) != 0);
217*5d5fbe79SDavid van Moolenbroek   u32_t t = is_1900_based ? (rx_secs - DIFF_SEC_1900_1970) : (rx_secs + DIFF_SEC_1970_2036);
218*5d5fbe79SDavid van Moolenbroek   time_t tim = t;
219*5d5fbe79SDavid van Moolenbroek 
220*5d5fbe79SDavid van Moolenbroek #if SNTP_CALC_TIME_US
221*5d5fbe79SDavid van Moolenbroek   u32_t us = lwip_ntohl(receive_timestamp[1]) / 4295;
222*5d5fbe79SDavid van Moolenbroek   SNTP_SET_SYSTEM_TIME_US(t, us);
223*5d5fbe79SDavid van Moolenbroek   /* display local time from GMT time */
224*5d5fbe79SDavid van Moolenbroek   LWIP_DEBUGF(SNTP_DEBUG_TRACE, ("sntp_process: %s, %"U32_F" us", ctime(&tim), us));
225*5d5fbe79SDavid van Moolenbroek 
226*5d5fbe79SDavid van Moolenbroek #else /* SNTP_CALC_TIME_US */
227*5d5fbe79SDavid van Moolenbroek 
228*5d5fbe79SDavid van Moolenbroek   /* change system time and/or the update the RTC clock */
229*5d5fbe79SDavid van Moolenbroek   SNTP_SET_SYSTEM_TIME(t);
230*5d5fbe79SDavid van Moolenbroek   /* display local time from GMT time */
231*5d5fbe79SDavid van Moolenbroek   LWIP_DEBUGF(SNTP_DEBUG_TRACE, ("sntp_process: %s", ctime(&tim)));
232*5d5fbe79SDavid van Moolenbroek #endif /* SNTP_CALC_TIME_US */
233*5d5fbe79SDavid van Moolenbroek   LWIP_UNUSED_ARG(tim);
234*5d5fbe79SDavid van Moolenbroek }
235*5d5fbe79SDavid van Moolenbroek 
236*5d5fbe79SDavid van Moolenbroek /**
237*5d5fbe79SDavid van Moolenbroek  * Initialize request struct to be sent to server.
238*5d5fbe79SDavid van Moolenbroek  */
239*5d5fbe79SDavid van Moolenbroek static void
sntp_initialize_request(struct sntp_msg * req)240*5d5fbe79SDavid van Moolenbroek sntp_initialize_request(struct sntp_msg *req)
241*5d5fbe79SDavid van Moolenbroek {
242*5d5fbe79SDavid van Moolenbroek   memset(req, 0, SNTP_MSG_LEN);
243*5d5fbe79SDavid van Moolenbroek   req->li_vn_mode = SNTP_LI_NO_WARNING | SNTP_VERSION | SNTP_MODE_CLIENT;
244*5d5fbe79SDavid van Moolenbroek 
245*5d5fbe79SDavid van Moolenbroek #if SNTP_CHECK_RESPONSE >= 2
246*5d5fbe79SDavid van Moolenbroek   {
247*5d5fbe79SDavid van Moolenbroek     u32_t sntp_time_sec, sntp_time_us;
248*5d5fbe79SDavid van Moolenbroek     /* fill in transmit timestamp and save it in 'sntp_last_timestamp_sent' */
249*5d5fbe79SDavid van Moolenbroek     SNTP_GET_SYSTEM_TIME(sntp_time_sec, sntp_time_us);
250*5d5fbe79SDavid van Moolenbroek     sntp_last_timestamp_sent[0] = lwip_htonl(sntp_time_sec + DIFF_SEC_1900_1970);
251*5d5fbe79SDavid van Moolenbroek     req->transmit_timestamp[0] = sntp_last_timestamp_sent[0];
252*5d5fbe79SDavid van Moolenbroek     /* we send/save us instead of fraction to be faster... */
253*5d5fbe79SDavid van Moolenbroek     sntp_last_timestamp_sent[1] = lwip_htonl(sntp_time_us);
254*5d5fbe79SDavid van Moolenbroek     req->transmit_timestamp[1] = sntp_last_timestamp_sent[1];
255*5d5fbe79SDavid van Moolenbroek   }
256*5d5fbe79SDavid van Moolenbroek #endif /* SNTP_CHECK_RESPONSE >= 2 */
257*5d5fbe79SDavid van Moolenbroek }
258*5d5fbe79SDavid van Moolenbroek 
259*5d5fbe79SDavid van Moolenbroek /**
260*5d5fbe79SDavid van Moolenbroek  * Retry: send a new request (and increase retry timeout).
261*5d5fbe79SDavid van Moolenbroek  *
262*5d5fbe79SDavid van Moolenbroek  * @param arg is unused (only necessary to conform to sys_timeout)
263*5d5fbe79SDavid van Moolenbroek  */
264*5d5fbe79SDavid van Moolenbroek static void
sntp_retry(void * arg)265*5d5fbe79SDavid van Moolenbroek sntp_retry(void* arg)
266*5d5fbe79SDavid van Moolenbroek {
267*5d5fbe79SDavid van Moolenbroek   LWIP_UNUSED_ARG(arg);
268*5d5fbe79SDavid van Moolenbroek 
269*5d5fbe79SDavid van Moolenbroek   LWIP_DEBUGF(SNTP_DEBUG_STATE, ("sntp_retry: Next request will be sent in %"U32_F" ms\n",
270*5d5fbe79SDavid van Moolenbroek     sntp_retry_timeout));
271*5d5fbe79SDavid van Moolenbroek 
272*5d5fbe79SDavid van Moolenbroek   /* set up a timer to send a retry and increase the retry delay */
273*5d5fbe79SDavid van Moolenbroek   sys_timeout(sntp_retry_timeout, sntp_request, NULL);
274*5d5fbe79SDavid van Moolenbroek 
275*5d5fbe79SDavid van Moolenbroek #if SNTP_RETRY_TIMEOUT_EXP
276*5d5fbe79SDavid van Moolenbroek   {
277*5d5fbe79SDavid van Moolenbroek     u32_t new_retry_timeout;
278*5d5fbe79SDavid van Moolenbroek     /* increase the timeout for next retry */
279*5d5fbe79SDavid van Moolenbroek     new_retry_timeout = sntp_retry_timeout << 1;
280*5d5fbe79SDavid van Moolenbroek     /* limit to maximum timeout and prevent overflow */
281*5d5fbe79SDavid van Moolenbroek     if ((new_retry_timeout <= SNTP_RETRY_TIMEOUT_MAX) &&
282*5d5fbe79SDavid van Moolenbroek         (new_retry_timeout > sntp_retry_timeout)) {
283*5d5fbe79SDavid van Moolenbroek       sntp_retry_timeout = new_retry_timeout;
284*5d5fbe79SDavid van Moolenbroek     }
285*5d5fbe79SDavid van Moolenbroek   }
286*5d5fbe79SDavid van Moolenbroek #endif /* SNTP_RETRY_TIMEOUT_EXP */
287*5d5fbe79SDavid van Moolenbroek }
288*5d5fbe79SDavid van Moolenbroek 
289*5d5fbe79SDavid van Moolenbroek #if SNTP_SUPPORT_MULTIPLE_SERVERS
290*5d5fbe79SDavid van Moolenbroek /**
291*5d5fbe79SDavid van Moolenbroek  * If Kiss-of-Death is received (or another packet parsing error),
292*5d5fbe79SDavid van Moolenbroek  * try the next server or retry the current server and increase the retry
293*5d5fbe79SDavid van Moolenbroek  * timeout if only one server is available.
294*5d5fbe79SDavid van Moolenbroek  * (implicitly, SNTP_MAX_SERVERS > 1)
295*5d5fbe79SDavid van Moolenbroek  *
296*5d5fbe79SDavid van Moolenbroek  * @param arg is unused (only necessary to conform to sys_timeout)
297*5d5fbe79SDavid van Moolenbroek  */
298*5d5fbe79SDavid van Moolenbroek static void
sntp_try_next_server(void * arg)299*5d5fbe79SDavid van Moolenbroek sntp_try_next_server(void* arg)
300*5d5fbe79SDavid van Moolenbroek {
301*5d5fbe79SDavid van Moolenbroek   u8_t old_server, i;
302*5d5fbe79SDavid van Moolenbroek   LWIP_UNUSED_ARG(arg);
303*5d5fbe79SDavid van Moolenbroek 
304*5d5fbe79SDavid van Moolenbroek   old_server = sntp_current_server;
305*5d5fbe79SDavid van Moolenbroek   for (i = 0; i < SNTP_MAX_SERVERS - 1; i++) {
306*5d5fbe79SDavid van Moolenbroek     sntp_current_server++;
307*5d5fbe79SDavid van Moolenbroek     if (sntp_current_server >= SNTP_MAX_SERVERS) {
308*5d5fbe79SDavid van Moolenbroek       sntp_current_server = 0;
309*5d5fbe79SDavid van Moolenbroek     }
310*5d5fbe79SDavid van Moolenbroek     if (!ip_addr_isany(&sntp_servers[sntp_current_server].addr)
311*5d5fbe79SDavid van Moolenbroek #if SNTP_SERVER_DNS
312*5d5fbe79SDavid van Moolenbroek         || (sntp_servers[sntp_current_server].name != NULL)
313*5d5fbe79SDavid van Moolenbroek #endif
314*5d5fbe79SDavid van Moolenbroek         ) {
315*5d5fbe79SDavid van Moolenbroek       LWIP_DEBUGF(SNTP_DEBUG_STATE, ("sntp_try_next_server: Sending request to server %"U16_F"\n",
316*5d5fbe79SDavid van Moolenbroek         (u16_t)sntp_current_server));
317*5d5fbe79SDavid van Moolenbroek       /* new server: reset retry timeout */
318*5d5fbe79SDavid van Moolenbroek       SNTP_RESET_RETRY_TIMEOUT();
319*5d5fbe79SDavid van Moolenbroek       /* instantly send a request to the next server */
320*5d5fbe79SDavid van Moolenbroek       sntp_request(NULL);
321*5d5fbe79SDavid van Moolenbroek       return;
322*5d5fbe79SDavid van Moolenbroek     }
323*5d5fbe79SDavid van Moolenbroek   }
324*5d5fbe79SDavid van Moolenbroek   /* no other valid server found */
325*5d5fbe79SDavid van Moolenbroek   sntp_current_server = old_server;
326*5d5fbe79SDavid van Moolenbroek   sntp_retry(NULL);
327*5d5fbe79SDavid van Moolenbroek }
328*5d5fbe79SDavid van Moolenbroek #else /* SNTP_SUPPORT_MULTIPLE_SERVERS */
329*5d5fbe79SDavid van Moolenbroek /* Always retry on error if only one server is supported */
330*5d5fbe79SDavid van Moolenbroek #define sntp_try_next_server    sntp_retry
331*5d5fbe79SDavid van Moolenbroek #endif /* SNTP_SUPPORT_MULTIPLE_SERVERS */
332*5d5fbe79SDavid van Moolenbroek 
333*5d5fbe79SDavid van Moolenbroek /** UDP recv callback for the sntp pcb */
334*5d5fbe79SDavid van Moolenbroek static void
sntp_recv(void * arg,struct udp_pcb * pcb,struct pbuf * p,const ip_addr_t * addr,u16_t port)335*5d5fbe79SDavid van Moolenbroek sntp_recv(void *arg, struct udp_pcb* pcb, struct pbuf *p, const ip_addr_t *addr, u16_t port)
336*5d5fbe79SDavid van Moolenbroek {
337*5d5fbe79SDavid van Moolenbroek   u8_t mode;
338*5d5fbe79SDavid van Moolenbroek   u8_t stratum;
339*5d5fbe79SDavid van Moolenbroek   u32_t receive_timestamp[SNTP_RECEIVE_TIME_SIZE];
340*5d5fbe79SDavid van Moolenbroek   err_t err;
341*5d5fbe79SDavid van Moolenbroek 
342*5d5fbe79SDavid van Moolenbroek   LWIP_UNUSED_ARG(arg);
343*5d5fbe79SDavid van Moolenbroek   LWIP_UNUSED_ARG(pcb);
344*5d5fbe79SDavid van Moolenbroek 
345*5d5fbe79SDavid van Moolenbroek   /* packet received: stop retry timeout  */
346*5d5fbe79SDavid van Moolenbroek   sys_untimeout(sntp_try_next_server, NULL);
347*5d5fbe79SDavid van Moolenbroek   sys_untimeout(sntp_request, NULL);
348*5d5fbe79SDavid van Moolenbroek 
349*5d5fbe79SDavid van Moolenbroek   err = ERR_ARG;
350*5d5fbe79SDavid van Moolenbroek #if SNTP_CHECK_RESPONSE >= 1
351*5d5fbe79SDavid van Moolenbroek   /* check server address and port */
352*5d5fbe79SDavid van Moolenbroek   if (((sntp_opmode != SNTP_OPMODE_POLL) || ip_addr_cmp(addr, &sntp_last_server_address)) &&
353*5d5fbe79SDavid van Moolenbroek     (port == SNTP_PORT))
354*5d5fbe79SDavid van Moolenbroek #else /* SNTP_CHECK_RESPONSE >= 1 */
355*5d5fbe79SDavid van Moolenbroek   LWIP_UNUSED_ARG(addr);
356*5d5fbe79SDavid van Moolenbroek   LWIP_UNUSED_ARG(port);
357*5d5fbe79SDavid van Moolenbroek #endif /* SNTP_CHECK_RESPONSE >= 1 */
358*5d5fbe79SDavid van Moolenbroek   {
359*5d5fbe79SDavid van Moolenbroek     /* process the response */
360*5d5fbe79SDavid van Moolenbroek     if (p->tot_len == SNTP_MSG_LEN) {
361*5d5fbe79SDavid van Moolenbroek       pbuf_copy_partial(p, &mode, 1, SNTP_OFFSET_LI_VN_MODE);
362*5d5fbe79SDavid van Moolenbroek       mode &= SNTP_MODE_MASK;
363*5d5fbe79SDavid van Moolenbroek       /* if this is a SNTP response... */
364*5d5fbe79SDavid van Moolenbroek       if (((sntp_opmode == SNTP_OPMODE_POLL) && (mode == SNTP_MODE_SERVER)) ||
365*5d5fbe79SDavid van Moolenbroek           ((sntp_opmode == SNTP_OPMODE_LISTENONLY) && (mode == SNTP_MODE_BROADCAST))) {
366*5d5fbe79SDavid van Moolenbroek         pbuf_copy_partial(p, &stratum, 1, SNTP_OFFSET_STRATUM);
367*5d5fbe79SDavid van Moolenbroek         if (stratum == SNTP_STRATUM_KOD) {
368*5d5fbe79SDavid van Moolenbroek           /* Kiss-of-death packet. Use another server or increase UPDATE_DELAY. */
369*5d5fbe79SDavid van Moolenbroek           err = SNTP_ERR_KOD;
370*5d5fbe79SDavid van Moolenbroek           LWIP_DEBUGF(SNTP_DEBUG_STATE, ("sntp_recv: Received Kiss-of-Death\n"));
371*5d5fbe79SDavid van Moolenbroek         } else {
372*5d5fbe79SDavid van Moolenbroek #if SNTP_CHECK_RESPONSE >= 2
373*5d5fbe79SDavid van Moolenbroek           /* check originate_timetamp against sntp_last_timestamp_sent */
374*5d5fbe79SDavid van Moolenbroek           u32_t originate_timestamp[2];
375*5d5fbe79SDavid van Moolenbroek           pbuf_copy_partial(p, &originate_timestamp, 8, SNTP_OFFSET_ORIGINATE_TIME);
376*5d5fbe79SDavid van Moolenbroek           if ((originate_timestamp[0] != sntp_last_timestamp_sent[0]) ||
377*5d5fbe79SDavid van Moolenbroek               (originate_timestamp[1] != sntp_last_timestamp_sent[1]))
378*5d5fbe79SDavid van Moolenbroek           {
379*5d5fbe79SDavid van Moolenbroek             LWIP_DEBUGF(SNTP_DEBUG_WARN, ("sntp_recv: Invalid originate timestamp in response\n"));
380*5d5fbe79SDavid van Moolenbroek           } else
381*5d5fbe79SDavid van Moolenbroek #endif /* SNTP_CHECK_RESPONSE >= 2 */
382*5d5fbe79SDavid van Moolenbroek           /* @todo: add code for SNTP_CHECK_RESPONSE >= 3 and >= 4 here */
383*5d5fbe79SDavid van Moolenbroek           {
384*5d5fbe79SDavid van Moolenbroek             /* correct answer */
385*5d5fbe79SDavid van Moolenbroek             err = ERR_OK;
386*5d5fbe79SDavid van Moolenbroek             pbuf_copy_partial(p, &receive_timestamp, SNTP_RECEIVE_TIME_SIZE * 4, SNTP_OFFSET_TRANSMIT_TIME);
387*5d5fbe79SDavid van Moolenbroek           }
388*5d5fbe79SDavid van Moolenbroek         }
389*5d5fbe79SDavid van Moolenbroek       } else {
390*5d5fbe79SDavid van Moolenbroek         LWIP_DEBUGF(SNTP_DEBUG_WARN, ("sntp_recv: Invalid mode in response: %"U16_F"\n", (u16_t)mode));
391*5d5fbe79SDavid van Moolenbroek         /* wait for correct response */
392*5d5fbe79SDavid van Moolenbroek         err = ERR_TIMEOUT;
393*5d5fbe79SDavid van Moolenbroek       }
394*5d5fbe79SDavid van Moolenbroek     } else {
395*5d5fbe79SDavid van Moolenbroek       LWIP_DEBUGF(SNTP_DEBUG_WARN, ("sntp_recv: Invalid packet length: %"U16_F"\n", p->tot_len));
396*5d5fbe79SDavid van Moolenbroek     }
397*5d5fbe79SDavid van Moolenbroek   }
398*5d5fbe79SDavid van Moolenbroek #if SNTP_CHECK_RESPONSE >= 1
399*5d5fbe79SDavid van Moolenbroek   else {
400*5d5fbe79SDavid van Moolenbroek     /* packet from wrong remote address or port, wait for correct response */
401*5d5fbe79SDavid van Moolenbroek     err = ERR_TIMEOUT;
402*5d5fbe79SDavid van Moolenbroek   }
403*5d5fbe79SDavid van Moolenbroek #endif /* SNTP_CHECK_RESPONSE >= 1 */
404*5d5fbe79SDavid van Moolenbroek   pbuf_free(p);
405*5d5fbe79SDavid van Moolenbroek   if (err == ERR_OK) {
406*5d5fbe79SDavid van Moolenbroek     sntp_process(receive_timestamp);
407*5d5fbe79SDavid van Moolenbroek 
408*5d5fbe79SDavid van Moolenbroek     /* Set up timeout for next request (only if poll response was received)*/
409*5d5fbe79SDavid van Moolenbroek     if (sntp_opmode == SNTP_OPMODE_POLL) {
410*5d5fbe79SDavid van Moolenbroek       /* Correct response, reset retry timeout */
411*5d5fbe79SDavid van Moolenbroek       SNTP_RESET_RETRY_TIMEOUT();
412*5d5fbe79SDavid van Moolenbroek 
413*5d5fbe79SDavid van Moolenbroek       sys_timeout((u32_t)SNTP_UPDATE_DELAY, sntp_request, NULL);
414*5d5fbe79SDavid van Moolenbroek       LWIP_DEBUGF(SNTP_DEBUG_STATE, ("sntp_recv: Scheduled next time request: %"U32_F" ms\n",
415*5d5fbe79SDavid van Moolenbroek         (u32_t)SNTP_UPDATE_DELAY));
416*5d5fbe79SDavid van Moolenbroek     }
417*5d5fbe79SDavid van Moolenbroek   } else if (err != ERR_TIMEOUT) {
418*5d5fbe79SDavid van Moolenbroek     /* Errors are only processed in case of an explicit poll response */
419*5d5fbe79SDavid van Moolenbroek     if (sntp_opmode == SNTP_OPMODE_POLL) {
420*5d5fbe79SDavid van Moolenbroek       if (err == SNTP_ERR_KOD) {
421*5d5fbe79SDavid van Moolenbroek         /* Kiss-of-death packet. Use another server or increase UPDATE_DELAY. */
422*5d5fbe79SDavid van Moolenbroek         sntp_try_next_server(NULL);
423*5d5fbe79SDavid van Moolenbroek       } else {
424*5d5fbe79SDavid van Moolenbroek         /* another error, try the same server again */
425*5d5fbe79SDavid van Moolenbroek         sntp_retry(NULL);
426*5d5fbe79SDavid van Moolenbroek       }
427*5d5fbe79SDavid van Moolenbroek     }
428*5d5fbe79SDavid van Moolenbroek   }
429*5d5fbe79SDavid van Moolenbroek }
430*5d5fbe79SDavid van Moolenbroek 
431*5d5fbe79SDavid van Moolenbroek /** Actually send an sntp request to a server.
432*5d5fbe79SDavid van Moolenbroek  *
433*5d5fbe79SDavid van Moolenbroek  * @param server_addr resolved IP address of the SNTP server
434*5d5fbe79SDavid van Moolenbroek  */
435*5d5fbe79SDavid van Moolenbroek static void
sntp_send_request(const ip_addr_t * server_addr)436*5d5fbe79SDavid van Moolenbroek sntp_send_request(const ip_addr_t *server_addr)
437*5d5fbe79SDavid van Moolenbroek {
438*5d5fbe79SDavid van Moolenbroek   struct pbuf* p;
439*5d5fbe79SDavid van Moolenbroek   p = pbuf_alloc(PBUF_TRANSPORT, SNTP_MSG_LEN, PBUF_RAM);
440*5d5fbe79SDavid van Moolenbroek   if (p != NULL) {
441*5d5fbe79SDavid van Moolenbroek     struct sntp_msg *sntpmsg = (struct sntp_msg *)p->payload;
442*5d5fbe79SDavid van Moolenbroek     LWIP_DEBUGF(SNTP_DEBUG_STATE, ("sntp_send_request: Sending request to server\n"));
443*5d5fbe79SDavid van Moolenbroek     /* initialize request message */
444*5d5fbe79SDavid van Moolenbroek     sntp_initialize_request(sntpmsg);
445*5d5fbe79SDavid van Moolenbroek     /* send request */
446*5d5fbe79SDavid van Moolenbroek     udp_sendto(sntp_pcb, p, server_addr, SNTP_PORT);
447*5d5fbe79SDavid van Moolenbroek     /* free the pbuf after sending it */
448*5d5fbe79SDavid van Moolenbroek     pbuf_free(p);
449*5d5fbe79SDavid van Moolenbroek     /* set up receive timeout: try next server or retry on timeout */
450*5d5fbe79SDavid van Moolenbroek     sys_timeout((u32_t)SNTP_RECV_TIMEOUT, sntp_try_next_server, NULL);
451*5d5fbe79SDavid van Moolenbroek #if SNTP_CHECK_RESPONSE >= 1
452*5d5fbe79SDavid van Moolenbroek     /* save server address to verify it in sntp_recv */
453*5d5fbe79SDavid van Moolenbroek     ip_addr_set(&sntp_last_server_address, server_addr);
454*5d5fbe79SDavid van Moolenbroek #endif /* SNTP_CHECK_RESPONSE >= 1 */
455*5d5fbe79SDavid van Moolenbroek   } else {
456*5d5fbe79SDavid van Moolenbroek     LWIP_DEBUGF(SNTP_DEBUG_SERIOUS, ("sntp_send_request: Out of memory, trying again in %"U32_F" ms\n",
457*5d5fbe79SDavid van Moolenbroek       (u32_t)SNTP_RETRY_TIMEOUT));
458*5d5fbe79SDavid van Moolenbroek     /* out of memory: set up a timer to send a retry */
459*5d5fbe79SDavid van Moolenbroek     sys_timeout((u32_t)SNTP_RETRY_TIMEOUT, sntp_request, NULL);
460*5d5fbe79SDavid van Moolenbroek   }
461*5d5fbe79SDavid van Moolenbroek }
462*5d5fbe79SDavid van Moolenbroek 
463*5d5fbe79SDavid van Moolenbroek #if SNTP_SERVER_DNS
464*5d5fbe79SDavid van Moolenbroek /**
465*5d5fbe79SDavid van Moolenbroek  * DNS found callback when using DNS names as server address.
466*5d5fbe79SDavid van Moolenbroek  */
467*5d5fbe79SDavid van Moolenbroek static void
sntp_dns_found(const char * hostname,const ip_addr_t * ipaddr,void * arg)468*5d5fbe79SDavid van Moolenbroek sntp_dns_found(const char* hostname, const ip_addr_t *ipaddr, void *arg)
469*5d5fbe79SDavid van Moolenbroek {
470*5d5fbe79SDavid van Moolenbroek   LWIP_UNUSED_ARG(hostname);
471*5d5fbe79SDavid van Moolenbroek   LWIP_UNUSED_ARG(arg);
472*5d5fbe79SDavid van Moolenbroek 
473*5d5fbe79SDavid van Moolenbroek   if (ipaddr != NULL) {
474*5d5fbe79SDavid van Moolenbroek     /* Address resolved, send request */
475*5d5fbe79SDavid van Moolenbroek     LWIP_DEBUGF(SNTP_DEBUG_STATE, ("sntp_dns_found: Server address resolved, sending request\n"));
476*5d5fbe79SDavid van Moolenbroek     sntp_send_request(ipaddr);
477*5d5fbe79SDavid van Moolenbroek   } else {
478*5d5fbe79SDavid van Moolenbroek     /* DNS resolving failed -> try another server */
479*5d5fbe79SDavid van Moolenbroek     LWIP_DEBUGF(SNTP_DEBUG_WARN_STATE, ("sntp_dns_found: Failed to resolve server address resolved, trying next server\n"));
480*5d5fbe79SDavid van Moolenbroek     sntp_try_next_server(NULL);
481*5d5fbe79SDavid van Moolenbroek   }
482*5d5fbe79SDavid van Moolenbroek }
483*5d5fbe79SDavid van Moolenbroek #endif /* SNTP_SERVER_DNS */
484*5d5fbe79SDavid van Moolenbroek 
485*5d5fbe79SDavid van Moolenbroek /**
486*5d5fbe79SDavid van Moolenbroek  * Send out an sntp request.
487*5d5fbe79SDavid van Moolenbroek  *
488*5d5fbe79SDavid van Moolenbroek  * @param arg is unused (only necessary to conform to sys_timeout)
489*5d5fbe79SDavid van Moolenbroek  */
490*5d5fbe79SDavid van Moolenbroek static void
sntp_request(void * arg)491*5d5fbe79SDavid van Moolenbroek sntp_request(void *arg)
492*5d5fbe79SDavid van Moolenbroek {
493*5d5fbe79SDavid van Moolenbroek   ip_addr_t sntp_server_address;
494*5d5fbe79SDavid van Moolenbroek   err_t err;
495*5d5fbe79SDavid van Moolenbroek 
496*5d5fbe79SDavid van Moolenbroek   LWIP_UNUSED_ARG(arg);
497*5d5fbe79SDavid van Moolenbroek 
498*5d5fbe79SDavid van Moolenbroek   /* initialize SNTP server address */
499*5d5fbe79SDavid van Moolenbroek #if SNTP_SERVER_DNS
500*5d5fbe79SDavid van Moolenbroek   if (sntp_servers[sntp_current_server].name) {
501*5d5fbe79SDavid van Moolenbroek     /* always resolve the name and rely on dns-internal caching & timeout */
502*5d5fbe79SDavid van Moolenbroek     ip_addr_set_zero(&sntp_servers[sntp_current_server].addr);
503*5d5fbe79SDavid van Moolenbroek     err = dns_gethostbyname(sntp_servers[sntp_current_server].name, &sntp_server_address,
504*5d5fbe79SDavid van Moolenbroek       sntp_dns_found, NULL);
505*5d5fbe79SDavid van Moolenbroek     if (err == ERR_INPROGRESS) {
506*5d5fbe79SDavid van Moolenbroek       /* DNS request sent, wait for sntp_dns_found being called */
507*5d5fbe79SDavid van Moolenbroek       LWIP_DEBUGF(SNTP_DEBUG_STATE, ("sntp_request: Waiting for server address to be resolved.\n"));
508*5d5fbe79SDavid van Moolenbroek       return;
509*5d5fbe79SDavid van Moolenbroek     } else if (err == ERR_OK) {
510*5d5fbe79SDavid van Moolenbroek       sntp_servers[sntp_current_server].addr = sntp_server_address;
511*5d5fbe79SDavid van Moolenbroek     }
512*5d5fbe79SDavid van Moolenbroek   } else
513*5d5fbe79SDavid van Moolenbroek #endif /* SNTP_SERVER_DNS */
514*5d5fbe79SDavid van Moolenbroek   {
515*5d5fbe79SDavid van Moolenbroek     sntp_server_address = sntp_servers[sntp_current_server].addr;
516*5d5fbe79SDavid van Moolenbroek     err = (ip_addr_isany_val(sntp_server_address)) ? ERR_ARG : ERR_OK;
517*5d5fbe79SDavid van Moolenbroek   }
518*5d5fbe79SDavid van Moolenbroek 
519*5d5fbe79SDavid van Moolenbroek   if (err == ERR_OK) {
520*5d5fbe79SDavid van Moolenbroek     LWIP_DEBUGF(SNTP_DEBUG_TRACE, ("sntp_request: current server address is %s\n",
521*5d5fbe79SDavid van Moolenbroek       ipaddr_ntoa(&sntp_server_address)));
522*5d5fbe79SDavid van Moolenbroek     sntp_send_request(&sntp_server_address);
523*5d5fbe79SDavid van Moolenbroek   } else {
524*5d5fbe79SDavid van Moolenbroek     /* address conversion failed, try another server */
525*5d5fbe79SDavid van Moolenbroek     LWIP_DEBUGF(SNTP_DEBUG_WARN_STATE, ("sntp_request: Invalid server address, trying next server.\n"));
526*5d5fbe79SDavid van Moolenbroek     sys_timeout((u32_t)SNTP_RETRY_TIMEOUT, sntp_try_next_server, NULL);
527*5d5fbe79SDavid van Moolenbroek   }
528*5d5fbe79SDavid van Moolenbroek }
529*5d5fbe79SDavid van Moolenbroek 
530*5d5fbe79SDavid van Moolenbroek /**
531*5d5fbe79SDavid van Moolenbroek  * @ingroup sntp
532*5d5fbe79SDavid van Moolenbroek  * Initialize this module.
533*5d5fbe79SDavid van Moolenbroek  * Send out request instantly or after SNTP_STARTUP_DELAY(_FUNC).
534*5d5fbe79SDavid van Moolenbroek  */
535*5d5fbe79SDavid van Moolenbroek void
sntp_init(void)536*5d5fbe79SDavid van Moolenbroek sntp_init(void)
537*5d5fbe79SDavid van Moolenbroek {
538*5d5fbe79SDavid van Moolenbroek #ifdef SNTP_SERVER_ADDRESS
539*5d5fbe79SDavid van Moolenbroek #if SNTP_SERVER_DNS
540*5d5fbe79SDavid van Moolenbroek   sntp_setservername(0, SNTP_SERVER_ADDRESS);
541*5d5fbe79SDavid van Moolenbroek #else
542*5d5fbe79SDavid van Moolenbroek #error SNTP_SERVER_ADDRESS string not supported SNTP_SERVER_DNS==0
543*5d5fbe79SDavid van Moolenbroek #endif
544*5d5fbe79SDavid van Moolenbroek #endif /* SNTP_SERVER_ADDRESS */
545*5d5fbe79SDavid van Moolenbroek 
546*5d5fbe79SDavid van Moolenbroek   if (sntp_pcb == NULL) {
547*5d5fbe79SDavid van Moolenbroek     sntp_pcb = udp_new_ip_type(IPADDR_TYPE_ANY);
548*5d5fbe79SDavid van Moolenbroek     LWIP_ASSERT("Failed to allocate udp pcb for sntp client", sntp_pcb != NULL);
549*5d5fbe79SDavid van Moolenbroek     if (sntp_pcb != NULL) {
550*5d5fbe79SDavid van Moolenbroek       udp_recv(sntp_pcb, sntp_recv, NULL);
551*5d5fbe79SDavid van Moolenbroek 
552*5d5fbe79SDavid van Moolenbroek       if (sntp_opmode == SNTP_OPMODE_POLL) {
553*5d5fbe79SDavid van Moolenbroek         SNTP_RESET_RETRY_TIMEOUT();
554*5d5fbe79SDavid van Moolenbroek #if SNTP_STARTUP_DELAY
555*5d5fbe79SDavid van Moolenbroek         sys_timeout((u32_t)SNTP_STARTUP_DELAY_FUNC, sntp_request, NULL);
556*5d5fbe79SDavid van Moolenbroek #else
557*5d5fbe79SDavid van Moolenbroek         sntp_request(NULL);
558*5d5fbe79SDavid van Moolenbroek #endif
559*5d5fbe79SDavid van Moolenbroek       } else if (sntp_opmode == SNTP_OPMODE_LISTENONLY) {
560*5d5fbe79SDavid van Moolenbroek         ip_set_option(sntp_pcb, SOF_BROADCAST);
561*5d5fbe79SDavid van Moolenbroek         udp_bind(sntp_pcb, IP_ANY_TYPE, SNTP_PORT);
562*5d5fbe79SDavid van Moolenbroek       }
563*5d5fbe79SDavid van Moolenbroek     }
564*5d5fbe79SDavid van Moolenbroek   }
565*5d5fbe79SDavid van Moolenbroek }
566*5d5fbe79SDavid van Moolenbroek 
567*5d5fbe79SDavid van Moolenbroek /**
568*5d5fbe79SDavid van Moolenbroek  * @ingroup sntp
569*5d5fbe79SDavid van Moolenbroek  * Stop this module.
570*5d5fbe79SDavid van Moolenbroek  */
571*5d5fbe79SDavid van Moolenbroek void
sntp_stop(void)572*5d5fbe79SDavid van Moolenbroek sntp_stop(void)
573*5d5fbe79SDavid van Moolenbroek {
574*5d5fbe79SDavid van Moolenbroek   if (sntp_pcb != NULL) {
575*5d5fbe79SDavid van Moolenbroek     sys_untimeout(sntp_request, NULL);
576*5d5fbe79SDavid van Moolenbroek     sys_untimeout(sntp_try_next_server, NULL);
577*5d5fbe79SDavid van Moolenbroek     udp_remove(sntp_pcb);
578*5d5fbe79SDavid van Moolenbroek     sntp_pcb = NULL;
579*5d5fbe79SDavid van Moolenbroek   }
580*5d5fbe79SDavid van Moolenbroek }
581*5d5fbe79SDavid van Moolenbroek 
582*5d5fbe79SDavid van Moolenbroek /**
583*5d5fbe79SDavid van Moolenbroek  * @ingroup sntp
584*5d5fbe79SDavid van Moolenbroek  * Get enabled state.
585*5d5fbe79SDavid van Moolenbroek  */
sntp_enabled(void)586*5d5fbe79SDavid van Moolenbroek u8_t sntp_enabled(void)
587*5d5fbe79SDavid van Moolenbroek {
588*5d5fbe79SDavid van Moolenbroek   return (sntp_pcb != NULL)? 1 : 0;
589*5d5fbe79SDavid van Moolenbroek }
590*5d5fbe79SDavid van Moolenbroek 
591*5d5fbe79SDavid van Moolenbroek /**
592*5d5fbe79SDavid van Moolenbroek  * @ingroup sntp
593*5d5fbe79SDavid van Moolenbroek  * Sets the operating mode.
594*5d5fbe79SDavid van Moolenbroek  * @param operating_mode one of the available operating modes
595*5d5fbe79SDavid van Moolenbroek  */
596*5d5fbe79SDavid van Moolenbroek void
sntp_setoperatingmode(u8_t operating_mode)597*5d5fbe79SDavid van Moolenbroek sntp_setoperatingmode(u8_t operating_mode)
598*5d5fbe79SDavid van Moolenbroek {
599*5d5fbe79SDavid van Moolenbroek   LWIP_ASSERT("Invalid operating mode", operating_mode <= SNTP_OPMODE_LISTENONLY);
600*5d5fbe79SDavid van Moolenbroek   LWIP_ASSERT("Operating mode must not be set while SNTP client is running", sntp_pcb == NULL);
601*5d5fbe79SDavid van Moolenbroek   sntp_opmode = operating_mode;
602*5d5fbe79SDavid van Moolenbroek }
603*5d5fbe79SDavid van Moolenbroek 
604*5d5fbe79SDavid van Moolenbroek /**
605*5d5fbe79SDavid van Moolenbroek  * @ingroup sntp
606*5d5fbe79SDavid van Moolenbroek  * Gets the operating mode.
607*5d5fbe79SDavid van Moolenbroek  */
608*5d5fbe79SDavid van Moolenbroek u8_t
sntp_getoperatingmode(void)609*5d5fbe79SDavid van Moolenbroek sntp_getoperatingmode(void)
610*5d5fbe79SDavid van Moolenbroek {
611*5d5fbe79SDavid van Moolenbroek   return sntp_opmode;
612*5d5fbe79SDavid van Moolenbroek }
613*5d5fbe79SDavid van Moolenbroek 
614*5d5fbe79SDavid van Moolenbroek #if SNTP_GET_SERVERS_FROM_DHCP
615*5d5fbe79SDavid van Moolenbroek /**
616*5d5fbe79SDavid van Moolenbroek  * Config SNTP server handling by IP address, name, or DHCP; clear table
617*5d5fbe79SDavid van Moolenbroek  * @param set_servers_from_dhcp enable or disable getting server addresses from dhcp
618*5d5fbe79SDavid van Moolenbroek  */
619*5d5fbe79SDavid van Moolenbroek void
sntp_servermode_dhcp(int set_servers_from_dhcp)620*5d5fbe79SDavid van Moolenbroek sntp_servermode_dhcp(int set_servers_from_dhcp)
621*5d5fbe79SDavid van Moolenbroek {
622*5d5fbe79SDavid van Moolenbroek   u8_t new_mode = set_servers_from_dhcp ? 1 : 0;
623*5d5fbe79SDavid van Moolenbroek   if (sntp_set_servers_from_dhcp != new_mode) {
624*5d5fbe79SDavid van Moolenbroek     sntp_set_servers_from_dhcp = new_mode;
625*5d5fbe79SDavid van Moolenbroek   }
626*5d5fbe79SDavid van Moolenbroek }
627*5d5fbe79SDavid van Moolenbroek #endif /* SNTP_GET_SERVERS_FROM_DHCP */
628*5d5fbe79SDavid van Moolenbroek 
629*5d5fbe79SDavid van Moolenbroek /**
630*5d5fbe79SDavid van Moolenbroek  * @ingroup sntp
631*5d5fbe79SDavid van Moolenbroek  * Initialize one of the NTP servers by IP address
632*5d5fbe79SDavid van Moolenbroek  *
633*5d5fbe79SDavid van Moolenbroek  * @param idx the index of the NTP server to set must be < SNTP_MAX_SERVERS
634*5d5fbe79SDavid van Moolenbroek  * @param server IP address of the NTP server to set
635*5d5fbe79SDavid van Moolenbroek  */
636*5d5fbe79SDavid van Moolenbroek void
sntp_setserver(u8_t idx,const ip_addr_t * server)637*5d5fbe79SDavid van Moolenbroek sntp_setserver(u8_t idx, const ip_addr_t *server)
638*5d5fbe79SDavid van Moolenbroek {
639*5d5fbe79SDavid van Moolenbroek   if (idx < SNTP_MAX_SERVERS) {
640*5d5fbe79SDavid van Moolenbroek     if (server != NULL) {
641*5d5fbe79SDavid van Moolenbroek       sntp_servers[idx].addr = (*server);
642*5d5fbe79SDavid van Moolenbroek     } else {
643*5d5fbe79SDavid van Moolenbroek       ip_addr_set_zero(&sntp_servers[idx].addr);
644*5d5fbe79SDavid van Moolenbroek     }
645*5d5fbe79SDavid van Moolenbroek #if SNTP_SERVER_DNS
646*5d5fbe79SDavid van Moolenbroek     sntp_servers[idx].name = NULL;
647*5d5fbe79SDavid van Moolenbroek #endif
648*5d5fbe79SDavid van Moolenbroek   }
649*5d5fbe79SDavid van Moolenbroek }
650*5d5fbe79SDavid van Moolenbroek 
651*5d5fbe79SDavid van Moolenbroek #if LWIP_DHCP && SNTP_GET_SERVERS_FROM_DHCP
652*5d5fbe79SDavid van Moolenbroek /**
653*5d5fbe79SDavid van Moolenbroek  * Initialize one of the NTP servers by IP address, required by DHCP
654*5d5fbe79SDavid van Moolenbroek  *
655*5d5fbe79SDavid van Moolenbroek  * @param numdns the index of the NTP server to set must be < SNTP_MAX_SERVERS
656*5d5fbe79SDavid van Moolenbroek  * @param dnsserver IP address of the NTP server to set
657*5d5fbe79SDavid van Moolenbroek  */
658*5d5fbe79SDavid van Moolenbroek void
dhcp_set_ntp_servers(u8_t num,const ip4_addr_t * server)659*5d5fbe79SDavid van Moolenbroek dhcp_set_ntp_servers(u8_t num, const ip4_addr_t *server)
660*5d5fbe79SDavid van Moolenbroek {
661*5d5fbe79SDavid van Moolenbroek   LWIP_DEBUGF(SNTP_DEBUG_TRACE, ("sntp: %s %u.%u.%u.%u as NTP server #%u via DHCP\n",
662*5d5fbe79SDavid van Moolenbroek     (sntp_set_servers_from_dhcp ? "Got" : "Rejected"),
663*5d5fbe79SDavid van Moolenbroek     ip4_addr1(server), ip4_addr2(server), ip4_addr3(server), ip4_addr4(server), num));
664*5d5fbe79SDavid van Moolenbroek   if (sntp_set_servers_from_dhcp && num) {
665*5d5fbe79SDavid van Moolenbroek     u8_t i;
666*5d5fbe79SDavid van Moolenbroek     for (i = 0; (i < num) && (i < SNTP_MAX_SERVERS); i++) {
667*5d5fbe79SDavid van Moolenbroek       ip_addr_t addr;
668*5d5fbe79SDavid van Moolenbroek       ip_addr_copy_from_ip4(addr, server[i]);
669*5d5fbe79SDavid van Moolenbroek       sntp_setserver(i, &addr);
670*5d5fbe79SDavid van Moolenbroek     }
671*5d5fbe79SDavid van Moolenbroek     for (i = num; i < SNTP_MAX_SERVERS; i++) {
672*5d5fbe79SDavid van Moolenbroek       sntp_setserver(i, NULL);
673*5d5fbe79SDavid van Moolenbroek     }
674*5d5fbe79SDavid van Moolenbroek   }
675*5d5fbe79SDavid van Moolenbroek }
676*5d5fbe79SDavid van Moolenbroek #endif /* LWIP_DHCP && SNTP_GET_SERVERS_FROM_DHCP */
677*5d5fbe79SDavid van Moolenbroek 
678*5d5fbe79SDavid van Moolenbroek /**
679*5d5fbe79SDavid van Moolenbroek  * @ingroup sntp
680*5d5fbe79SDavid van Moolenbroek  * Obtain one of the currently configured by IP address (or DHCP) NTP servers
681*5d5fbe79SDavid van Moolenbroek  *
682*5d5fbe79SDavid van Moolenbroek  * @param idx the index of the NTP server
683*5d5fbe79SDavid van Moolenbroek  * @return IP address of the indexed NTP server or "ip_addr_any" if the NTP
684*5d5fbe79SDavid van Moolenbroek  *         server has not been configured by address (or at all).
685*5d5fbe79SDavid van Moolenbroek  */
686*5d5fbe79SDavid van Moolenbroek const ip_addr_t*
sntp_getserver(u8_t idx)687*5d5fbe79SDavid van Moolenbroek sntp_getserver(u8_t idx)
688*5d5fbe79SDavid van Moolenbroek {
689*5d5fbe79SDavid van Moolenbroek   if (idx < SNTP_MAX_SERVERS) {
690*5d5fbe79SDavid van Moolenbroek     return &sntp_servers[idx].addr;
691*5d5fbe79SDavid van Moolenbroek   }
692*5d5fbe79SDavid van Moolenbroek   return IP_ADDR_ANY;
693*5d5fbe79SDavid van Moolenbroek }
694*5d5fbe79SDavid van Moolenbroek 
695*5d5fbe79SDavid van Moolenbroek #if SNTP_SERVER_DNS
696*5d5fbe79SDavid van Moolenbroek /**
697*5d5fbe79SDavid van Moolenbroek  * Initialize one of the NTP servers by name
698*5d5fbe79SDavid van Moolenbroek  *
699*5d5fbe79SDavid van Moolenbroek  * @param numdns the index of the NTP server to set must be < SNTP_MAX_SERVERS
700*5d5fbe79SDavid van Moolenbroek  * @param dnsserver DNS name of the NTP server to set, to be resolved at contact time
701*5d5fbe79SDavid van Moolenbroek  */
702*5d5fbe79SDavid van Moolenbroek void
sntp_setservername(u8_t idx,char * server)703*5d5fbe79SDavid van Moolenbroek sntp_setservername(u8_t idx, char *server)
704*5d5fbe79SDavid van Moolenbroek {
705*5d5fbe79SDavid van Moolenbroek   if (idx < SNTP_MAX_SERVERS) {
706*5d5fbe79SDavid van Moolenbroek     sntp_servers[idx].name = server;
707*5d5fbe79SDavid van Moolenbroek   }
708*5d5fbe79SDavid van Moolenbroek }
709*5d5fbe79SDavid van Moolenbroek 
710*5d5fbe79SDavid van Moolenbroek /**
711*5d5fbe79SDavid van Moolenbroek  * Obtain one of the currently configured by name NTP servers.
712*5d5fbe79SDavid van Moolenbroek  *
713*5d5fbe79SDavid van Moolenbroek  * @param numdns the index of the NTP server
714*5d5fbe79SDavid van Moolenbroek  * @return IP address of the indexed NTP server or NULL if the NTP
715*5d5fbe79SDavid van Moolenbroek  *         server has not been configured by name (or at all)
716*5d5fbe79SDavid van Moolenbroek  */
717*5d5fbe79SDavid van Moolenbroek char *
sntp_getservername(u8_t idx)718*5d5fbe79SDavid van Moolenbroek sntp_getservername(u8_t idx)
719*5d5fbe79SDavid van Moolenbroek {
720*5d5fbe79SDavid van Moolenbroek   if (idx < SNTP_MAX_SERVERS) {
721*5d5fbe79SDavid van Moolenbroek     return sntp_servers[idx].name;
722*5d5fbe79SDavid van Moolenbroek   }
723*5d5fbe79SDavid van Moolenbroek   return NULL;
724*5d5fbe79SDavid van Moolenbroek }
725*5d5fbe79SDavid van Moolenbroek #endif /* SNTP_SERVER_DNS */
726*5d5fbe79SDavid van Moolenbroek 
727*5d5fbe79SDavid van Moolenbroek #endif /* LWIP_UDP */
728