LRSD stephane / Mbed 2 deprecated WEBserverv1

Important changes to repositories hosted on mbed.com

Mbed hosted mercurial repositories are deprecated and are due to be permanently deleted in July 2026.

To keep a copy of this software download the repository Zip archive or clone locally using Mercurial.

It is also possible to export all your personal repositories from the account settings page.

Dependencies:   mbed

lwip/SNTPClient/SNTPClient.cpp@0:4570f87afab6, 2011-09-03 (annotated)

Committer:
geiineuville
Date:
Sat Sep 03 09:42:32 2011 +0000
Revision:
0:4570f87afab6
v1

Who changed what in which revision?

UserRevisionLine numberNew contents of line
geiineuville 0:4570f87afab6 1 /*
geiineuville 0:4570f87afab6 2 * SNTPClient.cpp
geiineuville 0:4570f87afab6 3 * SNTP (Simple NTP) client
geiineuville 0:4570f87afab6 4 * Written by iva2k
geiineuville 0:4570f87afab6 5 *
geiineuville 0:4570f87afab6 6 * Wrapper around LWIP/sntp for MBED, with DST rules.
geiineuville 0:4570f87afab6 7 * This implementation relies on:
geiineuville 0:4570f87afab6 8 * 1. LWIP (http://www.sics.se/~adam/lwip/) adopted for MBED
geiineuville 0:4570f87afab6 9 * http://mbed.org/projects/cookbook/svn/EMAC/lwip/trunk
geiineuville 0:4570f87afab6 10 * 2. LWIP's contributed SNTP client (sntp.c and sntp.h) from
geiineuville 0:4570f87afab6 11 * http://cvs.savannah.gnu.org/viewvc/contrib/apps/sntp/?root=lwip
geiineuville 0:4570f87afab6 12 * (used version 1.8)
geiineuville 0:4570f87afab6 13 *
geiineuville 0:4570f87afab6 14 * Changes needed in LWIP/sntp:
geiineuville 0:4570f87afab6 15 * - pointer typecast (line 594) - fixes mbed compiler problem
geiineuville 0:4570f87afab6 16 * - #include "sntp.h" moved after lwip/opt.h et.al - for re-defines.
geiineuville 0:4570f87afab6 17 * - pbuf_free(p) in sntp_send_request() (line 602) - fixes memory leak BUG.
geiineuville 0:4570f87afab6 18 * - changing sntp_dns_found() to delayed sntp_try_next_server() - to unblock if network is disconnected.
geiineuville 0:4570f87afab6 19 *
geiineuville 0:4570f87afab6 20 * Changes in MBED's LWIP:
geiineuville 0:4570f87afab6 21 * - modified lwipopts.h (this file is automatically included into sntp.c)
geiineuville 0:4570f87afab6 22 *
geiineuville 0:4570f87afab6 23 * Requirements:
geiineuville 0:4570f87afab6 24 * + direct RTC update from receiving the NTP time packet
geiineuville 0:4570f87afab6 25 * + optionally support more than one NTP server
geiineuville 0:4570f87afab6 26 * + the IP address of the NTP server(s) stored in a local file
geiineuville 0:4570f87afab6 27 * + timeout error recovery should the NTP server(s) not be available. No RTC update should the NTP access fail
geiineuville 0:4570f87afab6 28 * + allow for a UTC offset, also stored in the local file
geiineuville 0:4570f87afab6 29 * + DST correction
geiineuville 0:4570f87afab6 30 * + use DNS for NTP servers IP address resolution
geiineuville 0:4570f87afab6 31 * + periodic updates at specified time intervals
geiineuville 0:4570f87afab6 32 *
geiineuville 0:4570f87afab6 33 * TODO:
geiineuville 0:4570f87afab6 34 * . DST correction
geiineuville 0:4570f87afab6 35 * - record metrics (count of updates, failed tries?, correction more than epsilon, etc.?)
geiineuville 0:4570f87afab6 36 */
geiineuville 0:4570f87afab6 37
geiineuville 0:4570f87afab6 38 #include "mbed.h"
geiineuville 0:4570f87afab6 39 #include "lwip/opt.h"
geiineuville 0:4570f87afab6 40 #include "SNTPClient.h"
geiineuville 0:4570f87afab6 41
geiineuville 0:4570f87afab6 42 #define SNTP_EPSILON 10 // time difference noticed as big update (in seconds).
geiineuville 0:4570f87afab6 43
geiineuville 0:4570f87afab6 44 //#define SNTP_DST_TESTS // Define this to run DST algorithms tests
geiineuville 0:4570f87afab6 45
geiineuville 0:4570f87afab6 46 typedef struct DST_ZONE_DESCR {
geiineuville 0:4570f87afab6 47 tDST_ZONE zone;
geiineuville 0:4570f87afab6 48 const char *name;
geiineuville 0:4570f87afab6 49 int gmt;
geiineuville 0:4570f87afab6 50 int dst;
geiineuville 0:4570f87afab6 51 int hr1;
geiineuville 0:4570f87afab6 52 int wk1;
geiineuville 0:4570f87afab6 53 int wday1;
geiineuville 0:4570f87afab6 54 int mon1;
geiineuville 0:4570f87afab6 55 int hr2;
geiineuville 0:4570f87afab6 56 int wk2;
geiineuville 0:4570f87afab6 57 int wday2;
geiineuville 0:4570f87afab6 58 int mon2;
geiineuville 0:4570f87afab6 59 pFncDstCalc fnc;
geiineuville 0:4570f87afab6 60 } tDST_ZONE_DESR;
geiineuville 0:4570f87afab6 61
geiineuville 0:4570f87afab6 62 static tDST_ZONE_DESR gSntpDstZones[] = {
geiineuville 0:4570f87afab6 63 #define _(z, fnc, gmt, dst, hr1,wk1,wday1,mon1, hr2,wk2,wday2,mon2) \
geiineuville 0:4570f87afab6 64 { z, #z, gmt, dst, hr1,wk1,wday1,mon1, hr2,wk2,wday2,mon2, fnc },
geiineuville 0:4570f87afab6 65 #include "DstZones.h"
geiineuville 0:4570f87afab6 66 };
geiineuville 0:4570f87afab6 67 #define DST_ZONE_DESCR_CNT (sizeof(gSntpDstZones)/sizeof(gSntpDstZones[0]))
geiineuville 0:4570f87afab6 68
geiineuville 0:4570f87afab6 69 const char *SNTPDstZoneName(tDST_ZONE zone) {
geiineuville 0:4570f87afab6 70 if (zone >= DST_ZONE_DESCR_CNT)
geiineuville 0:4570f87afab6 71 return "";
geiineuville 0:4570f87afab6 72 return gSntpDstZones[zone].name;
geiineuville 0:4570f87afab6 73 }
geiineuville 0:4570f87afab6 74
geiineuville 0:4570f87afab6 75 #ifdef __cplusplus
geiineuville 0:4570f87afab6 76 extern "C" {
geiineuville 0:4570f87afab6 77 #endif
geiineuville 0:4570f87afab6 78 tDST_ZONE gSntpDstZone = DST_NONE; // DST zone - rule selector
geiineuville 0:4570f87afab6 79 unsigned int gSntpRecvTimeout_s = 3; // 3 sec; SNTP_RECV_TIMEOUT
geiineuville 0:4570f87afab6 80 unsigned int gSntpUpdateDelay_s = 3600; // 1 hour; SNTP_UPDATE_DELAY
geiineuville 0:4570f87afab6 81 signed int gSntpTimezone = 0*3600; // seconds from UTC to local time
geiineuville 0:4570f87afab6 82 signed int gSntpDST = 0*3600; // seconds from UTC to local time
geiineuville 0:4570f87afab6 83 bool gSntpRtcUtc = false; // true to keep RTC in UTC, false to keep in local time
geiineuville 0:4570f87afab6 84 unsigned int gSntpUpdates = 0; // Track number of all clock NTP updates
geiineuville 0:4570f87afab6 85 unsigned int gSntpUpdatesBig = 0; // Track number of significant clock NTP updates
geiineuville 0:4570f87afab6 86 bool gSntpRunning = false; // true if SNTP service is running
geiineuville 0:4570f87afab6 87 Timeout gSntpDelay; // For async calls.
geiineuville 0:4570f87afab6 88 Ticker gSntpTicker; // There is no RTC interrupt on MBED (yet). Use (more wastefull) timer.
geiineuville 0:4570f87afab6 89 time_t gSntpRtcTCR = 0; // Timer Capture Register equivalent (in RTC time - either local or UTC depending on gSntpRtcUtc)
geiineuville 0:4570f87afab6 90 signed int gSntpRtcTCRDST = 0; // New DST value for when RTC crosses gSntpRtcTCR
geiineuville 0:4570f87afab6 91
geiineuville 0:4570f87afab6 92 static void SNTPSetDSTEx(unsigned int dst, bool adjust_clock) {
geiineuville 0:4570f87afab6 93 if (adjust_clock && !gSntpRtcUtc && gSntpDST != dst) {
geiineuville 0:4570f87afab6 94 time_t seconds = time(NULL);
geiineuville 0:4570f87afab6 95 seconds -= gSntpDST; // Convert from old local time
geiineuville 0:4570f87afab6 96 seconds += dst; // Convert to new local time
geiineuville 0:4570f87afab6 97 set_time(seconds);
geiineuville 0:4570f87afab6 98 if (gSntpRtcTCR) {
geiineuville 0:4570f87afab6 99 // Adjust our alarm clock
geiineuville 0:4570f87afab6 100 gSntpRtcTCR -= gSntpDST;
geiineuville 0:4570f87afab6 101 gSntpRtcTCR += dst;
geiineuville 0:4570f87afab6 102 }
geiineuville 0:4570f87afab6 103 }
geiineuville 0:4570f87afab6 104 gSntpDST = dst;
geiineuville 0:4570f87afab6 105 }
geiineuville 0:4570f87afab6 106
geiineuville 0:4570f87afab6 107 #if 0
geiineuville 0:4570f87afab6 108 // Custom DST zone function example
geiineuville 0:4570f87afab6 109 // USA (since 2007)
geiineuville 0:4570f87afab6 110 // Calculate start or stop DST point for given year based on rules
geiineuville 0:4570f87afab6 111 // tz - Timezone
geiineuville 0:4570f87afab6 112 // year - current year. DST changes well away from year end, so does not matter what timezone.
geiineuville 0:4570f87afab6 113 // start - DST_START for start, DST_STOP for stop
geiineuville 0:4570f87afab6 114 // Returns DST point (in local time). DST_STOP time is in DST
geiineuville 0:4570f87afab6 115 static tDstPoint _sntp_dst_calc_custom(int tz, int year, tDST_START start) {
geiineuville 0:4570f87afab6 116 tDstPoint ret;
geiineuville 0:4570f87afab6 117 struct tm t;
geiineuville 0:4570f87afab6 118
geiineuville 0:4570f87afab6 119 // USA: 3600; 2, Second SUN, March; 2, First SUN, November
geiineuville 0:4570f87afab6 120 int dst = 3600; // DST shift (seconds)
geiineuville 0:4570f87afab6 121 int hour; // Hour of the change
geiineuville 0:4570f87afab6 122 int N; // Week in the month
geiineuville 0:4570f87afab6 123 int wday; // Day of the week
geiineuville 0:4570f87afab6 124 int month;
geiineuville 0:4570f87afab6 125 if (start == DST_START) {
geiineuville 0:4570f87afab6 126 hour = 2; // (0-23) Hour of the change
geiineuville 0:4570f87afab6 127 N = 2-1; // 2nd in the month
geiineuville 0:4570f87afab6 128 wday = 0; // Sunday
geiineuville 0:4570f87afab6 129 month = 2; // March
geiineuville 0:4570f87afab6 130 } else { // DST_STOP
geiineuville 0:4570f87afab6 131 hour = 2; // (0-23) Hour of the change
geiineuville 0:4570f87afab6 132 N = 1-1; // 1st in the month
geiineuville 0:4570f87afab6 133 wday = 0; // Sunday
geiineuville 0:4570f87afab6 134 month = 10; // November
geiineuville 0:4570f87afab6 135 }
geiineuville 0:4570f87afab6 136
geiineuville 0:4570f87afab6 137 t.tm_sec = 0; // 0-59
geiineuville 0:4570f87afab6 138 t.tm_min = 0; // 0-59
geiineuville 0:4570f87afab6 139 t.tm_hour = hour; // 0-23
geiineuville 0:4570f87afab6 140 t.tm_year = year - 1900; //
geiineuville 0:4570f87afab6 141 t.tm_mon = month; // 0-11
geiineuville 0:4570f87afab6 142 t.tm_mday = 1+N*7; // 1-31, first possible date for Nth given weekday
geiineuville 0:4570f87afab6 143 mktime(&t); // Calculate tm_wday
geiineuville 0:4570f87afab6 144 t.tm_mday += (wday-t.tm_wday+14)%7; // Shift to wday
geiineuville 0:4570f87afab6 145 ret.t = mktime(&t);
geiineuville 0:4570f87afab6 146 ret.dst = (start == DST_START) ? dst : 0;
geiineuville 0:4570f87afab6 147 ret.dstshift = dst;
geiineuville 0:4570f87afab6 148 return ret;
geiineuville 0:4570f87afab6 149 }
geiineuville 0:4570f87afab6 150 #endif
geiineuville 0:4570f87afab6 151
geiineuville 0:4570f87afab6 152 // Calculate start or stop DST point for given year based on rules for the DST zone
geiineuville 0:4570f87afab6 153 // tz - Timezone
geiineuville 0:4570f87afab6 154 // zone - DST zone
geiineuville 0:4570f87afab6 155 // year - current year. DST changes well away from year end, so does not matter timezone.
geiineuville 0:4570f87afab6 156 // start - DST_START for start, DST_STOP for stop
geiineuville 0:4570f87afab6 157 // Returns DST point (in standard local time). DST_STOP time is in NOT IN DST
geiineuville 0:4570f87afab6 158 static tDstPoint _sntp_dst_calc(int tz, tDST_ZONE zone, int year, tDST_START start) {
geiineuville 0:4570f87afab6 159 tDstPoint ret;
geiineuville 0:4570f87afab6 160
geiineuville 0:4570f87afab6 161 ret.t = 0;
geiineuville 0:4570f87afab6 162 ret.dst = 0;
geiineuville 0:4570f87afab6 163 ret.dstshift = 0;
geiineuville 0:4570f87afab6 164 if (zone == DST_NONE || zone >= DST_ZONE_DESCR_CNT)
geiineuville 0:4570f87afab6 165 return ret;
geiineuville 0:4570f87afab6 166
geiineuville 0:4570f87afab6 167 tDST_ZONE_DESR *descr = &gSntpDstZones[zone];
geiineuville 0:4570f87afab6 168 if (descr->fnc) {
geiineuville 0:4570f87afab6 169 // Use custom function
geiineuville 0:4570f87afab6 170 ret = descr->fnc(tz, year, start);
geiineuville 0:4570f87afab6 171 } else {
geiineuville 0:4570f87afab6 172 // Use rules
geiineuville 0:4570f87afab6 173 struct tm t;
geiineuville 0:4570f87afab6 174 t.tm_sec = 0; // 0-59
geiineuville 0:4570f87afab6 175 t.tm_min = 0; // 0-59
geiineuville 0:4570f87afab6 176 t.tm_hour = (start == DST_START) ? descr->hr1 : descr->hr2;
geiineuville 0:4570f87afab6 177 t.tm_year = year - 1900; //
geiineuville 0:4570f87afab6 178 t.tm_mon = (start == DST_START) ? descr->mon1 : descr->mon2; // 0-11
geiineuville 0:4570f87afab6 179 int wk =((start == DST_START) ? descr->wk1 : descr->wk2) -1;
geiineuville 0:4570f87afab6 180 int wday = (start == DST_START) ? descr->wday1: descr->wday2;
geiineuville 0:4570f87afab6 181 if (wk < 0) {
geiineuville 0:4570f87afab6 182 // For "Last in the month" - we go to next month, then move back by one week
geiineuville 0:4570f87afab6 183 t.tm_mon += 1; // 0-11
geiineuville 0:4570f87afab6 184 if (t.tm_mon > 11) {
geiineuville 0:4570f87afab6 185 t.tm_mon -= 12;
geiineuville 0:4570f87afab6 186 t.tm_year += 1;
geiineuville 0:4570f87afab6 187 }
geiineuville 0:4570f87afab6 188 t.tm_mday = 1+0*7; // 1-31, first possible date for Nth given weekday
geiineuville 0:4570f87afab6 189 } else {
geiineuville 0:4570f87afab6 190 t.tm_mday = 1+wk*7; // 1-31, first possible date for Nth given weekday
geiineuville 0:4570f87afab6 191 }
geiineuville 0:4570f87afab6 192 mktime(&t); // Calculate tm_wday
geiineuville 0:4570f87afab6 193 t.tm_mday += (wday-t.tm_wday+14)%7; // Shift to wday
geiineuville 0:4570f87afab6 194 ret.t = mktime(&t);
geiineuville 0:4570f87afab6 195 if (wk < 0) {
geiineuville 0:4570f87afab6 196 ret.t -= 7 * 24 * 3600;
geiineuville 0:4570f87afab6 197 }
geiineuville 0:4570f87afab6 198 if (descr->gmt) {
geiineuville 0:4570f87afab6 199 ret.t += tz;
geiineuville 0:4570f87afab6 200 }
geiineuville 0:4570f87afab6 201 ret.dst = (start == DST_START) ? descr->dst : 0;
geiineuville 0:4570f87afab6 202 ret.dstshift = descr->dst;
geiineuville 0:4570f87afab6 203 }
geiineuville 0:4570f87afab6 204 if (start == DST_STOP) {
geiineuville 0:4570f87afab6 205 ret.t -= ret.dstshift;
geiineuville 0:4570f87afab6 206 // this correction is due to the fact that rules are given in local time with DST,
geiineuville 0:4570f87afab6 207 // but calculations are made in standard local time (without DST adjustment)
geiineuville 0:4570f87afab6 208 }
geiineuville 0:4570f87afab6 209 return ret;
geiineuville 0:4570f87afab6 210 }
geiineuville 0:4570f87afab6 211
geiineuville 0:4570f87afab6 212 // Calculate desired DST point relative to now based on rules for the DST zone
geiineuville 0:4570f87afab6 213 // tz - timezone
geiineuville 0:4570f87afab6 214 // zone - DST zone
geiineuville 0:4570f87afab6 215 // now - current time (standard local time = excluding DST).
geiineuville 0:4570f87afab6 216 // index - 0 for immediate next, +1 for second next, -1 for immediate previous
geiineuville 0:4570f87afab6 217 // Returns DST point (in standard local time)
geiineuville 0:4570f87afab6 218 static tDstPoint _sntp_dst_point(int tz, tDST_ZONE zone, time_t now, int index) {
geiineuville 0:4570f87afab6 219 tDstPoint ret;
geiineuville 0:4570f87afab6 220 int year;
geiineuville 0:4570f87afab6 221 tDST_START type;
geiineuville 0:4570f87afab6 222 struct tm *pt = localtime(&now);
geiineuville 0:4570f87afab6 223
geiineuville 0:4570f87afab6 224 ret.t = 0;
geiineuville 0:4570f87afab6 225 ret.dst = 0;
geiineuville 0:4570f87afab6 226 ret.dstshift = 0;
geiineuville 0:4570f87afab6 227 if (zone == DST_NONE || zone >= DST_ZONE_DESCR_CNT)
geiineuville 0:4570f87afab6 228 return ret;
geiineuville 0:4570f87afab6 229
geiineuville 0:4570f87afab6 230 // Algorithm
geiineuville 0:4570f87afab6 231 // 1. Determine where now is in respect to current year DST points (find for index=0)
geiineuville 0:4570f87afab6 232 // 2. Use index to shift year and type
geiineuville 0:4570f87afab6 233 // 3. return the point
geiineuville 0:4570f87afab6 234 // This algorithm relies on DST start date being before DST stop date in the year.
geiineuville 0:4570f87afab6 235
geiineuville 0:4570f87afab6 236 year = pt->tm_year + 1900;
geiineuville 0:4570f87afab6 237 type = DST_START;
geiineuville 0:4570f87afab6 238 ret = _sntp_dst_calc(tz, zone, year, type);
geiineuville 0:4570f87afab6 239 if (now > ret.t) {
geiineuville 0:4570f87afab6 240 type = DST_STOP;
geiineuville 0:4570f87afab6 241 ret = _sntp_dst_calc(tz, zone, year, type);
geiineuville 0:4570f87afab6 242 if (now > ret.t) {
geiineuville 0:4570f87afab6 243 // It is next year's start point
geiineuville 0:4570f87afab6 244 type = DST_START;
geiineuville 0:4570f87afab6 245 year += 1;
geiineuville 0:4570f87afab6 246 }
geiineuville 0:4570f87afab6 247 }
geiineuville 0:4570f87afab6 248 // Now year and type are right for index=0
geiineuville 0:4570f87afab6 249
geiineuville 0:4570f87afab6 250 // Calculate where index points to - shift year and type
geiineuville 0:4570f87afab6 251 int norm = (index > 0) ? (int)(index/2) : (int)((index-1)/2);
geiineuville 0:4570f87afab6 252 year += norm;
geiineuville 0:4570f87afab6 253 index -= norm*2; // Now index is (0,1)
geiineuville 0:4570f87afab6 254 if (index) {
geiineuville 0:4570f87afab6 255 // Flip the type
geiineuville 0:4570f87afab6 256 type = (type == DST_START) ? DST_STOP : DST_START;
geiineuville 0:4570f87afab6 257 }
geiineuville 0:4570f87afab6 258
geiineuville 0:4570f87afab6 259 ret = _sntp_dst_calc(tz, zone, year, type);
geiineuville 0:4570f87afab6 260 return ret;
geiineuville 0:4570f87afab6 261
geiineuville 0:4570f87afab6 262 // struct tm t;
geiineuville 0:4570f87afab6 263 // t.tm_sec = 0; // 0-59
geiineuville 0:4570f87afab6 264 // t.tm_min = 0; // 0-59
geiineuville 0:4570f87afab6 265 // t.tm_hour = 0; // 0-23
geiineuville 0:4570f87afab6 266 // t.tm_mday = 0; // 1-31
geiineuville 0:4570f87afab6 267 // t.tm_mon = 0; // 0-11
geiineuville 0:4570f87afab6 268 // t.tm_year = 2005-1900; // year since 1900
geiineuville 0:4570f87afab6 269 // t.tm_wday = 0; // 0-6 Day of week (Sunday = 0)
geiineuville 0:4570f87afab6 270 // t.tm_yday = 0; // Day of year (0 - 365)
geiineuville 0:4570f87afab6 271 // t.tm_isdst = -1; // Nonzero = Daylight saving time
geiineuville 0:4570f87afab6 272 }
geiineuville 0:4570f87afab6 273
geiineuville 0:4570f87afab6 274 #if defined(LWIP_DEBUG)
geiineuville 0:4570f87afab6 275 // Print DST dates report
geiineuville 0:4570f87afab6 276 static void _sntp_dst_dates(int tz, tDST_ZONE zone, int year) {
geiineuville 0:4570f87afab6 277 char _buffer[64];
geiineuville 0:4570f87afab6 278 tDstPoint r;
geiineuville 0:4570f87afab6 279 printf("\r\nDST DATES for zone %d/%s:\r\n", (int)zone, SNTPDstZoneName(zone));
geiineuville 0:4570f87afab6 280
geiineuville 0:4570f87afab6 281 r = _sntp_dst_calc(tz, zone, year, DST_START);
geiineuville 0:4570f87afab6 282 strftime(_buffer, sizeof(_buffer), "%A %m/%d/%Y %H:%M:%S", localtime(&r.t));
geiineuville 0:4570f87afab6 283 printf(" %d DST BEGINS (+%04d sec) %s\r\n", year, r.dst, _buffer);
geiineuville 0:4570f87afab6 284
geiineuville 0:4570f87afab6 285 r = _sntp_dst_calc(tz, zone, year, DST_STOP);
geiineuville 0:4570f87afab6 286 strftime(_buffer, sizeof(_buffer), "%A %m/%d/%Y %H:%M:%S", localtime(&r.t));
geiineuville 0:4570f87afab6 287 printf(" %d DST ENDS (+%04d sec) %s\r\n", year, r.dst, _buffer);
geiineuville 0:4570f87afab6 288 }
geiineuville 0:4570f87afab6 289 #endif
geiineuville 0:4570f87afab6 290
geiineuville 0:4570f87afab6 291 #ifdef SNTP_DST_TESTS
geiineuville 0:4570f87afab6 292 static void test_sntp_dst_calc(int tz, tDST_ZONE zone) {
geiineuville 0:4570f87afab6 293 char _buffer[64];
geiineuville 0:4570f87afab6 294 tDstPoint r;
geiineuville 0:4570f87afab6 295 int year;
geiineuville 0:4570f87afab6 296
geiineuville 0:4570f87afab6 297 printf("\r\nTEST: _sntp_dst_calc(tz=%d, zone=%d/%s)\r\n", tz, (int)zone, SNTPDstZoneName(zone));
geiineuville 0:4570f87afab6 298
geiineuville 0:4570f87afab6 299 for (year = 1999; year < 2016; year++) {
geiineuville 0:4570f87afab6 300 r = _sntp_dst_calc(tz, zone, year, DST_START);
geiineuville 0:4570f87afab6 301 strftime(_buffer, sizeof(_buffer), "%A %m/%d/%Y %H:%M:%S", localtime(&r.t));
geiineuville 0:4570f87afab6 302 printf(" (0,%d,start) %s %d\r\n", year, _buffer, r.dst);
geiineuville 0:4570f87afab6 303
geiineuville 0:4570f87afab6 304 r = _sntp_dst_calc(tz, zone, year, DST_STOP);
geiineuville 0:4570f87afab6 305 strftime(_buffer, sizeof(_buffer), "%A %m/%d/%Y %H:%M:%S", localtime(&r.t));
geiineuville 0:4570f87afab6 306 printf(" (0,%d,stop ) %s %d\r\n", year, _buffer, r.dst);
geiineuville 0:4570f87afab6 307 }
geiineuville 0:4570f87afab6 308 }
geiineuville 0:4570f87afab6 309
geiineuville 0:4570f87afab6 310 static void test_sntp_dst_point(int index) {
geiineuville 0:4570f87afab6 311 char _buffer[64];
geiineuville 0:4570f87afab6 312 struct tm t;
geiineuville 0:4570f87afab6 313 tDstPoint r;
geiineuville 0:4570f87afab6 314 int tz=gSntpTimezone;
geiineuville 0:4570f87afab6 315 tDST_ZONE zone=gSntpDstZone;
geiineuville 0:4570f87afab6 316 int year = 2009, day, month;
geiineuville 0:4570f87afab6 317
geiineuville 0:4570f87afab6 318 int norm = (index > 0) ? (int)(index/2) : (int)((index-1)/2);
geiineuville 0:4570f87afab6 319 printf("\r\nTEST: _sntp_dst_point(%d) norm=%d\r\n", index, norm);
geiineuville 0:4570f87afab6 320
geiineuville 0:4570f87afab6 321 t.tm_sec = 0; // 0-59
geiineuville 0:4570f87afab6 322 t.tm_min = 0; // 0-59
geiineuville 0:4570f87afab6 323 t.tm_hour = 9; // 0-23
geiineuville 0:4570f87afab6 324 t.tm_year = year-1900;
geiineuville 0:4570f87afab6 325
geiineuville 0:4570f87afab6 326 day = 1;
geiineuville 0:4570f87afab6 327 for (month = 0; month < 2; month++) {
geiineuville 0:4570f87afab6 328 t.tm_mon = month;
geiineuville 0:4570f87afab6 329 t.tm_mday = day;
geiineuville 0:4570f87afab6 330 t.tm_year = year-1900;
geiineuville 0:4570f87afab6 331 r = _sntp_dst_point(tz, zone, mktime(&t), index);
geiineuville 0:4570f87afab6 332 strftime(_buffer, sizeof(_buffer), "%A %m/%d/%Y %H:%M:%S", localtime(&r.t));
geiineuville 0:4570f87afab6 333 printf(" (0,%02d/%02d/%d,%d) %s %d\r\n", month+1, day, year, index, _buffer, r.dst);
geiineuville 0:4570f87afab6 334 }
geiineuville 0:4570f87afab6 335
geiineuville 0:4570f87afab6 336 for (day = 1; day < 32; day++) {
geiineuville 0:4570f87afab6 337 t.tm_mon = month;
geiineuville 0:4570f87afab6 338 t.tm_mday = day;
geiineuville 0:4570f87afab6 339 t.tm_year = year-1900;
geiineuville 0:4570f87afab6 340 r = _sntp_dst_point(tz, zone, mktime(&t), index);
geiineuville 0:4570f87afab6 341 strftime(_buffer, sizeof(_buffer), "%A %m/%d/%Y %H:%M:%S", localtime(&r.t));
geiineuville 0:4570f87afab6 342 printf(" (0,%02d/%02d/%d,%d) %s %d\r\n", month+1, day, year, index, _buffer, r.dst);
geiineuville 0:4570f87afab6 343 }
geiineuville 0:4570f87afab6 344
geiineuville 0:4570f87afab6 345 day = 30;
geiineuville 0:4570f87afab6 346 for (; month < 10; month++) {
geiineuville 0:4570f87afab6 347 t.tm_mon = month;
geiineuville 0:4570f87afab6 348 t.tm_mday = day;
geiineuville 0:4570f87afab6 349 t.tm_year = year-1900;
geiineuville 0:4570f87afab6 350 r = _sntp_dst_point(tz, zone, mktime(&t), index);
geiineuville 0:4570f87afab6 351 strftime(_buffer, sizeof(_buffer), "%A %m/%d/%Y %H:%M:%S", localtime(&r.t));
geiineuville 0:4570f87afab6 352 printf(" (0,%02d/%02d/%d,%d) %s %d\r\n", month+1, day, year, index, _buffer, r.dst);
geiineuville 0:4570f87afab6 353 }
geiineuville 0:4570f87afab6 354
geiineuville 0:4570f87afab6 355 for (day = 1; day < 32; day++) {
geiineuville 0:4570f87afab6 356 t.tm_mon = month;
geiineuville 0:4570f87afab6 357 t.tm_mday = day;
geiineuville 0:4570f87afab6 358 t.tm_year = year-1900;
geiineuville 0:4570f87afab6 359 r = _sntp_dst_point(tz, zone, mktime(&t), index);
geiineuville 0:4570f87afab6 360 strftime(_buffer, sizeof(_buffer), "%A %m/%d/%Y %H:%M:%S", localtime(&r.t));
geiineuville 0:4570f87afab6 361 printf(" (0,%02d/%02d/%d,%d) %s %d\r\n", month+1, day, year, index, _buffer, r.dst);
geiineuville 0:4570f87afab6 362 }
geiineuville 0:4570f87afab6 363
geiineuville 0:4570f87afab6 364 }
geiineuville 0:4570f87afab6 365 #endif // SNTP_DST_TESTS
geiineuville 0:4570f87afab6 366
geiineuville 0:4570f87afab6 367 // Set current DST
geiineuville 0:4570f87afab6 368 static void _sntp_dst_now(void) {
geiineuville 0:4570f87afab6 369 time_t now = time(NULL);
geiineuville 0:4570f87afab6 370 // Convert to standart local time (no DST)
geiineuville 0:4570f87afab6 371 now = gSntpRtcUtc ? (now + gSntpTimezone) : (now - gSntpDST);
geiineuville 0:4570f87afab6 372
geiineuville 0:4570f87afab6 373 // Check DST setting for now
geiineuville 0:4570f87afab6 374 tDstPoint dst = _sntp_dst_point(gSntpTimezone, gSntpDstZone, now, -1);
geiineuville 0:4570f87afab6 375
geiineuville 0:4570f87afab6 376 #ifdef LWIP_DEBUG
geiineuville 0:4570f87afab6 377 char _buffer[64];
geiineuville 0:4570f87afab6 378 strftime(_buffer, sizeof(_buffer), "%A %m/%d/%Y %H:%M:%S", localtime(&dst.t));
geiineuville 0:4570f87afab6 379 LWIP_DEBUGF(SNTP_DEBUG_STATE, (
geiineuville 0:4570f87afab6 380 "DEBUG: _sntp_dst_now(%d) based on last DST change on (%d) %s to (+%04d sec)\r\n",
geiineuville 0:4570f87afab6 381 now, dst.t, _buffer, dst.dst));
geiineuville 0:4570f87afab6 382 #endif
geiineuville 0:4570f87afab6 383
geiineuville 0:4570f87afab6 384 // Change RTC
geiineuville 0:4570f87afab6 385 SNTPSetDSTEx(dst.dst, true);
geiineuville 0:4570f87afab6 386 }
geiineuville 0:4570f87afab6 387
geiineuville 0:4570f87afab6 388 // Plan for next DST change
geiineuville 0:4570f87afab6 389 static void _sntp_dst_schedule(void) {
geiineuville 0:4570f87afab6 390 time_t now = time(NULL);
geiineuville 0:4570f87afab6 391 // Convert to standart local time (no DST)
geiineuville 0:4570f87afab6 392 now = gSntpRtcUtc ? (now + gSntpTimezone) : (now - gSntpDST);
geiineuville 0:4570f87afab6 393
geiineuville 0:4570f87afab6 394 // Check next DST change point
geiineuville 0:4570f87afab6 395 tDstPoint dst = _sntp_dst_point(gSntpTimezone, gSntpDstZone, now, 0);
geiineuville 0:4570f87afab6 396
geiineuville 0:4570f87afab6 397 if (dst.t) {
geiineuville 0:4570f87afab6 398
geiineuville 0:4570f87afab6 399 #ifdef LWIP_DEBUG
geiineuville 0:4570f87afab6 400 char _buffer[64];
geiineuville 0:4570f87afab6 401 strftime(_buffer, sizeof(_buffer), "%A %m/%d/%Y %H:%M:%S", localtime(&dst.t));
geiineuville 0:4570f87afab6 402 #endif
geiineuville 0:4570f87afab6 403
geiineuville 0:4570f87afab6 404 // Set our alarm clock
geiineuville 0:4570f87afab6 405 // Convert from standard local to UTC time or local time
geiineuville 0:4570f87afab6 406 dst.t = gSntpRtcUtc ? (dst.t - gSntpTimezone) : (dst.t + gSntpDST);
geiineuville 0:4570f87afab6 407
geiineuville 0:4570f87afab6 408 #ifdef LWIP_DEBUG
geiineuville 0:4570f87afab6 409 if (time(NULL) > dst.t) {
geiineuville 0:4570f87afab6 410 LWIP_DEBUGF(SNTP_DEBUG_STATE, (
geiineuville 0:4570f87afab6 411 "DEBUG: _sntp_dst_schedule() ASSERTION FAILED !(%d<%d) trying to schedule for the past: %s (+%04d sec)\r\n",
geiineuville 0:4570f87afab6 412 time(NULL), dst.t, _buffer, dst.dst));
geiineuville 0:4570f87afab6 413 } else {
geiineuville 0:4570f87afab6 414 LWIP_DEBUGF(SNTP_DEBUG_STATE, (
geiineuville 0:4570f87afab6 415 "DEBUG: _sntp_dst_schedule() scheduled in %d seconds, set for %s (+%04d sec)\r\n",
geiineuville 0:4570f87afab6 416 dst.t-time(NULL), _buffer, dst.dst));
geiineuville 0:4570f87afab6 417 }
geiineuville 0:4570f87afab6 418 #endif
geiineuville 0:4570f87afab6 419 }
geiineuville 0:4570f87afab6 420 gSntpRtcTCR = dst.t;
geiineuville 0:4570f87afab6 421 gSntpRtcTCRDST = dst.dst;
geiineuville 0:4570f87afab6 422 }
geiineuville 0:4570f87afab6 423
geiineuville 0:4570f87afab6 424 // RTC ISR - called upon each RTC tick
geiineuville 0:4570f87afab6 425 static void _sntp_isr(void) {
geiineuville 0:4570f87afab6 426 time_t seconds = time(NULL);
geiineuville 0:4570f87afab6 427 if (gSntpRtcTCR && seconds > gSntpRtcTCR ) {
geiineuville 0:4570f87afab6 428 // DST change has arrived
geiineuville 0:4570f87afab6 429 gSntpRtcTCR = 0;
geiineuville 0:4570f87afab6 430 // Disable ISR and avoid extra calcs in SNTPSetDSTEx()
geiineuville 0:4570f87afab6 431
geiineuville 0:4570f87afab6 432 //if (gSntpRtcTCRDST != gSntpDST) {
geiineuville 0:4570f87afab6 433 // Change to/from DST
geiineuville 0:4570f87afab6 434 SNTPSetDSTEx(gSntpRtcTCRDST, true);
geiineuville 0:4570f87afab6 435 gSntpRtcTCRDST = 0;
geiineuville 0:4570f87afab6 436
geiineuville 0:4570f87afab6 437 // Schedule callback to plan for next DST change (take it out of ISR context)
geiineuville 0:4570f87afab6 438 gSntpDelay.attach(_sntp_dst_schedule, 1.0);
geiineuville 0:4570f87afab6 439
geiineuville 0:4570f87afab6 440 #ifdef LWIP_DEBUG
geiineuville 0:4570f87afab6 441 char _buffer[64];
geiineuville 0:4570f87afab6 442 if (gSntpRtcUtc) {
geiineuville 0:4570f87afab6 443 seconds += gSntpTimezone + gSntpDST; // Convert to local time
geiineuville 0:4570f87afab6 444 }
geiineuville 0:4570f87afab6 445 strftime(_buffer, sizeof(_buffer), "%A %m/%d/%Y %H:%M:%S", localtime(&seconds));
geiineuville 0:4570f87afab6 446 LWIP_DEBUGF(SNTP_DEBUG_STATE, (
geiineuville 0:4570f87afab6 447 "DEBUG: _sntp_isr() changed DST. datetime=%s\r\n", _buffer));
geiineuville 0:4570f87afab6 448 #endif
geiineuville 0:4570f87afab6 449
geiineuville 0:4570f87afab6 450 //}
geiineuville 0:4570f87afab6 451
geiineuville 0:4570f87afab6 452 }
geiineuville 0:4570f87afab6 453 }
geiineuville 0:4570f87afab6 454
geiineuville 0:4570f87afab6 455 // NTP Callback - timestamp from NTP server arrives here
geiineuville 0:4570f87afab6 456 void SntpClientSet(time_t seconds) {
geiineuville 0:4570f87afab6 457 time_t old_seconds = time(NULL);
geiineuville 0:4570f87afab6 458 if (!gSntpRtcUtc) {
geiineuville 0:4570f87afab6 459 seconds += gSntpTimezone + gSntpDST; // Convert to local time
geiineuville 0:4570f87afab6 460 }
geiineuville 0:4570f87afab6 461 set_time(seconds);
geiineuville 0:4570f87afab6 462
geiineuville 0:4570f87afab6 463 // Special tasks for the very first NTP updates
geiineuville 0:4570f87afab6 464 if (!gSntpUpdates) {
geiineuville 0:4570f87afab6 465
geiineuville 0:4570f87afab6 466 #if defined(LWIP_DEBUG)
geiineuville 0:4570f87afab6 467 // Report DST dates for the zone
geiineuville 0:4570f87afab6 468 struct tm *pt = localtime(&seconds);
geiineuville 0:4570f87afab6 469 _sntp_dst_dates(gSntpTimezone, gSntpDstZone, pt->tm_year+1900);
geiineuville 0:4570f87afab6 470 #endif
geiineuville 0:4570f87afab6 471
geiineuville 0:4570f87afab6 472 // DST scheduler
geiineuville 0:4570f87afab6 473 _sntp_dst_now();
geiineuville 0:4570f87afab6 474 _sntp_dst_schedule();
geiineuville 0:4570f87afab6 475
geiineuville 0:4570f87afab6 476 // Enable RTC ISR
geiineuville 0:4570f87afab6 477 gSntpTicker.attach(_sntp_isr, 1.0);
geiineuville 0:4570f87afab6 478 }
geiineuville 0:4570f87afab6 479
geiineuville 0:4570f87afab6 480 if (gSntpUpdates && abs((int)(old_seconds - seconds)) > SNTP_EPSILON) {
geiineuville 0:4570f87afab6 481 printf("SNTP settime() corrected big difference: (%d) seconds, more than %d. Big updates count=%d.\r\n",
geiineuville 0:4570f87afab6 482 old_seconds-seconds, SNTP_EPSILON, gSntpUpdatesBig);
geiineuville 0:4570f87afab6 483 gSntpUpdatesBig ++;
geiineuville 0:4570f87afab6 484 }
geiineuville 0:4570f87afab6 485
geiineuville 0:4570f87afab6 486 gSntpUpdates++;
geiineuville 0:4570f87afab6 487
geiineuville 0:4570f87afab6 488 if (1) {
geiineuville 0:4570f87afab6 489 char _buffer[64];
geiineuville 0:4570f87afab6 490 if (gSntpRtcUtc) {
geiineuville 0:4570f87afab6 491 seconds += gSntpTimezone + gSntpDST; // Convert to local time
geiineuville 0:4570f87afab6 492 }
geiineuville 0:4570f87afab6 493 strftime(_buffer, sizeof(_buffer), "%A %m/%d/%Y %H:%M:%S", localtime(&seconds));
geiineuville 0:4570f87afab6 494 printf("SNTP settime() #%d seconds=%d TZ=%0.1f datetime=%s\r\n",
geiineuville 0:4570f87afab6 495 gSntpUpdates, seconds, gSntpTimezone/3600.0, _buffer);
geiineuville 0:4570f87afab6 496 }
geiineuville 0:4570f87afab6 497 }
geiineuville 0:4570f87afab6 498 #ifdef __cplusplus
geiineuville 0:4570f87afab6 499 };
geiineuville 0:4570f87afab6 500 #endif
geiineuville 0:4570f87afab6 501
geiineuville 0:4570f87afab6 502 #ifdef __cplusplus
geiineuville 0:4570f87afab6 503 extern "C" {
geiineuville 0:4570f87afab6 504 #endif
geiineuville 0:4570f87afab6 505
geiineuville 0:4570f87afab6 506 #include "lwip/def.h"
geiineuville 0:4570f87afab6 507 #include "lwip/pbuf.h"
geiineuville 0:4570f87afab6 508 #include "lwip/sys.h"
geiineuville 0:4570f87afab6 509 #include "lwip/stats.h"
geiineuville 0:4570f87afab6 510 #include "netif/etharp.h"
geiineuville 0:4570f87afab6 511 #include "string.h"
geiineuville 0:4570f87afab6 512
geiineuville 0:4570f87afab6 513 #ifdef __cplusplus
geiineuville 0:4570f87afab6 514 };
geiineuville 0:4570f87afab6 515 #endif
geiineuville 0:4570f87afab6 516
geiineuville 0:4570f87afab6 517 // Accomodating sntp timeout functions
geiineuville 0:4570f87afab6 518 #if NO_SYS
geiineuville 0:4570f87afab6 519 #include "sntp.h"
geiineuville 0:4570f87afab6 520 extern void sntp_request(void *arg); // this is dirty hack around "static" function. Some linkers may revolt!
geiineuville 0:4570f87afab6 521 extern void sntp_try_next_server(void *arg);
geiineuville 0:4570f87afab6 522 extern char* sntp_server_addresses[];
geiineuville 0:4570f87afab6 523 extern u8_t sntp_current_server;
geiineuville 0:4570f87afab6 524 extern u8_t sntp_num_servers;
geiineuville 0:4570f87afab6 525 static void (*sntp_addresses_free)(void*) = NULL;
geiineuville 0:4570f87afab6 526 static Timeout _sntp_timer1;
geiineuville 0:4570f87afab6 527 static Timeout _sntp_timer2;
geiineuville 0:4570f87afab6 528 void sntp_sys_timeout(u32_t timeout_s, void (*func)(void *arg), void *arg) {
geiineuville 0:4570f87afab6 529 // all we really need to track is only 2 functions: sntp_request, sntp_try_next_server
geiineuville 0:4570f87afab6 530 Timeout *t = NULL;
geiineuville 0:4570f87afab6 531 if (func == &sntp_request) {
geiineuville 0:4570f87afab6 532 t = &_sntp_timer1;
geiineuville 0:4570f87afab6 533 LWIP_DEBUGF(SNTP_DEBUG_STATE, ("DEBUG: IN sntp_sys_timeout(), func=sntp_request\r\n"));
geiineuville 0:4570f87afab6 534 } else if (func == &sntp_try_next_server) {
geiineuville 0:4570f87afab6 535 t = &_sntp_timer2;
geiineuville 0:4570f87afab6 536 LWIP_DEBUGF(SNTP_DEBUG_STATE, ("DEBUG: IN sntp_sys_timeout(), func=sntp_try_next_server\r\n"));
geiineuville 0:4570f87afab6 537 }
geiineuville 0:4570f87afab6 538 if (t) {
geiineuville 0:4570f87afab6 539 t->detach();
geiineuville 0:4570f87afab6 540 t->attach((void(*)(void))func, 1.0*timeout_s);
geiineuville 0:4570f87afab6 541 // Another shortcut - we have no arg to pass, so just typecast the func.
geiineuville 0:4570f87afab6 542 }
geiineuville 0:4570f87afab6 543 }
geiineuville 0:4570f87afab6 544
geiineuville 0:4570f87afab6 545 void sntp_sys_untimeout(void (*func)(void *arg), void *arg) {
geiineuville 0:4570f87afab6 546 Timeout *t = NULL;
geiineuville 0:4570f87afab6 547 if (func == &sntp_request) {
geiineuville 0:4570f87afab6 548 t = &_sntp_timer1;
geiineuville 0:4570f87afab6 549 LWIP_DEBUGF(SNTP_DEBUG_STATE, ("DEBUG: IN sntp_sys_untimeout(), func=sntp_request\r\n"));
geiineuville 0:4570f87afab6 550 } else if (func == &sntp_try_next_server) {
geiineuville 0:4570f87afab6 551 t = &_sntp_timer2;
geiineuville 0:4570f87afab6 552 LWIP_DEBUGF(SNTP_DEBUG_STATE, ("DEBUG: IN sntp_sys_untimeout(), func=sntp_try_next_server\r\n"));
geiineuville 0:4570f87afab6 553 }
geiineuville 0:4570f87afab6 554 if (t) {
geiineuville 0:4570f87afab6 555 t->detach();
geiineuville 0:4570f87afab6 556 }
geiineuville 0:4570f87afab6 557 }
geiineuville 0:4570f87afab6 558
geiineuville 0:4570f87afab6 559 #else // NO_SYS
geiineuville 0:4570f87afab6 560 #error "I don't know how to compile LWIP/SNTP with NO_SYS=0"
geiineuville 0:4570f87afab6 561 #endif // NO_SYS
geiineuville 0:4570f87afab6 562
geiineuville 0:4570f87afab6 563 // Can be called when already running
geiineuville 0:4570f87afab6 564 void SNTPSetDstZone(tDST_ZONE zone) {
geiineuville 0:4570f87afab6 565 if (zone >= DST_ZONE_DESCR_CNT)
geiineuville 0:4570f87afab6 566 return; // ERR_INVALID_ARG
geiineuville 0:4570f87afab6 567
geiineuville 0:4570f87afab6 568 gSntpDstZone = zone;
geiineuville 0:4570f87afab6 569
geiineuville 0:4570f87afab6 570 if (gSntpRunning) {
geiineuville 0:4570f87afab6 571 // DST scheduler
geiineuville 0:4570f87afab6 572 _sntp_dst_now();
geiineuville 0:4570f87afab6 573 _sntp_dst_schedule();
geiineuville 0:4570f87afab6 574 }
geiineuville 0:4570f87afab6 575 }
geiineuville 0:4570f87afab6 576
geiineuville 0:4570f87afab6 577 void SNTPSetRecvTimeout(unsigned int val_s) { gSntpRecvTimeout_s = val_s; }
geiineuville 0:4570f87afab6 578 void SNTPSetUpdateDelay(unsigned int val_s) { gSntpUpdateDelay_s = val_s; }
geiineuville 0:4570f87afab6 579 void SNTPSetTimezone(float hours_from_utc, bool adjust_clock) {
geiineuville 0:4570f87afab6 580 if (adjust_clock && !gSntpRtcUtc) {
geiineuville 0:4570f87afab6 581 time_t seconds = time(NULL);
geiineuville 0:4570f87afab6 582 seconds -= gSntpTimezone; // Convert from old local time
geiineuville 0:4570f87afab6 583 seconds += hours_from_utc * 3600; // Convert to new local time
geiineuville 0:4570f87afab6 584 set_time(seconds);
geiineuville 0:4570f87afab6 585 if (gSntpRtcTCR) {
geiineuville 0:4570f87afab6 586 // Adjust our alarm clock
geiineuville 0:4570f87afab6 587 gSntpRtcTCR -= gSntpTimezone;
geiineuville 0:4570f87afab6 588 gSntpRtcTCR += hours_from_utc * 3600;
geiineuville 0:4570f87afab6 589 }
geiineuville 0:4570f87afab6 590 }
geiineuville 0:4570f87afab6 591 gSntpTimezone = hours_from_utc * 3600;
geiineuville 0:4570f87afab6 592 }
geiineuville 0:4570f87afab6 593 void SNTPSetDST(float hours_from_utc, bool adjust_clock) {
geiineuville 0:4570f87afab6 594 SNTPSetDSTEx(hours_from_utc * 3600, adjust_clock);
geiineuville 0:4570f87afab6 595 }
geiineuville 0:4570f87afab6 596
geiineuville 0:4570f87afab6 597 static int sntp_num_servers_alloc = 0;
geiineuville 0:4570f87afab6 598 static void _SNTPClrAddresses(void) {
geiineuville 0:4570f87afab6 599 if (!sntp_num_servers_alloc) sntp_num_servers_alloc = sntp_num_servers;
geiineuville 0:4570f87afab6 600 // Here we save the original size of the sntp_server_addresses[] array.
geiineuville 0:4570f87afab6 601
geiineuville 0:4570f87afab6 602 if (sntp_addresses_free) {
geiineuville 0:4570f87afab6 603 for (int i=0; i<sntp_num_servers; i++) {
geiineuville 0:4570f87afab6 604 sntp_addresses_free(sntp_server_addresses[i]);
geiineuville 0:4570f87afab6 605 }
geiineuville 0:4570f87afab6 606 }
geiineuville 0:4570f87afab6 607 sntp_current_server = 0;
geiineuville 0:4570f87afab6 608 sntp_num_servers = 0;
geiineuville 0:4570f87afab6 609 sntp_addresses_free = NULL;
geiineuville 0:4570f87afab6 610 }
geiineuville 0:4570f87afab6 611 static int _SNTPAddAddress(const char* server_address) {
geiineuville 0:4570f87afab6 612 if (sntp_num_servers+1 > sntp_num_servers_alloc)
geiineuville 0:4570f87afab6 613 return -1;
geiineuville 0:4570f87afab6 614 sntp_server_addresses[sntp_num_servers] = (char*)malloc(strlen(server_address)+1);
geiineuville 0:4570f87afab6 615 if (sntp_server_addresses[sntp_num_servers] == NULL) return -1; // Out of memory
geiineuville 0:4570f87afab6 616 strcpy(sntp_server_addresses[sntp_num_servers], server_address);
geiineuville 0:4570f87afab6 617 sntp_num_servers++;
geiineuville 0:4570f87afab6 618 return 0;
geiineuville 0:4570f87afab6 619 }
geiineuville 0:4570f87afab6 620
geiineuville 0:4570f87afab6 621 // Override default servers list.
geiineuville 0:4570f87afab6 622 // For no-copy, pass pointer to free() in p_free.
geiineuville 0:4570f87afab6 623 // Returns: actual number of servers set (limited by allocated buffer size)
geiineuville 0:4570f87afab6 624 // WARNING! There is no interlock to ensure that SNTP service does not read its data while we are updating it.
geiineuville 0:4570f87afab6 625 // This function is intended to be called only before SNTPClientInit().
geiineuville 0:4570f87afab6 626 int SNTPSetAddresses(const char* server_addresses[], int count, void (*p_free)(void*)) {
geiineuville 0:4570f87afab6 627 // In order to use sntp.c as-is, we hack into its static variables.
geiineuville 0:4570f87afab6 628 // Not all compilers/linkers will support that.
geiineuville 0:4570f87afab6 629
geiineuville 0:4570f87afab6 630 _SNTPClrAddresses();
geiineuville 0:4570f87afab6 631 if (count > sntp_num_servers_alloc)
geiineuville 0:4570f87afab6 632 count = sntp_num_servers_alloc;
geiineuville 0:4570f87afab6 633 for (int i=0; i<count; i++) {
geiineuville 0:4570f87afab6 634 if (p_free) {
geiineuville 0:4570f87afab6 635 sntp_server_addresses[i] = (char *)server_addresses[i];
geiineuville 0:4570f87afab6 636 } else {
geiineuville 0:4570f87afab6 637 _SNTPAddAddress(server_addresses[i]);
geiineuville 0:4570f87afab6 638 }
geiineuville 0:4570f87afab6 639 }
geiineuville 0:4570f87afab6 640 sntp_num_servers = count;
geiineuville 0:4570f87afab6 641 sntp_current_server = 0;
geiineuville 0:4570f87afab6 642 sntp_addresses_free = p_free ? p_free : &free;
geiineuville 0:4570f87afab6 643 return count;
geiineuville 0:4570f87afab6 644 }
geiineuville 0:4570f87afab6 645
geiineuville 0:4570f87afab6 646 // Trim whitespace/CRLFs from both ends of a given string
geiineuville 0:4570f87afab6 647 char * str_cleanup(char *in) {
geiineuville 0:4570f87afab6 648 char * out = in;
geiineuville 0:4570f87afab6 649 // Trim leading spaces and CR/LF
geiineuville 0:4570f87afab6 650 while (*out == ' ' || *out == '\t' || *out == '\r' || *out == '\n')
geiineuville 0:4570f87afab6 651 out ++;
geiineuville 0:4570f87afab6 652 // Trim trailing spaces and CR/LF
geiineuville 0:4570f87afab6 653 int len = strlen(out)-1;
geiineuville 0:4570f87afab6 654 while (out[len] == ' ' || out[len] == '\t' || out[len] == '\r' || out[len] == '\n') {
geiineuville 0:4570f87afab6 655 out[len] = '\0';
geiineuville 0:4570f87afab6 656 len--;
geiineuville 0:4570f87afab6 657 }
geiineuville 0:4570f87afab6 658 return out;
geiineuville 0:4570f87afab6 659 }
geiineuville 0:4570f87afab6 660
geiineuville 0:4570f87afab6 661 #ifndef CRLF
geiineuville 0:4570f87afab6 662 #define CRLF "\r\n"
geiineuville 0:4570f87afab6 663 #endif
geiineuville 0:4570f87afab6 664 void SNTPWriteIniFile(FILE * f) {
geiineuville 0:4570f87afab6 665 fprintf(f, "# SNTP Configuration file" CRLF);
geiineuville 0:4570f87afab6 666 fprintf(f, CRLF "[Servers]" CRLF);
geiineuville 0:4570f87afab6 667 for (int i=0; i<sntp_num_servers; i++) {
geiineuville 0:4570f87afab6 668 fprintf(f, "%s" CRLF, sntp_server_addresses[i]);
geiineuville 0:4570f87afab6 669 }
geiineuville 0:4570f87afab6 670 fprintf(f, CRLF "[Global]" CRLF);
geiineuville 0:4570f87afab6 671 fprintf(f, "RtcUtc=%d" CRLF, (int)gSntpRtcUtc);
geiineuville 0:4570f87afab6 672 fprintf(f, "Timezone=%0.1f" CRLF, gSntpTimezone / 3600.0);
geiineuville 0:4570f87afab6 673 fprintf(f, "DstZone=%d" CRLF, gSntpDstZone);
geiineuville 0:4570f87afab6 674 fprintf(f, "# %s" CRLF, SNTPDstZoneName(gSntpDstZone));
geiineuville 0:4570f87afab6 675 fprintf(f, "UpdateDelay=%d" CRLF, gSntpUpdateDelay_s);
geiineuville 0:4570f87afab6 676 fprintf(f, "RecvTimeout=%d" CRLF, gSntpRecvTimeout_s);
geiineuville 0:4570f87afab6 677 fprintf(f, CRLF "##END" CRLF);
geiineuville 0:4570f87afab6 678 }
geiineuville 0:4570f87afab6 679
geiineuville 0:4570f87afab6 680 // Simple ini file parser for SNTP configuration (Case-sensitive!)
geiineuville 0:4570f87afab6 681 // This function is intended to be called only before SNTPClientInit().
geiineuville 0:4570f87afab6 682 // Returns: 0 if OK, errno otherwise
geiineuville 0:4570f87afab6 683 enum {
geiineuville 0:4570f87afab6 684 SECT_NONE,
geiineuville 0:4570f87afab6 685 SECT_SERVERS,
geiineuville 0:4570f87afab6 686 SECT_GLOBAL,
geiineuville 0:4570f87afab6 687 };
geiineuville 0:4570f87afab6 688 int SNTPReadIniFile(const char* filename) {
geiineuville 0:4570f87afab6 689 FILE *f;
geiineuville 0:4570f87afab6 690 char buf[512];
geiineuville 0:4570f87afab6 691 bool addresses_cleared = false;
geiineuville 0:4570f87afab6 692
geiineuville 0:4570f87afab6 693 f = fopen(filename, "r");
geiineuville 0:4570f87afab6 694 if (!f)
geiineuville 0:4570f87afab6 695 return -1; // errno not used?
geiineuville 0:4570f87afab6 696
geiineuville 0:4570f87afab6 697 char *buf1, *buf2;
geiineuville 0:4570f87afab6 698 int section=SECT_NONE;
geiineuville 0:4570f87afab6 699 int line = 0;
geiineuville 0:4570f87afab6 700 while (fgets(buf, sizeof(buf)/sizeof(buf[0]), f)) {
geiineuville 0:4570f87afab6 701 line++;
geiineuville 0:4570f87afab6 702 buf1 = str_cleanup(buf);
geiineuville 0:4570f87afab6 703 if (*buf1 == '#' || *buf1 == '\0')
geiineuville 0:4570f87afab6 704 continue; // Comment line or empty line - skip
geiineuville 0:4570f87afab6 705 if (*buf1 == '[') {
geiineuville 0:4570f87afab6 706 // New section
geiineuville 0:4570f87afab6 707 if (0 == strncmp(buf1,"[Servers]", sizeof("[Servers]")-1)) {
geiineuville 0:4570f87afab6 708 section=SECT_SERVERS;
geiineuville 0:4570f87afab6 709 if (!addresses_cleared) {
geiineuville 0:4570f87afab6 710 // Clear addresses only once.
geiineuville 0:4570f87afab6 711 _SNTPClrAddresses();
geiineuville 0:4570f87afab6 712 addresses_cleared = true;
geiineuville 0:4570f87afab6 713 }
geiineuville 0:4570f87afab6 714 } else if (0 == strncmp(buf1,"[Global]", sizeof("[Global]")-1)) {
geiineuville 0:4570f87afab6 715 section=SECT_GLOBAL;
geiineuville 0:4570f87afab6 716 } else {
geiineuville 0:4570f87afab6 717 section=SECT_NONE;
geiineuville 0:4570f87afab6 718 fprintf(stderr, "File \"%s\", line %d - section \"%s\" is not understood.\r\n", filename, line, buf1);
geiineuville 0:4570f87afab6 719 }
geiineuville 0:4570f87afab6 720 } else {
geiineuville 0:4570f87afab6 721 // Section values
geiineuville 0:4570f87afab6 722 switch (section) {
geiineuville 0:4570f87afab6 723 case SECT_SERVERS:
geiineuville 0:4570f87afab6 724 if (_SNTPAddAddress(buf1)) {
geiineuville 0:4570f87afab6 725 fprintf(stderr, "File \"%s\", line %d - cannot add server \"%s\" - exceeded allocated slots.\r\n", filename, line, buf1);
geiineuville 0:4570f87afab6 726 }
geiineuville 0:4570f87afab6 727 break;
geiineuville 0:4570f87afab6 728 case SECT_GLOBAL:
geiineuville 0:4570f87afab6 729 buf2 = strchr(buf1, '=');
geiineuville 0:4570f87afab6 730 if (buf2) {
geiineuville 0:4570f87afab6 731 *buf2++ = '\0'; // Now buf1 has variable name, buf2 has value
geiineuville 0:4570f87afab6 732 buf2 = str_cleanup(buf2);
geiineuville 0:4570f87afab6 733 if (0 == strncmp(buf1, "Timezone", sizeof("Timezone")-1)) {
geiineuville 0:4570f87afab6 734 gSntpTimezone = strtod(buf2, &buf2) * 3600;
geiineuville 0:4570f87afab6 735 } else if (0 == strncmp(buf1, "UpdateDelay", sizeof("UpdateDelay")-1)) {
geiineuville 0:4570f87afab6 736 gSntpUpdateDelay_s = strtoul(buf2, &buf2, 10);
geiineuville 0:4570f87afab6 737 } else if (0 == strncmp(buf1, "RecvTimeout", sizeof("RecvTimeout")-1)) {
geiineuville 0:4570f87afab6 738 gSntpRecvTimeout_s = strtoul(buf2, &buf2, 10);
geiineuville 0:4570f87afab6 739 } else if (0 == strncmp(buf1, "RtcUtc", sizeof("RtcUtc")-1)) {
geiineuville 0:4570f87afab6 740 gSntpRtcUtc = (bool)strtol(buf2, &buf2, 10);
geiineuville 0:4570f87afab6 741 } else if (0 == strncmp(buf1, "DstZone", sizeof("DstZone")-1)) {
geiineuville 0:4570f87afab6 742 // FIXME: It would be nice to allow human-readable string here.
geiineuville 0:4570f87afab6 743 gSntpDstZone = (tDST_ZONE)strtol(buf2, &buf2, 10);
geiineuville 0:4570f87afab6 744 } else {
geiineuville 0:4570f87afab6 745 fprintf(stderr, "File \"%s\", line %d - unrecognized variable \"%s\" in section [Global]\r\n", filename, line, buf1);
geiineuville 0:4570f87afab6 746 }
geiineuville 0:4570f87afab6 747 } else {
geiineuville 0:4570f87afab6 748 fprintf(stderr, "File \"%s\", line %d - unrecognized statement in section [Global]: %s\r\n", filename, line, buf1);
geiineuville 0:4570f87afab6 749 }
geiineuville 0:4570f87afab6 750 break;
geiineuville 0:4570f87afab6 751 default:
geiineuville 0:4570f87afab6 752 fprintf(stderr, "File \"%s\", line %d - unrecognized statement / no section: %s\r\n", filename, line, buf1);
geiineuville 0:4570f87afab6 753 }
geiineuville 0:4570f87afab6 754 }
geiineuville 0:4570f87afab6 755 }
geiineuville 0:4570f87afab6 756 fclose(f);
geiineuville 0:4570f87afab6 757 printf("SNTP configuration read from file \"%s\", %d lines.\r\n", filename, line);
geiineuville 0:4570f87afab6 758 return 0;
geiineuville 0:4570f87afab6 759 }
geiineuville 0:4570f87afab6 760
geiineuville 0:4570f87afab6 761 // Start the SNTP client
geiineuville 0:4570f87afab6 762 void SNTPClientInit(void) {
geiineuville 0:4570f87afab6 763
geiineuville 0:4570f87afab6 764 #ifdef SNTP_DST_TESTS
geiineuville 0:4570f87afab6 765 // Test our DST algorithms
geiineuville 0:4570f87afab6 766 test_sntp_dst_calc(gSntpTimezone, gSntpDstZone);
geiineuville 0:4570f87afab6 767 test_sntp_dst_point(-2);
geiineuville 0:4570f87afab6 768 test_sntp_dst_point(-1);
geiineuville 0:4570f87afab6 769 test_sntp_dst_point(0);
geiineuville 0:4570f87afab6 770 test_sntp_dst_point(1);
geiineuville 0:4570f87afab6 771 test_sntp_dst_point(2);
geiineuville 0:4570f87afab6 772 #endif
geiineuville 0:4570f87afab6 773
geiineuville 0:4570f87afab6 774 // SNTPv4 RFC 4330 enforces a minimum update time of 15 seconds
geiineuville 0:4570f87afab6 775 if (gSntpUpdateDelay_s < 15) {
geiineuville 0:4570f87afab6 776 gSntpUpdateDelay_s = 15;
geiineuville 0:4570f87afab6 777 }
geiineuville 0:4570f87afab6 778
geiineuville 0:4570f87afab6 779 gSntpRunning = true;
geiineuville 0:4570f87afab6 780
geiineuville 0:4570f87afab6 781 // Just call this to start SNTP client:
geiineuville 0:4570f87afab6 782 sntp_init();
geiineuville 0:4570f87afab6 783
geiineuville 0:4570f87afab6 784 // // Enable RTC ISR
geiineuville 0:4570f87afab6 785 // gSntpTicker.attach(_sntp_isr, 1);
geiineuville 0:4570f87afab6 786 // We do it from first NTP response
geiineuville 0:4570f87afab6 787 }
geiineuville 0:4570f87afab6 788
geiineuville 0:4570f87afab6 789 // Use instead of system time()
geiineuville 0:4570f87afab6 790 // Returns local time
geiineuville 0:4570f87afab6 791 time_t SNTPTime(void) {
geiineuville 0:4570f87afab6 792 time_t seconds = time(NULL);
geiineuville 0:4570f87afab6 793 if (gSntpRtcUtc) {
geiineuville 0:4570f87afab6 794 seconds += gSntpTimezone + gSntpDST; // Convert to local time
geiineuville 0:4570f87afab6 795 }
geiineuville 0:4570f87afab6 796 return seconds;
geiineuville 0:4570f87afab6 797 }
geiineuville 0:4570f87afab6 798
geiineuville 0:4570f87afab6 799 // Use instead of system set_time()
geiineuville 0:4570f87afab6 800 // seconds - local time
geiineuville 0:4570f87afab6 801 void SNTPSetTime(time_t seconds) {
geiineuville 0:4570f87afab6 802 if (gSntpRtcUtc) {
geiineuville 0:4570f87afab6 803 seconds -= gSntpTimezone + gSntpDST; // Convert from local time
geiineuville 0:4570f87afab6 804 }
geiineuville 0:4570f87afab6 805 set_time(seconds);
geiineuville 0:4570f87afab6 806 }
geiineuville 0:4570f87afab6 807
geiineuville 0:4570f87afab6 808 // Use instead of system time()
geiineuville 0:4570f87afab6 809 // Returns UTC time
geiineuville 0:4570f87afab6 810 time_t SNTPTimeUTC(void) {
geiineuville 0:4570f87afab6 811 time_t seconds = time(NULL);
geiineuville 0:4570f87afab6 812 if (!gSntpRtcUtc) {
geiineuville 0:4570f87afab6 813 seconds -= gSntpTimezone + gSntpDST; // Convert from local time
geiineuville 0:4570f87afab6 814 }
geiineuville 0:4570f87afab6 815 return seconds;
geiineuville 0:4570f87afab6 816 }
geiineuville 0:4570f87afab6 817
geiineuville 0:4570f87afab6 818 // Use instead of system set_time()
geiineuville 0:4570f87afab6 819 // seconds - UTC time
geiineuville 0:4570f87afab6 820 void SNTPSetTimeUTC(time_t seconds) {
geiineuville 0:4570f87afab6 821 if (!gSntpRtcUtc) {
geiineuville 0:4570f87afab6 822 seconds += gSntpTimezone + gSntpDST; // Convert to local time
geiineuville 0:4570f87afab6 823 }
geiineuville 0:4570f87afab6 824 set_time(seconds);
geiineuville 0:4570f87afab6 825 }
geiineuville 0:4570f87afab6 826
geiineuville 0:4570f87afab6 827 //END