Compare commits
11 Commits
new_sntp_s
...
new_sntp_i
Author | SHA1 | Date | |
---|---|---|---|
c46e5dbb3b | |||
e8f9455c17
|
|||
9f907cb84e
|
|||
4b39b99848
|
|||
5d25490af7
|
|||
6ad1eda428
|
|||
70de623e5f
|
|||
7a60bb9c97
|
|||
3cefd16838
|
|||
3c6ddcb99b
|
|||
13a67dc660
|
@ -98,7 +98,7 @@ int main(void)
|
||||
MX_SPI2_Init();
|
||||
MX_TIM1_Init();
|
||||
MX_USART1_UART_Init();
|
||||
MX_IWDG_Init();
|
||||
// MX_IWDG_Init();
|
||||
/* USER CODE BEGIN 2 */
|
||||
my_setup_2();
|
||||
|
||||
|
@ -2,11 +2,12 @@
|
||||
#define _NETWORK_ABSTRACTION_LAYER_IMPL_H_
|
||||
|
||||
#include <stdint.h>
|
||||
#include <stdbool.h>
|
||||
|
||||
uint64_t networkSntpQuery();
|
||||
|
||||
|
||||
int8_t networkUdpSend(char *hostname, uint16_t port, uint8_t *buf, uint16_t bufLen);
|
||||
void networkImplInit();
|
||||
bool isNetworkAvailable();
|
||||
|
||||
|
||||
#endif /* _NETWORK_ABSTRACTION_LAYER_IMPL_H_ */
|
||||
|
@ -7,9 +7,10 @@
|
||||
|
||||
|
||||
int wizInit();
|
||||
bool wizIsNetworkAvailable();
|
||||
bool isNetworkAvailable();
|
||||
uint8_t* wizGetIPAddress();
|
||||
bool wizDnsQuery(char *name, uint8_t *ip);
|
||||
uint64_t wizSntpQuery();
|
||||
|
||||
|
||||
#endif // _WIZHELPER_H_
|
||||
|
@ -14,13 +14,12 @@ static t_seconds seconds = { .seconds = 0, .missedUpdates = 0, .valid = false };
|
||||
static t_configBlock *config;
|
||||
|
||||
|
||||
|
||||
static void networkSecondsHandler(void *handle) {
|
||||
static bool tryAgain = false;
|
||||
|
||||
seconds.seconds += 1;
|
||||
|
||||
if (! seconds.valid && isNetworkAvailable()) {
|
||||
if (! seconds.valid) {
|
||||
coloredMsg(LOG_YELLOW, "nsh, initially querying time");
|
||||
uint64_t tmpSeconds = networkSntpQuery();
|
||||
if (tmpSeconds != 0) {
|
||||
|
@ -4,27 +4,20 @@
|
||||
#include <networkAbstractionLayer_impl.h>
|
||||
#include <logger.h>
|
||||
#include <PontCoopScheduler.h>
|
||||
|
||||
#include <wizHelper.h>
|
||||
#include <wizchip_conf.h>
|
||||
#include <socket.h>
|
||||
#include <wizchip_conf.h>
|
||||
#include <config.h>
|
||||
#include <sntp.h>
|
||||
|
||||
|
||||
static t_configBlock *config;
|
||||
|
||||
|
||||
|
||||
static const uint64_t UNIX_NTP_EPOCH_DIFF = 2208988800;
|
||||
static const uint16_t NTP_PORT = 123;
|
||||
static const uint16_t MAX_SNTP_RETRIES = 100;
|
||||
extern const uint8_t SNTP_SOCK;
|
||||
|
||||
|
||||
const uint16_t MAX_RECV_RETRY_COUNT = 100;
|
||||
const uint64_t UNIX_NTP_EPOCH_DIFF = 2208988800;
|
||||
|
||||
const uint8_t SEND_LI_VN_MODE = 0xe3; // LI: unknown (3), VN: 4, Mode: Client (3)
|
||||
typedef struct s_ntpStruct {
|
||||
typedef struct {
|
||||
uint8_t li_vn_mode;
|
||||
uint8_t stratum;
|
||||
uint8_t poll;
|
||||
@ -32,168 +25,114 @@ typedef struct s_ntpStruct {
|
||||
uint32_t rootdelay;
|
||||
uint32_t rootdisp;
|
||||
uint32_t refid;
|
||||
//uint64_t reftime;
|
||||
uint32_t reftime_h;
|
||||
uint32_t reftime_l;
|
||||
//uint64_t org;
|
||||
uint32_t org_h;
|
||||
uint32_t org_l;
|
||||
//uint64_t rec;
|
||||
uint32_t rec_h;
|
||||
uint32_t rec_l;
|
||||
//uint64_t xmt;
|
||||
uint32_t xmt_h;
|
||||
uint32_t xmt_l;
|
||||
} t_ntpStruct;
|
||||
|
||||
typedef union __attribute__((__packed__)) {
|
||||
t_ntpStruct s;
|
||||
uint8_t b[sizeof(t_ntpStruct)];
|
||||
uint64_t reftime;
|
||||
uint64_t org;
|
||||
uint64_t rec;
|
||||
uint64_t xmt;
|
||||
} ntpMsg_t;
|
||||
|
||||
typedef struct {
|
||||
ntpMsg_t ntpMsg;
|
||||
uint8_t ntpAddr[4];
|
||||
uint16_t retryCount;
|
||||
uint64_t seconds;
|
||||
extern uint8_t SNTP_SOCK;
|
||||
|
||||
const uint16_t NTP_PORT = 123;
|
||||
|
||||
enum {
|
||||
SNTP_STATE_IDLE,
|
||||
SNTP_STATE_START,
|
||||
SNTP_STATE_SEND,
|
||||
SNTP_STATE_RECV,
|
||||
SNTP_STATE_DONE,
|
||||
SNTP_STATE_ERROR
|
||||
} sntpState;
|
||||
} sntpEngineHandle_t;
|
||||
|
||||
sntpEngineHandle_t sntpEngineHandle = {
|
||||
.seconds = 0,
|
||||
.retryCount = 0,
|
||||
.sntpState = SNTP_STATE_IDLE
|
||||
};
|
||||
SNTP_STATE_ERROR,
|
||||
SNTP_STATE_DONE
|
||||
} sntpState = SNTP_STATE_IDLE;
|
||||
uint64_t seconds;
|
||||
|
||||
|
||||
void networkSntpEngine(void *handle) {
|
||||
sntpEngineHandle_t *localHandle = (sntpEngineHandle_t*) handle;
|
||||
if (isNetworkAvailable()) {
|
||||
switch (localHandle->sntpState) {
|
||||
/*
|
||||
static void networkSntpEngine(void *handle) {
|
||||
static uint16_t retryCount = 0;
|
||||
|
||||
coloredMsg(LOG_BLUE, "nes, %u", sntpState);
|
||||
|
||||
switch (sntpState) {
|
||||
case SNTP_STATE_START:
|
||||
coloredMsg(LOG_BLUE, "nes, resolve ntp server");
|
||||
if (! wizDnsQuery(config->ntpServer, localHandle->ntpAddr)) {
|
||||
coloredMsg(LOG_BLUE, "nes, about to send");
|
||||
uint8_t ntpAddr[4];
|
||||
if (! wizDnsQuery(config->ntpServer, ntpAddr)) {
|
||||
coloredMsg(LOG_BLUE, "nes, failed to resolve ntp server");
|
||||
localHandle->sntpState = SNTP_STATE_ERROR;
|
||||
sntpState = SNTP_STATE_ERROR;
|
||||
} else {
|
||||
localHandle->sntpState = SNTP_STATE_SEND;
|
||||
schAdd(networkSntpEngine, (void*) localHandle, 10, 0);
|
||||
}
|
||||
break;
|
||||
case SNTP_STATE_SEND:
|
||||
coloredMsg(LOG_BLUE, "nes, about to call SNTP");
|
||||
localHandle->retryCount = 0;
|
||||
socket(SNTP_SOCK, Sn_MR_UDP, NTP_PORT, 0);
|
||||
retryCount = 0;
|
||||
uint8_t sockState = getSn_SR(SNTP_SOCK);
|
||||
if (sockState == SOCK_UDP) {
|
||||
memset(&(localHandle->ntpMsg), 0, sizeof(localHandle->ntpMsg));
|
||||
localHandle->ntpMsg.s.li_vn_mode = SEND_LI_VN_MODE;
|
||||
localHandle->ntpMsg.s.xmt_l = 1;
|
||||
sendto(SNTP_SOCK, localHandle->ntpMsg.b,
|
||||
sizeof(localHandle->ntpMsg.b), localHandle->ntpAddr, NTP_PORT);
|
||||
ntpMsg_t ntpMsg;
|
||||
memset(&ntpMsg, 0, sizeof(ntpMsg));
|
||||
ntpMsg.li_vn_mode = SEND_LI_VN_MODE;
|
||||
sendto(SNTP_SOCK, (uint8_t*)&ntpMsg, sizeof(ntpMsg), ntpAddr, NTP_PORT);
|
||||
coloredMsg(LOG_BLUE, "nes, sent");
|
||||
localHandle->sntpState = SNTP_STATE_RECV;
|
||||
schAdd(networkSntpEngine, (void*) localHandle, 100, 0);
|
||||
sntpState = SNTP_STATE_RECV;
|
||||
schAdd(networkSntpEngine, NULL, 1000, 0);
|
||||
} else {
|
||||
coloredMsg(LOG_BLUE, "nes, socket in unexpected state %d", sockState);
|
||||
localHandle->sntpState = SNTP_STATE_ERROR;
|
||||
coloredMsg(LOG_BLUE, "nes, socket in unexpected state: %d", sockState);
|
||||
sntpState = SNTP_STATE_ERROR;
|
||||
}
|
||||
}
|
||||
break;
|
||||
case SNTP_STATE_RECV:
|
||||
coloredMsg(LOG_BLUE, "nes, check receive");
|
||||
localHandle->retryCount += 1;
|
||||
uint16_t recvLen = getSn_RX_RSR(SNTP_SOCK);
|
||||
if (recvLen == 0) {
|
||||
if (localHandle->retryCount > MAX_SNTP_RETRIES) {
|
||||
coloredMsg(LOG_BLUE, "nes, max retry count reached, failed");
|
||||
localHandle->sntpState = SNTP_STATE_ERROR;
|
||||
retryCount += 1;
|
||||
if (retryCount > MAX_RECV_RETRY_COUNT) {
|
||||
coloredMsg(LOG_BLUE, "nes max retry count reached, failed");
|
||||
sntpState = SNTP_STATE_ERROR;
|
||||
} else {
|
||||
coloredMsg(LOG_BLUE, "nes, nothing received yet, try again");
|
||||
schAdd(networkSntpEngine, (void*) localHandle, 100, 0);
|
||||
schAdd(networkSntpEngine, NULL, 100, 0);
|
||||
}
|
||||
} else if (recvLen >= sizeof(localHandle->ntpMsg)) {
|
||||
memset(&(localHandle->ntpMsg), 0, sizeof(localHandle->ntpMsg));
|
||||
} else if (recvLen == sizeof(ntpMsg_t)) {
|
||||
ntpMsg_t ntpMsg;
|
||||
memset(&ntpMsg, 0, sizeof(ntpMsg_t));
|
||||
uint8_t srcAddr[4];
|
||||
uint16_t srcPort;
|
||||
|
||||
recvfrom(SNTP_SOCK, localHandle->ntpMsg.b,
|
||||
sizeof(localHandle->ntpMsg.b), srcAddr, &srcPort);
|
||||
|
||||
|
||||
uint8_t *buf = localHandle->ntpMsg.b;
|
||||
uint8_t x = 0;
|
||||
coloredMsg(LOG_BLUE, "nes, %02x %02x %02x %02x %02x %02x %02x %02x %02x %02x %02x %02x %02x %02x %02x %02x",
|
||||
buf[x+0], buf[x+1], buf[x+2], buf[x+3], buf[x+4], buf[x+5], buf[x+6], buf[x+7],
|
||||
buf[x+8], buf[x+9], buf[x+10], buf[x+11], buf[x+12], buf[x+13], buf[x+14], buf[x+15]);
|
||||
x += 16;
|
||||
coloredMsg(LOG_BLUE, "nes, %02x %02x %02x %02x %02x %02x %02x %02x %02x %02x %02x %02x %02x %02x %02x %02x",
|
||||
buf[x+0], buf[x+1], buf[x+2], buf[x+3], buf[x+4], buf[x+5], buf[x+6], buf[x+7],
|
||||
buf[x+8], buf[x+9], buf[x+10], buf[x+11], buf[x+12], buf[x+13], buf[x+14], buf[x+15]);
|
||||
x += 16;
|
||||
coloredMsg(LOG_BLUE, "nes, %02x %02x %02x %02x %02x %02x %02x %02x %02x %02x %02x %02x %02x %02x %02x %02x",
|
||||
buf[x+0], buf[x+1], buf[x+2], buf[x+3], buf[x+4], buf[x+5], buf[x+6], buf[x+7],
|
||||
buf[x+8], buf[x+9], buf[x+10], buf[x+11], buf[x+12], buf[x+13], buf[x+14], buf[x+15]);
|
||||
x += 16;
|
||||
coloredMsg(LOG_BLUE, "nes, %02x %02x %02x %02x %02x %02x %02x %02x %02x %02x %02x %02x %02x %02x %02x %02x",
|
||||
buf[x+0], buf[x+1], buf[x+2], buf[x+3], buf[x+4], buf[x+5], buf[x+6], buf[x+7],
|
||||
buf[x+8], buf[x+9], buf[x+10], buf[x+11], buf[x+12], buf[x+13], buf[x+14], buf[x+15]);
|
||||
|
||||
recvfrom(SNTP_SOCK, (uint8_t*)&ntpMsg, sizeof(ntpMsg_t), srcAddr, &srcPort);
|
||||
close(SNTP_SOCK);
|
||||
coloredMsg(LOG_BLUE, "nes, msg received from %d.%d.%d.%d:%d",
|
||||
srcAddr[0], srcAddr[1], srcAddr[2], srcAddr[3],
|
||||
srcPort);
|
||||
|
||||
coloredMsg(LOG_BLUE, "nes, received in the %d. cycles", localHandle->retryCount);
|
||||
uint32_t xmt_h =
|
||||
(localHandle->ntpMsg.s.xmt_h & 0x0000000ff) << 24 |
|
||||
(localHandle->ntpMsg.s.xmt_h & 0x00000ff00) << 8 |
|
||||
(localHandle->ntpMsg.s.xmt_h & 0x000ff0000) >> 8 |
|
||||
(localHandle->ntpMsg.s.xmt_h & 0x0ff000000) >> 24;
|
||||
localHandle->seconds = ((uint64_t)xmt_h) - UNIX_NTP_EPOCH_DIFF;
|
||||
coloredMsg(LOG_BLUE, "nes, xmt: %08x", xmt_h);
|
||||
coloredMsg(LOG_BLUE, "nes, seconds: %lu", localHandle->seconds);
|
||||
localHandle->sntpState = SNTP_STATE_DONE;
|
||||
coloredMsg(LOG_BLUE, "nes, received in the %d. cycles", retryCount);
|
||||
seconds = ntpMsg.rec - UNIX_NTP_EPOCH_DIFF;
|
||||
coloredMsg(LOG_BLUE, "nes, seconds: %lu", seconds);
|
||||
sntpState = SNTP_STATE_DONE;
|
||||
} else {
|
||||
coloredMsg(LOG_BLUE, "nes, invalid number of octets received: %d", recvLen);
|
||||
localHandle->sntpState = SNTP_STATE_ERROR;
|
||||
sntpState = SNTP_STATE_ERROR;
|
||||
}
|
||||
break;
|
||||
default:
|
||||
coloredMsg(LOG_BLUE, "nes, unexpected state");
|
||||
}
|
||||
} else {
|
||||
coloredMsg(LOG_BLUE, "nes, no network yet, try again");
|
||||
schAdd(networkSntpEngine, (void*) localHandle, 100, 0);
|
||||
}
|
||||
}
|
||||
*/
|
||||
|
||||
|
||||
uint64_t networkSntpQuery() {
|
||||
/*
|
||||
uint64_t res = 0;
|
||||
|
||||
if (sntpEngineHandle.sntpState == SNTP_STATE_IDLE) {
|
||||
coloredMsg(LOG_BLUE, "nsq, start sntp request");
|
||||
sntpEngineHandle.sntpState = SNTP_STATE_START;
|
||||
schAdd(networkSntpEngine, (void*) &sntpEngineHandle, 1, 0);
|
||||
} else if (sntpEngineHandle.sntpState == SNTP_STATE_DONE) {
|
||||
coloredMsg(LOG_BLUE, "nsq, start sntp done");
|
||||
res = sntpEngineHandle.seconds;
|
||||
coloredMsg(LOG_BLUE, "nsq, time is %lu", res);
|
||||
sntpEngineHandle.sntpState = SNTP_STATE_IDLE;
|
||||
} else if (sntpEngineHandle.sntpState == SNTP_STATE_ERROR) {
|
||||
coloredMsg(LOG_BLUE, "nsq, start sntp failed");
|
||||
sntpEngineHandle.sntpState = SNTP_STATE_IDLE;
|
||||
if (sntpState == SNTP_STATE_IDLE) {
|
||||
sntpState = SNTP_STATE_START;
|
||||
schAdd(networkSntpEngine, NULL, 1, 0);
|
||||
} else if (sntpState == SNTP_STATE_ERROR) {
|
||||
sntpState = SNTP_STATE_IDLE;
|
||||
} else if (sntpState == SNTP_STATE_DONE) {
|
||||
sntpState = SNTP_STATE_IDLE;
|
||||
res = seconds;
|
||||
}
|
||||
|
||||
return res;
|
||||
*/
|
||||
return 0;
|
||||
}
|
||||
|
||||
|
||||
extern uint8_t SINK_SOCK;
|
||||
|
||||
int8_t networkUdpSend(char *hostname, uint16_t port, uint8_t *buf, uint16_t bufLen) {
|
||||
@ -220,10 +159,6 @@ int8_t networkUdpSend(char *hostname, uint16_t port, uint8_t *buf, uint16_t bufL
|
||||
return 1;
|
||||
}
|
||||
|
||||
bool isNetworkAvailable() {
|
||||
return wizIsNetworkAvailable();
|
||||
}
|
||||
|
||||
void networkImplInit() {
|
||||
config = getConfig();
|
||||
wizInit();
|
||||
|
@ -33,7 +33,7 @@ extern const uint8_t DNS_SOCK;
|
||||
|
||||
static bool networkAvailable = false;
|
||||
|
||||
bool wizIsNetworkAvailable() {
|
||||
bool isNetworkAvailable() {
|
||||
return networkAvailable;
|
||||
}
|
||||
|
||||
|
BIN
docs/ntp.pcap
BIN
docs/ntp.pcap
Binary file not shown.
BIN
docs/ntp2.pcap
BIN
docs/ntp2.pcap
Binary file not shown.
Reference in New Issue
Block a user