Add new commands and responses for RSSI, channel status, airtime, noise floor, statistics, battery, and sensors.

examples/kiss_modem/KissModem.cpp

@@ -10,6 +10,13 @@ KissModem::KissModem(Stream& serial, mesh::LocalIdentity& identity, mesh::RNG& r
   _setRadioCallback = nullptr;
   _setTxPowerCallback = nullptr;
   _setSyncWordCallback = nullptr;
+  _getCurrentRssiCallback = nullptr;
+  _isChannelBusyCallback = nullptr;
+  _getAirtimeCallback = nullptr;
+  _getNoiseFloorCallback = nullptr;
+  _getStatsCallback = nullptr;
+  _getBatteryCallback = nullptr;
+  _getSensorsCallback = nullptr;
   _config = {0, 0, 0, 0, 0, 0x12};
 }
 
@@ -91,6 +98,8 @@ void KissModem::processFrame() {
         writeErrorFrame(ERR_INVALID_LENGTH);
       } else if (data_len > KISS_MAX_PACKET_SIZE) {
         writeErrorFrame(ERR_INVALID_LENGTH);
+      } else if (_has_pending_tx) {
+        writeErrorFrame(ERR_TX_PENDING);
       } else {
         memcpy(_pending_tx, data, data_len);
         _pending_tx_len = data_len;
@@ -142,6 +151,30 @@ void KissModem::processFrame() {
     case CMD_GET_VERSION:
       handleGetVersion();
       break;
+    case CMD_GET_CURRENT_RSSI:
+      handleGetCurrentRssi();
+      break;
+    case CMD_IS_CHANNEL_BUSY:
+      handleIsChannelBusy();
+      break;
+    case CMD_GET_AIRTIME:
+      handleGetAirtime(data, data_len);
+      break;
+    case CMD_GET_NOISE_FLOOR:
+      handleGetNoiseFloor();
+      break;
+    case CMD_GET_STATS:
+      handleGetStats();
+      break;
+    case CMD_GET_BATTERY:
+      handleGetBattery();
+      break;
+    case CMD_PING:
+      handlePing();
+      break;
+    case CMD_GET_SENSORS:
+      handleGetSensors(data, data_len);
+      break;
     default:
       writeErrorFrame(ERR_UNKNOWN_CMD);
       break;
@@ -360,3 +393,98 @@ void KissModem::onTxComplete(bool success) {
   uint8_t result = success ? 0x01 : 0x00;
   writeFrame(RESP_TX_DONE, &result, 1);
 }
+
+void KissModem::handleGetCurrentRssi() {
+  if (!_getCurrentRssiCallback) {
+    writeErrorFrame(ERR_NO_CALLBACK);
+    return;
+  }
+  
+  float rssi = _getCurrentRssiCallback();
+  int8_t rssi_byte = (int8_t)rssi;
+  writeFrame(RESP_CURRENT_RSSI, (uint8_t*)&rssi_byte, 1);
+}
+
+void KissModem::handleIsChannelBusy() {
+  if (!_isChannelBusyCallback) {
+    writeErrorFrame(ERR_NO_CALLBACK);
+    return;
+  }
+  
+  uint8_t busy = _isChannelBusyCallback() ? 0x01 : 0x00;
+  writeFrame(RESP_CHANNEL_BUSY, &busy, 1);
+}
+
+void KissModem::handleGetAirtime(const uint8_t* data, uint16_t len) {
+  if (len < 1) {
+    writeErrorFrame(ERR_INVALID_LENGTH);
+    return;
+  }
+  if (!_getAirtimeCallback) {
+    writeErrorFrame(ERR_NO_CALLBACK);
+    return;
+  }
+  
+  uint8_t packet_len = data[0];
+  uint32_t airtime = _getAirtimeCallback(packet_len);
+  writeFrame(RESP_AIRTIME, (uint8_t*)&airtime, 4);
+}
+
+void KissModem::handleGetNoiseFloor() {
+  if (!_getNoiseFloorCallback) {
+    writeErrorFrame(ERR_NO_CALLBACK);
+    return;
+  }
+  
+  int16_t noise_floor = _getNoiseFloorCallback();
+  writeFrame(RESP_NOISE_FLOOR, (uint8_t*)&noise_floor, 2);
+}
+
+void KissModem::handleGetStats() {
+  if (!_getStatsCallback) {
+    writeErrorFrame(ERR_NO_CALLBACK);
+    return;
+  }
+  
+  uint32_t rx, tx, errors;
+  _getStatsCallback(&rx, &tx, &errors);
+  uint8_t buf[12];
+  memcpy(buf, &rx, 4);
+  memcpy(buf + 4, &tx, 4);
+  memcpy(buf + 8, &errors, 4);
+  writeFrame(RESP_STATS, buf, 12);
+}
+
+void KissModem::handleGetBattery() {
+  if (!_getBatteryCallback) {
+    writeErrorFrame(ERR_NO_CALLBACK);
+    return;
+  }
+  
+  uint16_t mv = _getBatteryCallback();
+  writeFrame(RESP_BATTERY, (uint8_t*)&mv, 2);
+}
+
+void KissModem::handlePing() {
+  writeFrame(RESP_PONG, nullptr, 0);
+}
+
+void KissModem::handleGetSensors(const uint8_t* data, uint16_t len) {
+  if (len < 1) {
+    writeErrorFrame(ERR_INVALID_LENGTH);
+    return;
+  }
+  if (!_getSensorsCallback) {
+    writeErrorFrame(ERR_NO_CALLBACK);
+    return;
+  }
+  
+  uint8_t permissions = data[0];
+  uint8_t buf[255];
+  uint8_t result_len = _getSensorsCallback(permissions, buf, 255);
+  if (result_len > 0) {
+    writeFrame(RESP_SENSORS, buf, result_len);
+  } else {
+    writeFrame(RESP_SENSORS, nullptr, 0);
+  }
+}