timesync fixes

This commit is contained in:
Verkehrsrot 2019-04-13 13:59:30 +02:00
parent 2e7b68d836
commit 20a39ae6d6
5 changed files with 65 additions and 62 deletions

View File

@ -47,6 +47,7 @@ void irqHandler(void *pvParameters) {
// is time to be synced? // is time to be synced?
if (InterruptStatus & TIMESYNC_IRQ) { if (InterruptStatus & TIMESYNC_IRQ) {
time_t t = timeProvider(); time_t t = timeProvider();
ESP_LOGD(TAG, "Sync time = %d", t);
if (timeIsValid(t)) if (timeIsValid(t))
setTime(t); setTime(t);
} }

View File

@ -221,12 +221,7 @@ void onEvent(ev_t ev) {
// kickoff first send job // kickoff first send job
os_setCallback(&sendjob, lora_send); os_setCallback(&sendjob, lora_send);
// show effective LoRa parameters after join // show effective LoRa parameters after join
ESP_LOGI(TAG, "ADR=%d, SF=%d, TXPOWER=%d", cfg.adrmode, cfg.lorasf, ESP_LOGI(TAG, "DEVaddr=%08X", LMIC.devaddr);
cfg.txpower);
#if (TIME_SYNC_LORASERVER)
// kickoff first time sync
send_timesync_req();
#endif
break; break;
case EV_RFU1: case EV_RFU1:
@ -315,7 +310,6 @@ void onEvent(ev_t ev) {
if (!(LMIC.opmode & OP_JOINING)) if (!(LMIC.opmode & OP_JOINING))
#if (TIME_SYNC_LORASERVER) #if (TIME_SYNC_LORASERVER)
// if last packet sent was a timesync request, store TX time // if last packet sent was a timesync request, store TX time
// if ((LMIC.pendTxPort == TIMEPORT) && timeSyncPending)
if (LMIC.pendTxPort == TIMEPORT) if (LMIC.pendTxPort == TIMEPORT)
strcpy_P(buff, PSTR("TX TIMESYNC")); strcpy_P(buff, PSTR("TX TIMESYNC"));
else else

View File

@ -426,16 +426,12 @@ void setup() {
#endif #endif
#if (TIME_SYNC_LORASERVER) #if (TIME_SYNC_LORASERVER)
// create time sync task timesync_init(); // create loraserver time sync task
timesync_init();
#endif #endif
// start pps timepulse
ESP_LOGI(TAG, "Starting Timekeeper..."); ESP_LOGI(TAG, "Starting Timekeeper...");
assert(timepulse_init()); // setup timepulse assert(timepulse_init()); // setup pps timepulse
timepulse_start(); timepulse_start(); // starts pps and cyclic time sync
timeSync(); // init systime
timesyncer.attach(TIME_SYNC_INTERVAL * 60, timeSync);
#endif // TIME_SYNC_INTERVAL #endif // TIME_SYNC_INTERVAL

View File

@ -116,6 +116,10 @@ void timepulse_start(void) {
timerAttachInterrupt(ppsIRQ, &CLOCKIRQ, true); timerAttachInterrupt(ppsIRQ, &CLOCKIRQ, true);
timerAlarmEnable(ppsIRQ); timerAlarmEnable(ppsIRQ);
#endif #endif
// start cyclic time sync
timeSync(); // init systime by RTC or GPS or LORA
timesyncer.attach(TIME_SYNC_INTERVAL * 60, timeSync);
} }
// interrupt service routine triggered by either pps or esp32 hardware timer // interrupt service routine triggered by either pps or esp32 hardware timer
@ -225,7 +229,7 @@ void clock_loop(void *taskparameter) { // ClockTask
tx_Ticks(IF482_FRAME_SIZE, HAS_IF482); tx_Ticks(IF482_FRAME_SIZE, HAS_IF482);
#endif #endif
// output the next second's pulse after timepulse arrived // output the next second's pulse/telegram after pps arrived
for (;;) { for (;;) {
// wait for timepulse and store UTC time in seconds got // wait for timepulse and store UTC time in seconds got

View File

@ -33,12 +33,11 @@ static myClock_timepoint time_sync_rx[TIME_SYNC_SAMPLES];
// send time request message // send time request message
void send_timesync_req() { void send_timesync_req() {
// if a timesync handshake is pending or we are not joined then exit // if a timesync handshake is pending then exit
if (timeSyncPending || !LMIC.devaddr) if (timeSyncPending)
return; return;
// else unblock timesync task // else unblock timesync task
else { else {
timeSyncPending = true;
ESP_LOGI(TAG, "[%0.3f] Timeserver sync request started", millis() / 1000.0); ESP_LOGI(TAG, "[%0.3f] Timeserver sync request started", millis() / 1000.0);
xTaskNotifyGive(timeSyncReqTask); xTaskNotifyGive(timeSyncReqTask);
} }
@ -49,7 +48,7 @@ void process_timesync_req(void *taskparameter) {
uint8_t k; uint8_t k;
uint16_t time_to_set_fraction_msec; uint16_t time_to_set_fraction_msec;
uint32_t seq_no, time_to_set; uint32_t seq_no = 0, time_to_set;
auto time_offset_ms = myClock_msecTick::zero(); auto time_offset_ms = myClock_msecTick::zero();
while (1) { while (1) {
@ -61,6 +60,12 @@ void process_timesync_req(void *taskparameter) {
// wait for kickoff // wait for kickoff
ulTaskNotifyTake(pdFALSE, portMAX_DELAY); ulTaskNotifyTake(pdFALSE, portMAX_DELAY);
timeSyncPending = true;
// wait until we are joined if we are not
while (!LMIC.devaddr) {
vTaskDelay(5000);
}
// collect timestamp samples // collect timestamp samples
for (uint8_t i = 0; i < TIME_SYNC_SAMPLES; i++) { for (uint8_t i = 0; i < TIME_SYNC_SAMPLES; i++) {
@ -69,43 +74,49 @@ void process_timesync_req(void *taskparameter) {
payload.addByte(time_sync_seqNo); payload.addByte(time_sync_seqNo);
SendPayload(TIMEPORT, prio_high); SendPayload(TIMEPORT, prio_high);
// wait for notification from recv_timesync_ans() // wait for a valid timestamp from recv_timesync_ans()
if ((xTaskNotifyWait(0x00, ULONG_MAX, &seq_no, while (seq_no != time_sync_seqNo) {
pdMS_TO_TICKS(TIME_SYNC_TIMEOUT * 1000)) == if (xTaskNotifyWait(0x00, ULONG_MAX, &seq_no,
pdFALSE) || pdMS_TO_TICKS(TIME_SYNC_TIMEOUT * 1000)) ==
(seq_no != time_sync_seqNo)) pdFALSE) {
goto error; // no valid sequence received before timeout ESP_LOGW(TAG, "[%0.3f] Timesync handshake error: timeout",
millis() / 1000.0);
goto finish; // no valid sequence received before timeout
}
}
// process answer // process answer
else { k = seq_no % TIME_SYNC_SAMPLES;
k = seq_no % TIME_SYNC_SAMPLES;
// calculate time diff from collected timestamps // calculate time diff from collected timestamps
time_offset_ms += time_point_cast<milliseconds>(time_sync_rx[k]) - time_offset_ms += time_point_cast<milliseconds>(time_sync_rx[k]) -
time_point_cast<milliseconds>(time_sync_tx[k]); time_point_cast<milliseconds>(time_sync_tx[k]);
// wrap around seqNo, keeping it in time port range // wrap around seqNo, keeping it in time port range
time_sync_seqNo = (time_sync_seqNo < TIMEANSWERPORT_MAX) time_sync_seqNo = (time_sync_seqNo < TIMEANSWERPORT_MAX)
? time_sync_seqNo + 1 ? time_sync_seqNo + 1
: TIMEANSWERPORT_MIN; : TIMEANSWERPORT_MIN;
if (i < TIME_SYNC_SAMPLES - 1) { if (i < TIME_SYNC_SAMPLES - 1) {
// wait until next cycle // wait until next cycle
vTaskDelay(pdMS_TO_TICKS(TIME_SYNC_CYCLE * 1000)); vTaskDelay(pdMS_TO_TICKS(TIME_SYNC_CYCLE * 1000));
} else { // before sending last time sample... } else { // before sending last time sample...
// ...send flush to open a receive window for last time_sync_answer // ...send flush to open a receive window for last time_sync_answer
payload.reset(); payload.reset();
payload.addByte(0x99); payload.addByte(0x99);
SendPayload(RCMDPORT, prio_high); SendPayload(RCMDPORT, prio_high);
// ...send a alive open a receive window for last time_sync_answer // ...send a alive open a receive window for last time_sync_answer
// LMIC_sendAlive(); // LMIC_sendAlive();
}
} }
} // end of for loop to collect timestamp samples } // end of for loop to collect timestamp samples
// begin of time critical section: lock app irq's and I2C bus // begin of time critical section: lock app irq's and I2C bus
if (!mask_user_IRQ()) if (!mask_user_IRQ()) {
goto error; // failure ESP_LOGW(TAG,
"[%0.3f] Timesync handshake error: irq / i2c masking failed",
millis() / 1000.0);
goto finish; // failure
}
// average time offset over all collected diffs // average time offset over all collected diffs
time_offset_ms /= TIME_SYNC_SAMPLES; time_offset_ms /= TIME_SYNC_SAMPLES;
@ -127,12 +138,6 @@ void process_timesync_req(void *taskparameter) {
// end of time critical section: release I2C bus and re-enable app irq's // end of time critical section: release I2C bus and re-enable app irq's
unmask_user_IRQ(); unmask_user_IRQ();
goto finish;
error:
ESP_LOGW(TAG, "[%0.3f] Timeserver error: handshake timed out",
millis() / 1000.0);
finish: finish:
timeSyncPending = false; timeSyncPending = false;
@ -142,14 +147,16 @@ void process_timesync_req(void *taskparameter) {
// called from lorawan.cpp after time_sync_req was sent // called from lorawan.cpp after time_sync_req was sent
void store_time_sync_req(uint32_t timestamp) { void store_time_sync_req(uint32_t timestamp) {
if (timeSyncPending) { // if no timesync handshake is pending then exit
if (!timeSyncPending)
return;
uint8_t k = time_sync_seqNo % TIME_SYNC_SAMPLES; uint8_t k = time_sync_seqNo % TIME_SYNC_SAMPLES;
time_sync_tx[k] += milliseconds(timestamp); time_sync_tx[k] += milliseconds(timestamp);
ESP_LOGD(TAG, "[%0.3f] Timesync request #%d sent at %d.%03d", ESP_LOGD(TAG, "[%0.3f] Timesync request #%d of %d sent at %d.%03d",
millis() / 1000.0, k, timestamp / 1000, timestamp % 1000); millis() / 1000.0, k + 1, TIME_SYNC_SAMPLES, timestamp / 1000,
} timestamp % 1000);
} }
// process timeserver timestamp answer, called from lorawan.cpp // process timeserver timestamp answer, called from lorawan.cpp
@ -190,8 +197,9 @@ int recv_timesync_ans(uint8_t seq_no, uint8_t buf[], uint8_t buf_len) {
// we guess timepoint is recent if it newer than code compile date // we guess timepoint is recent if it newer than code compile date
if (timeIsValid(myClock::to_time_t(time_sync_rx[k]))) { if (timeIsValid(myClock::to_time_t(time_sync_rx[k]))) {
ESP_LOGD(TAG, "[%0.3f] Timesync request #%d rcvd at %d.%03d", ESP_LOGD(TAG, "[%0.3f] Timesync request #%d of %d rcvd at %d.%03d",
millis() / 1000.0, k, timestamp_sec, timestamp_msec); millis() / 1000.0, k + 1, TIME_SYNC_SAMPLES, timestamp_sec,
timestamp_msec);
// inform processing task // inform processing task
xTaskNotify(timeSyncReqTask, seq_no, eSetBits); xTaskNotify(timeSyncReqTask, seq_no, eSetBits);