ESP32-PaxCounter/src/senddata.cpp

232 lines
7.5 KiB
C++
Raw Normal View History

2018-07-14 19:12:20 +02:00
// Basic Config
#include "globals.h"
2018-08-03 23:50:04 +02:00
// put data to send in RTos Queues used for transmit over channels Lora and SPI
void EnqueueSendData(uint8_t port, uint8_t data[], uint8_t size) {
2018-08-04 14:37:41 +02:00
MessageBuffer_t MySendBuffer;
MySendBuffer.MessageSize = size;
MySendBuffer.MessagePort = PAYLOAD_ENCODER <= 2
? port
: (PAYLOAD_ENCODER == 4 ? LPP2PORT : LPP1PORT);
memcpy(MySendBuffer.Message, data, size);
// enqueue message in LoRa send queue
#ifdef HAS_LORA
if (xQueueSendToBack(LoraSendQueue, (void *)&MySendBuffer, (TickType_t)0))
ESP_LOGI(TAG, "%d bytes enqueued to send on LoRa", size);
#endif
// enqueue message in SPI send queue
#ifdef HAS_SPI
if (xQueueSendToBack(SPISendQueue, (void *)&MySendBuffer, (TickType_t)0))
ESP_LOGI(TAG, "%d bytes enqueued to send on SPI", size);
#endif
// clear counter if not in cumulative counter mode
if ((port == COUNTERPORT) && (cfg.countermode != 1)) {
reset_counters(); // clear macs container and reset all counters
reset_salt(); // get new salt for salting hashes
ESP_LOGI(TAG, "Counter cleared");
}
ESP_LOGI(TAG, "%d Bytes left", ESP.getFreeHeap());
} // senddata
// cyclic called function to prepare payload to send
void sendPayload() {
if (SendCycleTimerIRQ) {
portENTER_CRITICAL(&timerMux);
SendCycleTimerIRQ = 0;
portEXIT_CRITICAL(&timerMux);
// append counter data to payload
payload.reset();
payload.addCount(macs_wifi, cfg.blescan ? macs_ble : 0);
// append GPS data, if present
#ifdef HAS_GPS
// show NMEA data in debug mode, useful for debugging GPS on board
// connection
ESP_LOGD(TAG, "GPS NMEA data: passed %d / failed: %d / with fix: %d",
gps.passedChecksum(), gps.failedChecksum(),
gps.sentencesWithFix());
// log GPS position if we have a fix and gps data mode is enabled
if ((cfg.gpsmode) && (gps.location.isValid())) {
gps_read();
payload.addGPS(gps_status);
ESP_LOGD(TAG, "lat=%.6f | lon=%.6f | %u Sats | HDOP=%.1f | Altitude=%um",
gps_status.latitude / (float)1e6,
gps_status.longitude / (float)1e6, gps_status.satellites,
gps_status.hdop / (float)100, gps_status.altitude);
} else {
ESP_LOGD(TAG, "No valid GPS position or GPS data mode disabled");
}
#endif
EnqueueSendData(COUNTERPORT, payload.getBuffer(), payload.getSize());
}
} // sendpayload()
// interrupt handler used for payload send cycle timer
void IRAM_ATTR SendCycleIRQ() {
portENTER_CRITICAL(&timerMux);
SendCycleTimerIRQ++;
portEXIT_CRITICAL(&timerMux);
}
// cyclic called function to eat data from RTos send queues and transmit it
void processSendBuffer() {
MessageBuffer_t RcvBuf;
#ifdef HAS_LORA
// Check if there is a pending TX/RX job running
if ((LMIC.opmode & (OP_JOINING | OP_REJOIN | OP_TXDATA | OP_POLL)) != 0) {
// LoRa Busy -> don't eat data from queue, since it cannot be sent
} else {
if (xQueueReceive(LoraSendQueue, &(RcvBuf), (TickType_t)10)) {
// xMsg now holds the struct MessageBuffer from queue
LMIC_setTxData2(RcvBuf.MessagePort, RcvBuf.Message, RcvBuf.MessageSize,
(cfg.countermode & 0x02));
ESP_LOGI(TAG, "%d bytes sent to LORA", RcvBuf.MessageSize);
sprintf(display_line7, "PACKET QUEUED");
}
}
#endif
#ifdef HAS_SPI
if (xQueueReceive(SPISendQueue, &(RcvBuf), (TickType_t)10)) {
ESP_LOGI(TAG, "%d bytes sent to SPI", RcvBuf.MessageSize);
}
#endif
ESP_LOGI(TAG, "%d Bytes left", ESP.getFreeHeap());
} // processSendBuffer
/* old version with pointers
// Basic Config
#include "globals.h"
// put data to send in RTos Queues used for transmit over channels Lora and SPI
void EnqueueSendData(uint8_t port, uint8_t data[], uint8_t size) {
MessageBuffer_t *xMsg = &SendBuffer;
2018-07-14 19:12:20 +02:00
2018-08-03 23:50:04 +02:00
SendBuffer.MessageSize = size;
SendBuffer.MessagePort = PAYLOAD_ENCODER <= 2
? port
: (PAYLOAD_ENCODER == 4 ? LPP2PORT : LPP1PORT);
memcpy(SendBuffer.Message, data, size);
2018-07-21 13:36:49 +02:00
2018-08-03 23:50:04 +02:00
// enqueue message in LoRa send queue
#ifdef HAS_LORA
2018-08-04 14:37:41 +02:00
if (uxQueueSpacesAvailable(LoraSendQueue)) {
xQueueSend(LoraSendQueue, (void *)&xMsg, (TickType_t)0);
ESP_LOGI(TAG, "%d bytes enqueued to send on LoRa", size);
};
2018-07-14 19:12:20 +02:00
#endif
2018-08-03 23:50:04 +02:00
// enqueue message in SPI send queue
2018-07-14 19:12:20 +02:00
#ifdef HAS_SPI
2018-08-04 14:37:41 +02:00
if (uxQueueSpacesAvailable(SPISendQueue)) {
xQueueSend(SPISendQueue, (void *)&xMsg, (TickType_t)0);
ESP_LOGI(TAG, "%d bytes enqueued to send on SPI", size);
};
2018-07-14 19:12:20 +02:00
#endif
// clear counter if not in cumulative counter mode
2018-07-21 18:25:03 +02:00
if ((port == COUNTERPORT) && (cfg.countermode != 1)) {
2018-07-14 19:12:20 +02:00
reset_counters(); // clear macs container and reset all counters
reset_salt(); // get new salt for salting hashes
2018-07-21 18:25:03 +02:00
ESP_LOGI(TAG, "Counter cleared");
2018-07-14 19:12:20 +02:00
}
2018-08-04 14:37:41 +02:00
ESP_LOGI(TAG, "%d Bytes left", ESP.getFreeHeap());
2018-07-22 20:27:58 +02:00
} // senddata
2018-08-03 23:50:04 +02:00
// cyclic called function to prepare payload to send
2018-07-22 20:27:58 +02:00
void sendPayload() {
if (SendCycleTimerIRQ) {
portENTER_CRITICAL(&timerMux);
SendCycleTimerIRQ = 0;
portEXIT_CRITICAL(&timerMux);
// append counter data to payload
payload.reset();
payload.addCount(macs_wifi, cfg.blescan ? macs_ble : 0);
// append GPS data, if present
#ifdef HAS_GPS
// show NMEA data in debug mode, useful for debugging GPS on board
// connection
ESP_LOGD(TAG, "GPS NMEA data: passed %d / failed: %d / with fix: %d",
gps.passedChecksum(), gps.failedChecksum(),
gps.sentencesWithFix());
// log GPS position if we have a fix and gps data mode is enabled
if ((cfg.gpsmode) && (gps.location.isValid())) {
gps_read();
payload.addGPS(gps_status);
ESP_LOGD(TAG, "lat=%.6f | lon=%.6f | %u Sats | HDOP=%.1f | Altitude=%um",
gps_status.latitude / (float)1e6,
gps_status.longitude / (float)1e6, gps_status.satellites,
gps_status.hdop / (float)100, gps_status.altitude);
} else {
ESP_LOGD(TAG, "No valid GPS position or GPS data mode disabled");
}
#endif
2018-08-03 23:50:04 +02:00
EnqueueSendData(COUNTERPORT, payload.getBuffer(), payload.getSize());
2018-07-22 20:27:58 +02:00
}
2018-08-03 23:50:04 +02:00
} // sendpayload()
2018-07-23 08:25:23 +02:00
2018-08-03 23:50:04 +02:00
// interrupt handler used for payload send cycle timer
2018-07-23 08:25:23 +02:00
void IRAM_ATTR SendCycleIRQ() {
portENTER_CRITICAL(&timerMux);
SendCycleTimerIRQ++;
portEXIT_CRITICAL(&timerMux);
2018-08-03 23:50:04 +02:00
}
// cyclic called function to eat data from RTos send queues and transmit it
void processSendBuffer() {
2018-08-04 14:37:41 +02:00
2018-08-03 23:50:04 +02:00
MessageBuffer_t *xMsg;
#ifdef HAS_LORA
// Check if there is a pending TX/RX job running
2018-08-04 14:37:41 +02:00
if ((LMIC.opmode & (OP_JOINING | OP_REJOIN | OP_TXDATA | OP_POLL)) != 0) {
// LoRa Busy -> don't eat data from queue, since it cannot be sent
2018-08-03 23:50:04 +02:00
} else {
2018-08-04 14:37:41 +02:00
if (uxQueueMessagesWaiting(LoraSendQueue)) // check if msg are waiting on
queue if (xQueueReceive(LoraSendQueue, &xMsg, (TickType_t)10)) {
// xMsg now holds the struct MessageBuffer from queue
LMIC_setTxData2(xMsg->MessagePort, xMsg->Message, xMsg->MessageSize,
(cfg.countermode & 0x02));
ESP_LOGI(TAG, "%d bytes sent to LORA", xMsg->MessageSize);
sprintf(display_line7, "PACKET QUEUED");
}
2018-08-03 23:50:04 +02:00
}
#endif
#ifdef HAS_SPI
2018-08-04 14:37:41 +02:00
if (uxQueueMessagesWaiting(SPISendQueue)) // check if msg are waiting on queue
if (xQueueReceive(SPISendQueue, &xMsg, (TickType_t)10)) {
2018-08-03 23:50:04 +02:00
2018-08-04 14:37:41 +02:00
// to come here: send data over SPI
// use these pointers to the payload:
// xMsg->MessagePort
// xMsg->MessageSize
// xMsg->Message
2018-08-03 23:50:04 +02:00
2018-08-04 14:37:41 +02:00
ESP_LOGI(TAG, "%d bytes sent to SPI", xMsg->MessageSize);
}
2018-08-03 23:50:04 +02:00
#endif
2018-08-04 14:37:41 +02:00
ESP_LOGI(TAG, "%d Bytes left", ESP.getFreeHeap());
} // processSendBuffer
*/