From 2b257620600859fb21b1441f3c490b9125df9af8 Mon Sep 17 00:00:00 2001
From: Mark Qvist <mark@adepta.io>
Date: Wed, 20 May 2020 16:16:04 +0200
Subject: [PATCH] Added querying packet buffer state as KISS command

---
 Config.h           | 2 +-
 RNode_Firmware.ino | 6 ++++++
 Utilities.h        | 7 +++++++
 3 files changed, 14 insertions(+), 1 deletion(-)

diff --git a/Config.h b/Config.h
index 5685c00..13b0b91 100644
--- a/Config.h
+++ b/Config.h
@@ -4,7 +4,7 @@
 	#define CONFIG_H
 
 	#define MAJ_VERS  0x01
-	#define MIN_VERS  0x0B
+	#define MIN_VERS  0x0C
 
 	#define MCU_328P  0x90
 	#define MCU_1284P 0x91
diff --git a/RNode_Firmware.ino b/RNode_Firmware.ino
index 78f2d08..f1d5280 100644
--- a/RNode_Firmware.ino
+++ b/RNode_Firmware.ino
@@ -468,6 +468,12 @@ void serialCallback(uint8_t sbyte) {
         promisc_disable();
       }
       kiss_indicate_promisc();
+    } else if (command == CMD_READY) {
+      if (!queueFull()) {
+        kiss_indicate_ready();
+      } else {
+        kiss_indicate_not_ready();
+      }
     } else if (command == CMD_UNLOCK_ROM) {
       if (sbyte == ROM_UNLOCK_BYTE) {
         unlock_rom();
diff --git a/Utilities.h b/Utilities.h
index 29033a0..26c2255 100644
--- a/Utilities.h
+++ b/Utilities.h
@@ -207,6 +207,13 @@ void kiss_indicate_ready() {
 	Serial.write(FEND);
 }
 
+void kiss_indicate_not_ready() {
+	Serial.write(FEND);
+	Serial.write(CMD_READY);
+	Serial.write(0x00);
+	Serial.write(FEND);
+}
+
 void kiss_indicate_promisc() {
 	Serial.write(FEND);
 	Serial.write(CMD_PROMISC);