Leest de waarde van een sensor binnen een maakt deze beschikbaar via internet

Dependencies:   NTPClient_NetServices mbed

Committer:
hendrikvincent
Date:
Mon Dec 02 09:01:23 2013 +0000
Revision:
0:05ccbd4f84f1
eerste programma;

Who changed what in which revision?

UserRevisionLine numberNew contents of line
hendrikvincent 0:05ccbd4f84f1 1 #pragma diag_remark 1293
hendrikvincent 0:05ccbd4f84f1 2 /*
hendrikvincent 0:05ccbd4f84f1 3 Copyright (c) 2010 Donatien Garnier (donatiengar [at] gmail [dot] com)
hendrikvincent 0:05ccbd4f84f1 4
hendrikvincent 0:05ccbd4f84f1 5 Permission is hereby granted, free of charge, to any person obtaining a copy
hendrikvincent 0:05ccbd4f84f1 6 of this software and associated documentation files (the "Software"), to deal
hendrikvincent 0:05ccbd4f84f1 7 in the Software without restriction, including without limitation the rights
hendrikvincent 0:05ccbd4f84f1 8 to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
hendrikvincent 0:05ccbd4f84f1 9 copies of the Software, and to permit persons to whom the Software is
hendrikvincent 0:05ccbd4f84f1 10 furnished to do so, subject to the following conditions:
hendrikvincent 0:05ccbd4f84f1 11
hendrikvincent 0:05ccbd4f84f1 12 The above copyright notice and this permission notice shall be included in
hendrikvincent 0:05ccbd4f84f1 13 all copies or substantial portions of the Software.
hendrikvincent 0:05ccbd4f84f1 14
hendrikvincent 0:05ccbd4f84f1 15 THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
hendrikvincent 0:05ccbd4f84f1 16 IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
hendrikvincent 0:05ccbd4f84f1 17 FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE
hendrikvincent 0:05ccbd4f84f1 18 AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
hendrikvincent 0:05ccbd4f84f1 19 LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
hendrikvincent 0:05ccbd4f84f1 20 OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
hendrikvincent 0:05ccbd4f84f1 21 THE SOFTWARE.
hendrikvincent 0:05ccbd4f84f1 22 */
hendrikvincent 0:05ccbd4f84f1 23
hendrikvincent 0:05ccbd4f84f1 24 #include "NTPClient.h"
hendrikvincent 0:05ccbd4f84f1 25
hendrikvincent 0:05ccbd4f84f1 26 #include <stdio.h>
hendrikvincent 0:05ccbd4f84f1 27
hendrikvincent 0:05ccbd4f84f1 28 //#define __DEBUG
hendrikvincent 0:05ccbd4f84f1 29 #include "dbg/dbg.h"
hendrikvincent 0:05ccbd4f84f1 30
hendrikvincent 0:05ccbd4f84f1 31 #define NTP_PORT 123
hendrikvincent 0:05ccbd4f84f1 32 #define NTP_CLIENT_PORT 0//50420 //Random port
hendrikvincent 0:05ccbd4f84f1 33 #define NTP_REQUEST_TIMEOUT 15000
hendrikvincent 0:05ccbd4f84f1 34 #define NTP_TIMESTAMP_DELTA 2208988800ull //Diff btw a UNIX timestamp (Starting Jan, 1st 1970) and a NTP timestamp (Starting Jan, 1st 1900)
hendrikvincent 0:05ccbd4f84f1 35
hendrikvincent 0:05ccbd4f84f1 36 #define htons( x ) ( (( x << 8 ) & 0xFF00) | (( x >> 8 ) & 0x00FF) )
hendrikvincent 0:05ccbd4f84f1 37 #define ntohs( x ) (htons(x))
hendrikvincent 0:05ccbd4f84f1 38
hendrikvincent 0:05ccbd4f84f1 39 #define htonl( x ) ( (( x << 24 ) & 0xFF000000) \
hendrikvincent 0:05ccbd4f84f1 40 | (( x << 8 ) & 0x00FF0000) \
hendrikvincent 0:05ccbd4f84f1 41 | (( x >> 8 ) & 0x0000FF00) \
hendrikvincent 0:05ccbd4f84f1 42 | (( x >> 24 ) & 0x000000FF) )
hendrikvincent 0:05ccbd4f84f1 43 #define ntohl( x ) (htonl(x))
hendrikvincent 0:05ccbd4f84f1 44
hendrikvincent 0:05ccbd4f84f1 45 NTPClient::NTPClient() : NetService(false), m_state(NTP_PING), m_pCbItem(NULL), m_pCbMeth(NULL), m_pCb(NULL),
hendrikvincent 0:05ccbd4f84f1 46 m_watchdog(), m_timeout(0), m_closed(true), m_host(), m_pDnsReq(NULL), m_blockingResult(NTP_PROCESSING)
hendrikvincent 0:05ccbd4f84f1 47 {
hendrikvincent 0:05ccbd4f84f1 48 setTimeout(NTP_REQUEST_TIMEOUT);
hendrikvincent 0:05ccbd4f84f1 49 DBG("\r\nNew NTPClient %p\r\n",this);
hendrikvincent 0:05ccbd4f84f1 50 }
hendrikvincent 0:05ccbd4f84f1 51
hendrikvincent 0:05ccbd4f84f1 52 NTPClient::~NTPClient()
hendrikvincent 0:05ccbd4f84f1 53 {
hendrikvincent 0:05ccbd4f84f1 54 close();
hendrikvincent 0:05ccbd4f84f1 55 }
hendrikvincent 0:05ccbd4f84f1 56
hendrikvincent 0:05ccbd4f84f1 57 //High level setup functions
hendrikvincent 0:05ccbd4f84f1 58 NTPResult NTPClient::setTime(const Host& host) //Blocking
hendrikvincent 0:05ccbd4f84f1 59 {
hendrikvincent 0:05ccbd4f84f1 60 doSetTime(host);
hendrikvincent 0:05ccbd4f84f1 61 return blockingProcess();
hendrikvincent 0:05ccbd4f84f1 62 }
hendrikvincent 0:05ccbd4f84f1 63
hendrikvincent 0:05ccbd4f84f1 64 NTPResult NTPClient::setTime(const Host& host, void (*pMethod)(NTPResult)) //Non blocking
hendrikvincent 0:05ccbd4f84f1 65 {
hendrikvincent 0:05ccbd4f84f1 66 setOnResult(pMethod);
hendrikvincent 0:05ccbd4f84f1 67 doSetTime(host);
hendrikvincent 0:05ccbd4f84f1 68 return NTP_PROCESSING;
hendrikvincent 0:05ccbd4f84f1 69 }
hendrikvincent 0:05ccbd4f84f1 70
hendrikvincent 0:05ccbd4f84f1 71 #if 0 //For doc only
hendrikvincent 0:05ccbd4f84f1 72 template<class T>
hendrikvincent 0:05ccbd4f84f1 73 NTPResult NTPClient::setTime(const Host& host, T* pItem, void (T::*pMethod)(NTPResult)) //Non blocking
hendrikvincent 0:05ccbd4f84f1 74 {
hendrikvincent 0:05ccbd4f84f1 75 setOnResult(pItem, pMethod);
hendrikvincent 0:05ccbd4f84f1 76 doSetTime(host);
hendrikvincent 0:05ccbd4f84f1 77 return NTP_PROCESSING;
hendrikvincent 0:05ccbd4f84f1 78 }
hendrikvincent 0:05ccbd4f84f1 79 #endif
hendrikvincent 0:05ccbd4f84f1 80
hendrikvincent 0:05ccbd4f84f1 81 void NTPClient::doSetTime(const Host& host)
hendrikvincent 0:05ccbd4f84f1 82 {
hendrikvincent 0:05ccbd4f84f1 83 init();
hendrikvincent 0:05ccbd4f84f1 84 resetTimeout();
hendrikvincent 0:05ccbd4f84f1 85 m_host = host;
hendrikvincent 0:05ccbd4f84f1 86 if(!m_host.getPort())
hendrikvincent 0:05ccbd4f84f1 87 {
hendrikvincent 0:05ccbd4f84f1 88 m_host.setPort(NTP_PORT);
hendrikvincent 0:05ccbd4f84f1 89 }
hendrikvincent 0:05ccbd4f84f1 90 if(m_host.getIp().isNull())
hendrikvincent 0:05ccbd4f84f1 91 {
hendrikvincent 0:05ccbd4f84f1 92 //DNS query required
hendrikvincent 0:05ccbd4f84f1 93 m_pDnsReq = new DNSRequest();
hendrikvincent 0:05ccbd4f84f1 94 DBG("\r\nNTPClient : DNSRequest %p\r\n", m_pDnsReq);
hendrikvincent 0:05ccbd4f84f1 95 m_pDnsReq->setOnReply(this, &NTPClient::onDNSReply);
hendrikvincent 0:05ccbd4f84f1 96 m_pDnsReq->resolve(&m_host);
hendrikvincent 0:05ccbd4f84f1 97 return;
hendrikvincent 0:05ccbd4f84f1 98 }
hendrikvincent 0:05ccbd4f84f1 99 open();
hendrikvincent 0:05ccbd4f84f1 100 }
hendrikvincent 0:05ccbd4f84f1 101
hendrikvincent 0:05ccbd4f84f1 102 void NTPClient::setOnResult( void (*pMethod)(NTPResult) )
hendrikvincent 0:05ccbd4f84f1 103 {
hendrikvincent 0:05ccbd4f84f1 104 m_pCb = pMethod;
hendrikvincent 0:05ccbd4f84f1 105 }
hendrikvincent 0:05ccbd4f84f1 106
hendrikvincent 0:05ccbd4f84f1 107 void NTPClient::close()
hendrikvincent 0:05ccbd4f84f1 108 {
hendrikvincent 0:05ccbd4f84f1 109 if(m_closed)
hendrikvincent 0:05ccbd4f84f1 110 return;
hendrikvincent 0:05ccbd4f84f1 111 m_closed = true; //Prevent recursive calling or calling on an object being destructed by someone else
hendrikvincent 0:05ccbd4f84f1 112 m_watchdog.stop();
hendrikvincent 0:05ccbd4f84f1 113 m_pUDPSocket->resetOnEvent();
hendrikvincent 0:05ccbd4f84f1 114 m_pUDPSocket->close();
hendrikvincent 0:05ccbd4f84f1 115 delete m_pUDPSocket;
hendrikvincent 0:05ccbd4f84f1 116 if( m_pDnsReq )
hendrikvincent 0:05ccbd4f84f1 117 {
hendrikvincent 0:05ccbd4f84f1 118 m_pDnsReq->close();
hendrikvincent 0:05ccbd4f84f1 119 delete m_pDnsReq;
hendrikvincent 0:05ccbd4f84f1 120 m_pDnsReq = NULL;
hendrikvincent 0:05ccbd4f84f1 121 }
hendrikvincent 0:05ccbd4f84f1 122 }
hendrikvincent 0:05ccbd4f84f1 123
hendrikvincent 0:05ccbd4f84f1 124 void NTPClient::poll() //Called by NetServices
hendrikvincent 0:05ccbd4f84f1 125 {
hendrikvincent 0:05ccbd4f84f1 126 if( (!m_closed) && (m_watchdog.read_ms() >= m_timeout) )
hendrikvincent 0:05ccbd4f84f1 127 {
hendrikvincent 0:05ccbd4f84f1 128 onTimeout();
hendrikvincent 0:05ccbd4f84f1 129 }
hendrikvincent 0:05ccbd4f84f1 130 }
hendrikvincent 0:05ccbd4f84f1 131
hendrikvincent 0:05ccbd4f84f1 132 void NTPClient::init() //Create and setup socket if needed
hendrikvincent 0:05ccbd4f84f1 133 {
hendrikvincent 0:05ccbd4f84f1 134 if(!m_closed) //Already opened
hendrikvincent 0:05ccbd4f84f1 135 return;
hendrikvincent 0:05ccbd4f84f1 136 m_state = NTP_PING;
hendrikvincent 0:05ccbd4f84f1 137 m_pUDPSocket = new UDPSocket;
hendrikvincent 0:05ccbd4f84f1 138 m_pUDPSocket->setOnEvent(this, &NTPClient::onUDPSocketEvent);
hendrikvincent 0:05ccbd4f84f1 139 m_closed = false;
hendrikvincent 0:05ccbd4f84f1 140 DBG("NTPClient: Init OK\n");
hendrikvincent 0:05ccbd4f84f1 141 }
hendrikvincent 0:05ccbd4f84f1 142
hendrikvincent 0:05ccbd4f84f1 143 void NTPClient::open()
hendrikvincent 0:05ccbd4f84f1 144 {
hendrikvincent 0:05ccbd4f84f1 145 resetTimeout();
hendrikvincent 0:05ccbd4f84f1 146 DBG("Opening connection\n");
hendrikvincent 0:05ccbd4f84f1 147 m_state = NTP_PING;
hendrikvincent 0:05ccbd4f84f1 148 Host localhost(IpAddr(), NTP_CLIENT_PORT, "localhost"); //Any local address
hendrikvincent 0:05ccbd4f84f1 149 m_pUDPSocket->bind(localhost);
hendrikvincent 0:05ccbd4f84f1 150 if ((int)time(NULL) < 1280000000) set_time( 1280000000 ); //End of July 2010... just there to limit offset range
hendrikvincent 0:05ccbd4f84f1 151 process();
hendrikvincent 0:05ccbd4f84f1 152 }
hendrikvincent 0:05ccbd4f84f1 153
hendrikvincent 0:05ccbd4f84f1 154 #define MIN(a,b) ((a)<(b))?(a):(b)
hendrikvincent 0:05ccbd4f84f1 155 void NTPClient::process() //Main state-machine
hendrikvincent 0:05ccbd4f84f1 156 {
hendrikvincent 0:05ccbd4f84f1 157 int len;
hendrikvincent 0:05ccbd4f84f1 158 Host host;
hendrikvincent 0:05ccbd4f84f1 159
hendrikvincent 0:05ccbd4f84f1 160 switch(m_state)
hendrikvincent 0:05ccbd4f84f1 161 {
hendrikvincent 0:05ccbd4f84f1 162 case NTP_PING:
hendrikvincent 0:05ccbd4f84f1 163 DBG("\r\nPing\r\n");
hendrikvincent 0:05ccbd4f84f1 164 //Prepare NTP Packet:
hendrikvincent 0:05ccbd4f84f1 165 m_pkt.li = 0; //Leap Indicator : No warning
hendrikvincent 0:05ccbd4f84f1 166 m_pkt.vn = 4; //Version Number : 4
hendrikvincent 0:05ccbd4f84f1 167 m_pkt.mode = 3; //Client mode
hendrikvincent 0:05ccbd4f84f1 168 m_pkt.stratum = 0; //Not relevant here
hendrikvincent 0:05ccbd4f84f1 169 m_pkt.poll = 0; //Not significant as well
hendrikvincent 0:05ccbd4f84f1 170 m_pkt.precision = 0; //Neither this one is
hendrikvincent 0:05ccbd4f84f1 171
hendrikvincent 0:05ccbd4f84f1 172 m_pkt.rootDelay = 0; //Or this one
hendrikvincent 0:05ccbd4f84f1 173 m_pkt.rootDispersion = 0; //Or that one
hendrikvincent 0:05ccbd4f84f1 174 m_pkt.refId = 0; //...
hendrikvincent 0:05ccbd4f84f1 175
hendrikvincent 0:05ccbd4f84f1 176 m_pkt.refTm_s = 0;
hendrikvincent 0:05ccbd4f84f1 177 m_pkt.origTm_s = 0;
hendrikvincent 0:05ccbd4f84f1 178 m_pkt.rxTm_s = 0;
hendrikvincent 0:05ccbd4f84f1 179 m_pkt.txTm_s = htonl( NTP_TIMESTAMP_DELTA + time(NULL) ); //WARN: We are in LE format, network byte order is BE
hendrikvincent 0:05ccbd4f84f1 180
hendrikvincent 0:05ccbd4f84f1 181 m_pkt.refTm_f = m_pkt.origTm_f = m_pkt.rxTm_f = m_pkt.txTm_f = 0;
hendrikvincent 0:05ccbd4f84f1 182
hendrikvincent 0:05ccbd4f84f1 183 #ifdef __DEBUG
hendrikvincent 0:05ccbd4f84f1 184 //Hex Dump:
hendrikvincent 0:05ccbd4f84f1 185 DBG("\r\nDump Tx:\r\n");
hendrikvincent 0:05ccbd4f84f1 186 for(int i = 0; i< sizeof(NTPPacket); i++)
hendrikvincent 0:05ccbd4f84f1 187 {
hendrikvincent 0:05ccbd4f84f1 188 DBG("%02x ", *((char*)&m_pkt + i));
hendrikvincent 0:05ccbd4f84f1 189 }
hendrikvincent 0:05ccbd4f84f1 190 DBG("\r\n\r\n");
hendrikvincent 0:05ccbd4f84f1 191 #endif
hendrikvincent 0:05ccbd4f84f1 192
hendrikvincent 0:05ccbd4f84f1 193 len = m_pUDPSocket->sendto( (char*)&m_pkt, sizeof(NTPPacket), &m_host );
hendrikvincent 0:05ccbd4f84f1 194 if(len < sizeof(NTPPacket))
hendrikvincent 0:05ccbd4f84f1 195 { onResult(NTP_PRTCL); close(); return; }
hendrikvincent 0:05ccbd4f84f1 196
hendrikvincent 0:05ccbd4f84f1 197 m_state = NTP_PONG;
hendrikvincent 0:05ccbd4f84f1 198
hendrikvincent 0:05ccbd4f84f1 199 break;
hendrikvincent 0:05ccbd4f84f1 200
hendrikvincent 0:05ccbd4f84f1 201 case NTP_PONG:
hendrikvincent 0:05ccbd4f84f1 202 DBG("\r\nPong\r\n");
hendrikvincent 0:05ccbd4f84f1 203 while( len = m_pUDPSocket->recvfrom( (char*)&m_pkt, sizeof(NTPPacket), &host ) )
hendrikvincent 0:05ccbd4f84f1 204 {
hendrikvincent 0:05ccbd4f84f1 205 if( len <= 0 )
hendrikvincent 0:05ccbd4f84f1 206 break;
hendrikvincent 0:05ccbd4f84f1 207 if( !host.getIp().isEq(m_host.getIp()) )
hendrikvincent 0:05ccbd4f84f1 208 continue; //Not our packet
hendrikvincent 0:05ccbd4f84f1 209 if( len > 0 )
hendrikvincent 0:05ccbd4f84f1 210 break;
hendrikvincent 0:05ccbd4f84f1 211 }
hendrikvincent 0:05ccbd4f84f1 212
hendrikvincent 0:05ccbd4f84f1 213 if(len == 0)
hendrikvincent 0:05ccbd4f84f1 214 return; //Wait for the next packet
hendrikvincent 0:05ccbd4f84f1 215
hendrikvincent 0:05ccbd4f84f1 216 if(len < 0)
hendrikvincent 0:05ccbd4f84f1 217 { onResult(NTP_PRTCL); close(); return; }
hendrikvincent 0:05ccbd4f84f1 218
hendrikvincent 0:05ccbd4f84f1 219 if(len < sizeof(NTPPacket)) //TODO: Accept chunks
hendrikvincent 0:05ccbd4f84f1 220 { onResult(NTP_PRTCL); close(); return; }
hendrikvincent 0:05ccbd4f84f1 221
hendrikvincent 0:05ccbd4f84f1 222 #ifdef __DEBUG
hendrikvincent 0:05ccbd4f84f1 223 //Hex Dump:
hendrikvincent 0:05ccbd4f84f1 224 DBG("\r\nDump Rx:\r\n");
hendrikvincent 0:05ccbd4f84f1 225 for(int i = 0; i< sizeof(NTPPacket); i++)
hendrikvincent 0:05ccbd4f84f1 226 {
hendrikvincent 0:05ccbd4f84f1 227 DBG("%02x ", *((char*)&m_pkt + i));
hendrikvincent 0:05ccbd4f84f1 228 }
hendrikvincent 0:05ccbd4f84f1 229 DBG("\r\n\r\n");
hendrikvincent 0:05ccbd4f84f1 230 #endif
hendrikvincent 0:05ccbd4f84f1 231
hendrikvincent 0:05ccbd4f84f1 232 if( m_pkt.stratum == 0) //Kiss of death message : Not good !
hendrikvincent 0:05ccbd4f84f1 233 {
hendrikvincent 0:05ccbd4f84f1 234 onResult(NTP_PRTCL); close(); return;
hendrikvincent 0:05ccbd4f84f1 235 }
hendrikvincent 0:05ccbd4f84f1 236
hendrikvincent 0:05ccbd4f84f1 237 //Correct Endianness
hendrikvincent 0:05ccbd4f84f1 238 m_pkt.refTm_s = ntohl( m_pkt.refTm_s );
hendrikvincent 0:05ccbd4f84f1 239 m_pkt.refTm_f = ntohl( m_pkt.refTm_f );
hendrikvincent 0:05ccbd4f84f1 240 m_pkt.origTm_s = ntohl( m_pkt.origTm_s );
hendrikvincent 0:05ccbd4f84f1 241 m_pkt.origTm_f = ntohl( m_pkt.origTm_f );
hendrikvincent 0:05ccbd4f84f1 242 m_pkt.rxTm_s = ntohl( m_pkt.rxTm_s );
hendrikvincent 0:05ccbd4f84f1 243 m_pkt.rxTm_f = ntohl( m_pkt.rxTm_f );
hendrikvincent 0:05ccbd4f84f1 244 m_pkt.txTm_s = ntohl( m_pkt.txTm_s );
hendrikvincent 0:05ccbd4f84f1 245 m_pkt.txTm_f = ntohl( m_pkt.txTm_f );
hendrikvincent 0:05ccbd4f84f1 246
hendrikvincent 0:05ccbd4f84f1 247 //Compute offset, see RFC 4330 p.13
hendrikvincent 0:05ccbd4f84f1 248 uint32_t destTm_s = (NTP_TIMESTAMP_DELTA + time(NULL));
hendrikvincent 0:05ccbd4f84f1 249 //int32_t origTm = (int32_t) ((uint64_t) m_pkt.origTm - NTP_TIMESTAMP_DELTA); //Convert in local 32 bits timestamps
hendrikvincent 0:05ccbd4f84f1 250 //int32_t rxTm = (int32_t) ((uint64_t) m_pkt.rxTm - NTP_TIMESTAMP_DELTA); //Convert in local 32 bits timestamps
hendrikvincent 0:05ccbd4f84f1 251 //int32_t txTm = (int32_t) ((uint64_t) m_pkt.txTm - NTP_TIMESTAMP_DELTA); //Convert in local 32 bits timestamps
hendrikvincent 0:05ccbd4f84f1 252 // int64_t offset = ( ( ( m_pkt.rxTm_s - m_pkt.origTm_s ) + ( m_pkt.txTm_s - destTm_s ) ) << 32 + ( ( m_pkt.rxTm_f - m_pkt.origTm_f ) + ( m_pkt.txTm_f - 0 ) ) ) / 2;
hendrikvincent 0:05ccbd4f84f1 253 int64_t offset = ( (int64_t)( m_pkt.rxTm_s - m_pkt.origTm_s ) + (int64_t) ( m_pkt.txTm_s - destTm_s ) ) / 2; //Avoid overflow
hendrikvincent 0:05ccbd4f84f1 254 DBG("\r\nSent @%d\r\n", m_pkt.txTm_s);
hendrikvincent 0:05ccbd4f84f1 255 DBG("\r\nOffset: %d\r\n", offset);
hendrikvincent 0:05ccbd4f84f1 256 //Set time accordingly
hendrikvincent 0:05ccbd4f84f1 257 set_time( time(NULL) + (offset /*>> 32*/) );
hendrikvincent 0:05ccbd4f84f1 258
hendrikvincent 0:05ccbd4f84f1 259 onResult(NTP_OK);
hendrikvincent 0:05ccbd4f84f1 260 close();
hendrikvincent 0:05ccbd4f84f1 261
hendrikvincent 0:05ccbd4f84f1 262 break;
hendrikvincent 0:05ccbd4f84f1 263 }
hendrikvincent 0:05ccbd4f84f1 264 }
hendrikvincent 0:05ccbd4f84f1 265
hendrikvincent 0:05ccbd4f84f1 266 void NTPClient::setTimeout(int ms)
hendrikvincent 0:05ccbd4f84f1 267 {
hendrikvincent 0:05ccbd4f84f1 268 m_timeout = ms;
hendrikvincent 0:05ccbd4f84f1 269 }
hendrikvincent 0:05ccbd4f84f1 270
hendrikvincent 0:05ccbd4f84f1 271 void NTPClient::resetTimeout()
hendrikvincent 0:05ccbd4f84f1 272 {
hendrikvincent 0:05ccbd4f84f1 273 m_watchdog.reset();
hendrikvincent 0:05ccbd4f84f1 274 m_watchdog.start();
hendrikvincent 0:05ccbd4f84f1 275 }
hendrikvincent 0:05ccbd4f84f1 276
hendrikvincent 0:05ccbd4f84f1 277 void NTPClient::onTimeout() //Connection has timed out
hendrikvincent 0:05ccbd4f84f1 278 {
hendrikvincent 0:05ccbd4f84f1 279 close();
hendrikvincent 0:05ccbd4f84f1 280 onResult(NTP_TIMEOUT);
hendrikvincent 0:05ccbd4f84f1 281 }
hendrikvincent 0:05ccbd4f84f1 282
hendrikvincent 0:05ccbd4f84f1 283 void NTPClient::onDNSReply(DNSReply r)
hendrikvincent 0:05ccbd4f84f1 284 {
hendrikvincent 0:05ccbd4f84f1 285 if(m_closed)
hendrikvincent 0:05ccbd4f84f1 286 {
hendrikvincent 0:05ccbd4f84f1 287 DBG("\r\nWARN: Discarded\r\n");
hendrikvincent 0:05ccbd4f84f1 288 return;
hendrikvincent 0:05ccbd4f84f1 289 }
hendrikvincent 0:05ccbd4f84f1 290
hendrikvincent 0:05ccbd4f84f1 291 if( r != DNS_FOUND )
hendrikvincent 0:05ccbd4f84f1 292 {
hendrikvincent 0:05ccbd4f84f1 293 DBG("\r\nCould not resolve hostname.\r\n");
hendrikvincent 0:05ccbd4f84f1 294 onResult(NTP_DNS);
hendrikvincent 0:05ccbd4f84f1 295 close();
hendrikvincent 0:05ccbd4f84f1 296 return;
hendrikvincent 0:05ccbd4f84f1 297 }
hendrikvincent 0:05ccbd4f84f1 298 DBG("\r\nDNS resolved.\r\n");
hendrikvincent 0:05ccbd4f84f1 299 m_pDnsReq->close();
hendrikvincent 0:05ccbd4f84f1 300 delete m_pDnsReq;
hendrikvincent 0:05ccbd4f84f1 301 m_pDnsReq=NULL;
hendrikvincent 0:05ccbd4f84f1 302 open();
hendrikvincent 0:05ccbd4f84f1 303 }
hendrikvincent 0:05ccbd4f84f1 304
hendrikvincent 0:05ccbd4f84f1 305 void NTPClient::onUDPSocketEvent(UDPSocketEvent e)
hendrikvincent 0:05ccbd4f84f1 306 {
hendrikvincent 0:05ccbd4f84f1 307 resetTimeout();
hendrikvincent 0:05ccbd4f84f1 308 switch(e)
hendrikvincent 0:05ccbd4f84f1 309 {
hendrikvincent 0:05ccbd4f84f1 310 case UDPSOCKET_READABLE: //The only event for now
hendrikvincent 0:05ccbd4f84f1 311 resetTimeout();
hendrikvincent 0:05ccbd4f84f1 312 process();
hendrikvincent 0:05ccbd4f84f1 313 break;
hendrikvincent 0:05ccbd4f84f1 314 }
hendrikvincent 0:05ccbd4f84f1 315 }
hendrikvincent 0:05ccbd4f84f1 316
hendrikvincent 0:05ccbd4f84f1 317 void NTPClient::onResult(NTPResult r) //Must be called by impl when the request completes
hendrikvincent 0:05ccbd4f84f1 318 {
hendrikvincent 0:05ccbd4f84f1 319 if(m_pCbItem && m_pCbMeth)
hendrikvincent 0:05ccbd4f84f1 320 (m_pCbItem->*m_pCbMeth)(r);
hendrikvincent 0:05ccbd4f84f1 321 else if(m_pCb)
hendrikvincent 0:05ccbd4f84f1 322 m_pCb(r);
hendrikvincent 0:05ccbd4f84f1 323 m_blockingResult = r; //Blocking mode
hendrikvincent 0:05ccbd4f84f1 324 }
hendrikvincent 0:05ccbd4f84f1 325
hendrikvincent 0:05ccbd4f84f1 326 NTPResult NTPClient::blockingProcess() //Called in blocking mode, calls Net::poll() until return code is available
hendrikvincent 0:05ccbd4f84f1 327 {
hendrikvincent 0:05ccbd4f84f1 328 m_blockingResult = NTP_PROCESSING;
hendrikvincent 0:05ccbd4f84f1 329 do
hendrikvincent 0:05ccbd4f84f1 330 {
hendrikvincent 0:05ccbd4f84f1 331 Net::poll();
hendrikvincent 0:05ccbd4f84f1 332 } while(m_blockingResult == NTP_PROCESSING);
hendrikvincent 0:05ccbd4f84f1 333 Net::poll(); //Necessary for cleanup
hendrikvincent 0:05ccbd4f84f1 334 return m_blockingResult;
hendrikvincent 0:05ccbd4f84f1 335 }