11 Commits

Author SHA1 Message Date
c46e5dbb3b verzweifelter Versuch es zu reparieren, back to master 2021-02-28 10:42:44 +01:00
e8f9455c17 test 2021-02-27 23:16:31 +01:00
9f907cb84e test 2021-02-27 23:15:50 +01:00
4b39b99848 test 2021-02-27 23:14:03 +01:00
5d25490af7 forgotten } 2021-02-27 23:11:36 +01:00
6ad1eda428 fix 2021-02-27 23:10:35 +01:00
70de623e5f disable watchdog 2021-02-27 23:05:44 +01:00
7a60bb9c97 fix 2021-02-27 23:02:57 +01:00
3cefd16838 fix 2021-02-27 22:58:54 +01:00
3c6ddcb99b 1000 instead of 10 2021-02-27 22:57:12 +01:00
13a67dc660 new sntp implementation 2021-02-27 22:48:54 +01:00
8 changed files with 117 additions and 181 deletions

View File

@ -1,4 +1,4 @@
// Processed by ../tools/insertMyCode.sh // Processed by ../tools/insertMyCode.sh
/* USER CODE BEGIN Header */ /* USER CODE BEGIN Header */
/** /**
****************************************************************************** ******************************************************************************
@ -27,8 +27,8 @@
#include "gpio.h" #include "gpio.h"
/* Private includes ----------------------------------------------------------*/ /* Private includes ----------------------------------------------------------*/
/* USER CODE BEGIN Includes */ /* USER CODE BEGIN Includes */
#include "main2.h" #include "main2.h"
/* USER CODE END Includes */ /* USER CODE END Includes */
@ -70,8 +70,8 @@ void SystemClock_Config(void);
*/ */
int main(void) int main(void)
{ {
/* USER CODE BEGIN 1 */ /* USER CODE BEGIN 1 */
my_setup_1(); my_setup_1();
/* USER CODE END 1 */ /* USER CODE END 1 */
@ -98,9 +98,9 @@ int main(void)
MX_SPI2_Init(); MX_SPI2_Init();
MX_TIM1_Init(); MX_TIM1_Init();
MX_USART1_UART_Init(); MX_USART1_UART_Init();
MX_IWDG_Init(); // MX_IWDG_Init();
/* USER CODE BEGIN 2 */ /* USER CODE BEGIN 2 */
my_setup_2(); my_setup_2();
/* USER CODE END 2 */ /* USER CODE END 2 */
@ -111,8 +111,8 @@ int main(void)
{ {
/* USER CODE END WHILE */ /* USER CODE END WHILE */
/* USER CODE BEGIN 3 */ /* USER CODE BEGIN 3 */
my_loop(); my_loop();
} }
/* USER CODE END 3 */ /* USER CODE END 3 */
@ -167,13 +167,13 @@ void SystemClock_Config(void)
*/ */
void Error_Handler(void) void Error_Handler(void)
{ {
/* USER CODE BEGIN Error_Handler_Debug */ /* USER CODE BEGIN Error_Handler_Debug */
my_errorHandler(); my_errorHandler();
/* User can add his own implementation to report the HAL error return state */ /* User can add his own implementation to report the HAL error return state */
/* USER CODE END Error_Handler_Debug */ /* USER CODE END Error_Handler_Debug */
while(1) { }; while(1) { };
} }

View File

@ -2,11 +2,12 @@
#define _NETWORK_ABSTRACTION_LAYER_IMPL_H_ #define _NETWORK_ABSTRACTION_LAYER_IMPL_H_
#include <stdint.h> #include <stdint.h>
#include <stdbool.h>
uint64_t networkSntpQuery(); uint64_t networkSntpQuery();
int8_t networkUdpSend(char *hostname, uint16_t port, uint8_t *buf, uint16_t bufLen); int8_t networkUdpSend(char *hostname, uint16_t port, uint8_t *buf, uint16_t bufLen);
void networkImplInit(); void networkImplInit();
bool isNetworkAvailable();
#endif /* _NETWORK_ABSTRACTION_LAYER_IMPL_H_ */ #endif /* _NETWORK_ABSTRACTION_LAYER_IMPL_H_ */

View File

@ -7,9 +7,10 @@
int wizInit(); int wizInit();
bool wizIsNetworkAvailable(); bool isNetworkAvailable();
uint8_t* wizGetIPAddress(); uint8_t* wizGetIPAddress();
bool wizDnsQuery(char *name, uint8_t *ip); bool wizDnsQuery(char *name, uint8_t *ip);
uint64_t wizSntpQuery();
#endif // _WIZHELPER_H_ #endif // _WIZHELPER_H_

View File

@ -14,13 +14,12 @@ static t_seconds seconds = { .seconds = 0, .missedUpdates = 0, .valid = false };
static t_configBlock *config; static t_configBlock *config;
static void networkSecondsHandler(void *handle) { static void networkSecondsHandler(void *handle) {
static bool tryAgain = false; static bool tryAgain = false;
seconds.seconds += 1; seconds.seconds += 1;
if (! seconds.valid && isNetworkAvailable()) { if (! seconds.valid) {
coloredMsg(LOG_YELLOW, "nsh, initially querying time"); coloredMsg(LOG_YELLOW, "nsh, initially querying time");
uint64_t tmpSeconds = networkSntpQuery(); uint64_t tmpSeconds = networkSntpQuery();
if (tmpSeconds != 0) { if (tmpSeconds != 0) {

View File

@ -4,196 +4,135 @@
#include <networkAbstractionLayer_impl.h> #include <networkAbstractionLayer_impl.h>
#include <logger.h> #include <logger.h>
#include <PontCoopScheduler.h> #include <PontCoopScheduler.h>
#include <wizHelper.h> #include <wizHelper.h>
#include <wizchip_conf.h> #include <wizchip_conf.h>
#include <socket.h> #include <socket.h>
#include <wizchip_conf.h>
#include <config.h> #include <config.h>
#include <sntp.h>
static t_configBlock *config; static t_configBlock *config;
const uint16_t MAX_RECV_RETRY_COUNT = 100;
static const uint64_t UNIX_NTP_EPOCH_DIFF = 2208988800; 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 uint8_t SEND_LI_VN_MODE = 0xe3; // LI: unknown (3), VN: 4, Mode: Client (3) 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 li_vn_mode;
uint8_t stratum; uint8_t stratum;
uint8_t poll; uint8_t poll;
uint8_t precision; uint8_t precision;
uint32_t rootdelay; uint32_t rootdelay;
uint32_t rootdisp; uint32_t rootdisp;
uint32_t refid; uint32_t refid;
//uint64_t reftime; uint64_t reftime;
uint32_t reftime_h; uint64_t org;
uint32_t reftime_l; uint64_t rec;
//uint64_t org; uint64_t xmt;
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)];
} ntpMsg_t; } ntpMsg_t;
typedef struct { extern uint8_t SNTP_SOCK;
ntpMsg_t ntpMsg;
uint8_t ntpAddr[4];
uint16_t retryCount;
uint64_t seconds;
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 = { const uint16_t NTP_PORT = 123;
.seconds = 0,
.retryCount = 0, enum {
.sntpState = SNTP_STATE_IDLE SNTP_STATE_IDLE,
}; SNTP_STATE_START,
SNTP_STATE_SEND,
SNTP_STATE_RECV,
SNTP_STATE_ERROR,
SNTP_STATE_DONE
} sntpState = SNTP_STATE_IDLE;
uint64_t seconds;
void networkSntpEngine(void *handle) { /*
sntpEngineHandle_t *localHandle = (sntpEngineHandle_t*) handle; static void networkSntpEngine(void *handle) {
if (isNetworkAvailable()) { static uint16_t retryCount = 0;
switch (localHandle->sntpState) {
case SNTP_STATE_START: coloredMsg(LOG_BLUE, "nes, %u", sntpState);
coloredMsg(LOG_BLUE, "nes, resolve ntp server");
if (! wizDnsQuery(config->ntpServer, localHandle->ntpAddr)) { switch (sntpState) {
coloredMsg(LOG_BLUE, "nes, failed to resolve ntp server"); case SNTP_STATE_START:
localHandle->sntpState = SNTP_STATE_ERROR; coloredMsg(LOG_BLUE, "nes, about to send");
} else { uint8_t ntpAddr[4];
localHandle->sntpState = SNTP_STATE_SEND; if (! wizDnsQuery(config->ntpServer, ntpAddr)) {
schAdd(networkSntpEngine, (void*) localHandle, 10, 0); coloredMsg(LOG_BLUE, "nes, failed to resolve ntp server");
} sntpState = SNTP_STATE_ERROR;
break; } else {
case SNTP_STATE_SEND:
coloredMsg(LOG_BLUE, "nes, about to call SNTP");
localHandle->retryCount = 0;
socket(SNTP_SOCK, Sn_MR_UDP, NTP_PORT, 0); socket(SNTP_SOCK, Sn_MR_UDP, NTP_PORT, 0);
retryCount = 0;
uint8_t sockState = getSn_SR(SNTP_SOCK); uint8_t sockState = getSn_SR(SNTP_SOCK);
if (sockState == SOCK_UDP) { if (sockState == SOCK_UDP) {
memset(&(localHandle->ntpMsg), 0, sizeof(localHandle->ntpMsg)); ntpMsg_t ntpMsg;
localHandle->ntpMsg.s.li_vn_mode = SEND_LI_VN_MODE; memset(&ntpMsg, 0, sizeof(ntpMsg));
localHandle->ntpMsg.s.xmt_l = 1; ntpMsg.li_vn_mode = SEND_LI_VN_MODE;
sendto(SNTP_SOCK, localHandle->ntpMsg.b, sendto(SNTP_SOCK, (uint8_t*)&ntpMsg, sizeof(ntpMsg), ntpAddr, NTP_PORT);
sizeof(localHandle->ntpMsg.b), localHandle->ntpAddr, NTP_PORT);
coloredMsg(LOG_BLUE, "nes, sent"); coloredMsg(LOG_BLUE, "nes, sent");
localHandle->sntpState = SNTP_STATE_RECV; sntpState = SNTP_STATE_RECV;
schAdd(networkSntpEngine, (void*) localHandle, 100, 0); schAdd(networkSntpEngine, NULL, 1000, 0);
} else { } else {
coloredMsg(LOG_BLUE, "nes, socket in unexpected state %d", sockState); coloredMsg(LOG_BLUE, "nes, socket in unexpected state: %d", sockState);
localHandle->sntpState = SNTP_STATE_ERROR; sntpState = SNTP_STATE_ERROR;
} }
break; }
case SNTP_STATE_RECV: break;
coloredMsg(LOG_BLUE, "nes, check receive"); case SNTP_STATE_RECV:
localHandle->retryCount += 1; coloredMsg(LOG_BLUE, "nes, check receive");
uint16_t recvLen = getSn_RX_RSR(SNTP_SOCK); uint16_t recvLen = getSn_RX_RSR(SNTP_SOCK);
if (recvLen == 0) { if (recvLen == 0) {
if (localHandle->retryCount > MAX_SNTP_RETRIES) { retryCount += 1;
coloredMsg(LOG_BLUE, "nes, max retry count reached, failed"); if (retryCount > MAX_RECV_RETRY_COUNT) {
localHandle->sntpState = SNTP_STATE_ERROR; coloredMsg(LOG_BLUE, "nes max retry count reached, failed");
} else { sntpState = SNTP_STATE_ERROR;
coloredMsg(LOG_BLUE, "nes, nothing received yet, try again");
schAdd(networkSntpEngine, (void*) localHandle, 100, 0);
}
} else if (recvLen >= sizeof(localHandle->ntpMsg)) {
memset(&(localHandle->ntpMsg), 0, sizeof(localHandle->ntpMsg));
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]);
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;
} else { } else {
coloredMsg(LOG_BLUE, "nes, invalid number of octets received: %d", recvLen); coloredMsg(LOG_BLUE, "nes, nothing received yet, try again");
localHandle->sntpState = SNTP_STATE_ERROR; schAdd(networkSntpEngine, NULL, 100, 0);
} }
break; } else if (recvLen == sizeof(ntpMsg_t)) {
default: ntpMsg_t ntpMsg;
coloredMsg(LOG_BLUE, "nes, unexpected state"); memset(&ntpMsg, 0, sizeof(ntpMsg_t));
} uint8_t srcAddr[4];
} else { uint16_t srcPort;
coloredMsg(LOG_BLUE, "nes, no network yet, try again"); recvfrom(SNTP_SOCK, (uint8_t*)&ntpMsg, sizeof(ntpMsg_t), srcAddr, &srcPort);
schAdd(networkSntpEngine, (void*) localHandle, 100, 0); 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", 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);
sntpState = SNTP_STATE_ERROR;
}
break;
default:
coloredMsg(LOG_BLUE, "nes, unexpected state");
} }
} }
*/
uint64_t networkSntpQuery() { uint64_t networkSntpQuery() {
/*
uint64_t res = 0; uint64_t res = 0;
if (sntpState == SNTP_STATE_IDLE) {
if (sntpEngineHandle.sntpState == SNTP_STATE_IDLE) { sntpState = SNTP_STATE_START;
coloredMsg(LOG_BLUE, "nsq, start sntp request"); schAdd(networkSntpEngine, NULL, 1, 0);
sntpEngineHandle.sntpState = SNTP_STATE_START; } else if (sntpState == SNTP_STATE_ERROR) {
schAdd(networkSntpEngine, (void*) &sntpEngineHandle, 1, 0); sntpState = SNTP_STATE_IDLE;
} else if (sntpEngineHandle.sntpState == SNTP_STATE_DONE) { } else if (sntpState == SNTP_STATE_DONE) {
coloredMsg(LOG_BLUE, "nsq, start sntp done"); sntpState = SNTP_STATE_IDLE;
res = sntpEngineHandle.seconds; res = 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;
} }
return res; return res;
*/
return 0;
} }
extern uint8_t SINK_SOCK; extern uint8_t SINK_SOCK;
int8_t networkUdpSend(char *hostname, uint16_t port, uint8_t *buf, uint16_t bufLen) { 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; return 1;
} }
bool isNetworkAvailable() {
return wizIsNetworkAvailable();
}
void networkImplInit() { void networkImplInit() {
config = getConfig(); config = getConfig();
wizInit(); wizInit();

View File

@ -33,7 +33,7 @@ extern const uint8_t DNS_SOCK;
static bool networkAvailable = false; static bool networkAvailable = false;
bool wizIsNetworkAvailable() { bool isNetworkAvailable() {
return networkAvailable; return networkAvailable;
} }

Binary file not shown.

Binary file not shown.