diff --git a/src/fdrs_node.h b/src/fdrs_node.h index 4debed2..3d8ec01 100644 --- a/src/fdrs_node.h +++ b/src/fdrs_node.h @@ -497,7 +497,16 @@ void loadFDRS(float d, uint8_t t) { fdrsData[data_count] = dr; data_count++; } - +void loadFDRS(float d, uint8_t t, uint16_t id) { + DBG("Id: " + String(READING_ID) + " - Type: " + String(t) + " - Data loaded: " + String(d)); + if (data_count > espnow_size) sendFDRS(); + DataReading dr; + dr.id = id; + dr.t = t; + dr.d = d; + fdrsData[data_count] = dr; + data_count++; +} void sleepFDRS(int sleep_time) { DBG("Sleepytime!"); #ifdef DEEP_SLEEP