You cannot select more than 25 topics
Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
178 lines
5.2 KiB
C
178 lines
5.2 KiB
C
#if defined(ESP8266)
|
|
#include <ESP8266WiFi.h>
|
|
#include <espnow.h>
|
|
#elif defined(ESP32)
|
|
#include <esp_now.h>
|
|
#include <WiFi.h>
|
|
#include <esp_wifi.h>
|
|
#endif
|
|
|
|
const uint8_t broadcast_mac[] = {0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF};
|
|
crcResult esp_now_ack_flag;
|
|
bool is_added = false;
|
|
uint32_t last_refresh = 0;
|
|
uint32_t gtwy_timeout = 300000;
|
|
bool pingFlag = false;
|
|
|
|
// Request time from gateway - Optionally used in sensors
|
|
bool reqTimeEspNow() {
|
|
unsigned long pingStart = millis();
|
|
SystemPacket sys_packet = {.cmd = cmd_time, .param = 0};
|
|
DBG1("Requesting time from gateway 0x" + String(gatewayAddress[5],HEX));
|
|
esp_now_send(gatewayAddress, (uint8_t *)&sys_packet, sizeof(SystemPacket));
|
|
while(timeSource.tmNetIf < TMIF_ESPNOW && (millis() - pingStart < 300)) {
|
|
// wait for time to be set
|
|
// magic happens here :)
|
|
yield();
|
|
delay(0);
|
|
}
|
|
if(timeSource.tmNetIf == TMIF_ESPNOW) {
|
|
return true;
|
|
}
|
|
else {
|
|
return false;
|
|
}
|
|
}
|
|
|
|
void recvTimeEspNow(uint32_t t) {
|
|
// Process time if there is no master set yet or if LoRa is the master or if we are already the time master
|
|
if(timeSource.tmNetIf < TMIF_ESPNOW || (timeSource.tmNetIf == TMIF_ESPNOW && timeSource.tmAddress == (incMAC[4] << 8 | incMAC[5]))) {
|
|
DBG1("Received time via ESP-NOW from 0x" + String(incMAC[5], HEX));
|
|
if(timeSource.tmNetIf < TMIF_ESPNOW) {
|
|
timeSource.tmNetIf = TMIF_ESPNOW;
|
|
timeSource.tmSource = TMS_NET;
|
|
timeSource.tmAddress = (incMAC[4] << 8 | incMAC[5]);
|
|
DBG1("ESP-NOW time source is now 0x" + String(incMAC[5], HEX));
|
|
}
|
|
setTime(t);
|
|
timeSource.tmLastTimeSet = millis();
|
|
}
|
|
else {
|
|
DBG2("ESP-NOW 0x" + String(incMAC[5], HEX) + " is not our time source, discarding request");
|
|
}
|
|
return;
|
|
}
|
|
|
|
// Set ESP-NOW send and receive callbacks for either ESP8266 or ESP32
|
|
#if defined(ESP8266)
|
|
void OnDataSent(uint8_t *mac_addr, uint8_t sendStatus)
|
|
{
|
|
if (sendStatus == 0)
|
|
{
|
|
esp_now_ack_flag = CRC_OK;
|
|
}
|
|
else
|
|
{
|
|
esp_now_ack_flag = CRC_BAD;
|
|
}
|
|
}
|
|
void OnDataRecv(uint8_t *mac, uint8_t *incomingData, uint8_t len)
|
|
{
|
|
memcpy(&incMAC, mac, sizeof(incMAC));
|
|
#elif defined(ESP32)
|
|
void OnDataSent(const uint8_t *mac_addr, esp_now_send_status_t status)
|
|
{
|
|
if (status == ESP_NOW_SEND_SUCCESS)
|
|
{
|
|
esp_now_ack_flag = CRC_OK;
|
|
}
|
|
else
|
|
{
|
|
esp_now_ack_flag = CRC_BAD;
|
|
}
|
|
}
|
|
void OnDataRecv(const esp_now_recv_info *pkt_info, const uint8_t *incomingData, int len)
|
|
{
|
|
memcpy(&incMAC, pkt_info->src_addr, sizeof(incMAC));
|
|
#endif
|
|
if (len == sizeof(SystemPacket))
|
|
{
|
|
SystemPacket command;
|
|
memcpy(&command, incomingData, sizeof(command));
|
|
DBG2("Incoming ESP-NOW System Packet from 0x" + String(incMAC[5], HEX));
|
|
switch (command.cmd)
|
|
{
|
|
case cmd_ping:
|
|
if(command.param == ping_reply) {
|
|
pingFlag = true;
|
|
}
|
|
break;
|
|
case cmd_add:
|
|
is_added = true;
|
|
gtwy_timeout = command.param;
|
|
break;
|
|
case cmd_time:
|
|
if(command.param > MIN_TS) {
|
|
recvTimeEspNow(command.param);
|
|
}
|
|
break;
|
|
}
|
|
}
|
|
else if((len == sizeof(DataReading)))
|
|
{
|
|
memcpy(&theData, incomingData, len);
|
|
ln = len / sizeof(DataReading);
|
|
DBG2("Incoming ESP-NOW DataReading from 0x" + String(incMAC[5], HEX));
|
|
newData = event_espnowg;
|
|
// Processing done by handleIncoming() in fdrs_node.h
|
|
}
|
|
else {
|
|
DBG2("Incoming ESP-NOW Data from 0x" + String(incMAC[5], HEX) + " of unexpected size " + String(len));
|
|
}
|
|
}
|
|
|
|
// FDRS node pings gateway and listens for a defined amount of time for a reply
|
|
// ESP-NOW is on the order of 10 milliseconds so happens very quickly.
|
|
int pingFDRSEspNow(uint8_t *dstaddr, uint32_t timeout) {
|
|
SystemPacket sys_packet = {.cmd = cmd_ping, .param = ping_request};
|
|
unsigned long pingTime = 0;
|
|
|
|
pingFlag = false;
|
|
pingTime = millis();
|
|
DBG1("ESP-NOW ping sent to 0x" + String(*(dstaddr + 5),HEX));
|
|
esp_now_send(dstaddr, (uint8_t *)&sys_packet, sizeof(SystemPacket));
|
|
while(pingFlag == false && (millis() - pingTime < timeout)) {
|
|
yield();
|
|
delay(0);
|
|
}
|
|
if(pingFlag == true) {
|
|
|
|
pingTime = millis() - pingTime;
|
|
DBG1("ESP-NOW Ping Reply in " + String(pingTime) + "ms from 0x" + String(*(dstaddr + 5), HEX));
|
|
}
|
|
else {
|
|
DBG1("No ESP-NOW ping returned within " + String(timeout) + "ms.");
|
|
pingTime = -1;
|
|
}
|
|
pingFlag = false;
|
|
return pingTime;
|
|
|
|
}
|
|
|
|
bool refresh_registration()
|
|
{
|
|
#ifdef USE_ESPNOW
|
|
SystemPacket sys_packet = {.cmd = cmd_add, .param = 0};
|
|
esp_now_send(gatewayAddress, (uint8_t *)&sys_packet, sizeof(SystemPacket));
|
|
DBG1("Refreshing registration to 0x" + String(gatewayAddress[5],HEX));
|
|
uint32_t add_start = millis();
|
|
is_added = false;
|
|
while ((millis() - add_start) <= 1000) // 1000ms timeout
|
|
{
|
|
yield();
|
|
if (is_added)
|
|
{
|
|
DBG1("Registration accepted. Timeout: " + String(gtwy_timeout));
|
|
last_refresh = millis();
|
|
return true;
|
|
}
|
|
}
|
|
DBG1("No gateways accepted the request");
|
|
return false;
|
|
#endif // USE_ESPNOW
|
|
return true;
|
|
}
|
|
|
|
esp_err_t sendTimeESPNow() {
|
|
return ESP_OK;
|
|
} |