Added Serial reset code

BinghamtonRover · May 30, 2023 · c7aa1ef · c7aa1ef
1 parent 332504f
commit c7aa1ef
Showing 1 changed file with 11 additions and 3 deletions.
diff --git a/BURT_serial.cpp b/BURT_serial.cpp
@@ -5,10 +5,18 @@ void BurtSerial::update() {
 	int length = Serial.available();
 	if (length == 0) return;
 	uint8_t input[length];
-	Serial.readBytes((char*) input, length);
+	int receivedLength = Serial.readBytes((char*) input, length);
 
-	if (!isConnected) tryConnect(input, length);
-	else handler(input, length);
+	if (!isConnected) {
+		tryConnect(input, length);
+	} else if (receivedLength == 4 && (input[0] == 0 && input[1] == 0 && input[2] == 0 && input[3] == 0)) {
+		// This is our special "reset" code. Respond with 1111
+		uint8_t response[4] = {0x01, 0x01, 0x01, 0x01};
+		Serial.write(response, 4);
+		isConnected = false;
+	} else {
+		handler(input, length);
+	}
 }
 
 void BurtSerial::tryConnect(uint8_t* input, int length) {