From 934566900077d48275d9cced9da59f12284c16b3 Mon Sep 17 00:00:00 2001
From: Federico Nabarlats <fnabarlats@gmail.com>
Date: Tue, 21 Jul 2020 20:07:31 -0300
Subject: [PATCH] implement CSE/SPD

---
 src/LibAPRS.cpp | 29 +++++++++++++++++++++++++++--
 src/LibAPRS.h   |  2 ++
 2 files changed, 29 insertions(+), 2 deletions(-)

diff --git a/src/LibAPRS.cpp b/src/LibAPRS.cpp
index f271933..359f59c 100644
--- a/src/LibAPRS.cpp
+++ b/src/LibAPRS.cpp
@@ -34,6 +34,9 @@ char latitude[9];
 char longtitude[10];
 char symbolTable = '/';
 char symbol = 'n';
+char speed[4] = "000";
+char course[4] = "000";
+
 
 uint8_t power = 10;
 uint8_t height = 10;
@@ -175,6 +178,16 @@ void APRS_setDirectivity(int s) {
     }
 }
 
+void APRS_setCourse(int s){
+	int temp = s;
+    sprintf(course, "%03d", s);
+}
+
+void APRS_setSpeed(int s){
+	int temp = s;
+	sprintf(speed, "%03d", s);
+}
+
 void APRS_printSettings() {
     Serial.println(F("LibAPRS Settings:"));
     Serial.print(F("Callsign:     ")); Serial.print(CALL); Serial.print(F("-")); Serial.println(CALL_SSID);
@@ -184,7 +197,7 @@ void APRS_printSettings() {
     Serial.print(F("Message dst:  ")); if (message_recip[0] == 0) { Serial.println(F("N/A")); } else { Serial.print(message_recip); Serial.print(F("-")); Serial.println(message_recip_ssid); }
     Serial.print(F("TX Preamble:  ")); Serial.println(custom_preamble);
     Serial.print(F("TX Tail:      ")); Serial.println(custom_tail);
-    Serial.print(F("Symbol table: ")); if (symbolTable == '/') { Serial.println(F("Normal")); } else { Serial.println(F("Alternate")); }
+    Serial.print(F("Symbol table: ")); if (symbolTable = '/') { Serial.println(F("Normal")); } else { Serial.println(F("Alternate")); }
     Serial.print(F("Symbol:       ")); Serial.println(symbol);
     Serial.print(F("Power:        ")); if (power < 10) { Serial.println(power); } else { Serial.println(F("N/A")); }
     Serial.print(F("Height:       ")); if (height < 10) { Serial.println(height); } else { Serial.println(F("N/A")); }
@@ -222,10 +235,15 @@ void APRS_sendPkt(void *_buffer, size_t length) {
 void APRS_sendLoc(void *_buffer, size_t length) {
     size_t payloadLength = 20+length;
     bool usePHG = false;
+	bool useCS = false;
     if (power < 10 && height < 10 && gain < 10 && directivity < 9) {
         usePHG = true;
         payloadLength += 7;
     }
+	else if ( speed[2] != '0' ){   
+		useCS = true;
+		payloadLength += 7;
+	}	
     uint8_t *packet = (uint8_t*)malloc(payloadLength);
     uint8_t *ptr = packet;
     packet[0] = '=';
@@ -246,6 +264,13 @@ void APRS_sendLoc(void *_buffer, size_t length) {
         packet[26] = directivity+48;
         ptr+=7;
     }
+	if (useCS){
+		memcpy(ptr, course, 3);
+		packet[23] = '/';
+		ptr += 4;
+		memcpy(ptr, speed, 3);
+		ptr += 3;
+	}	
     if (length > 0) {
         uint8_t *buffer = (uint8_t *)_buffer;
         memcpy(ptr, buffer, length);
@@ -345,4 +370,4 @@ int freeMemory() {
     free_memory += freeListSize();
   }
   return free_memory;
-}
+}
\ No newline at end of file
diff --git a/src/LibAPRS.h b/src/LibAPRS.h
index 78e725a..b6afc50 100644
--- a/src/LibAPRS.h
+++ b/src/LibAPRS.h
@@ -28,6 +28,8 @@ void APRS_setPower(int s);
 void APRS_setHeight(int s);
 void APRS_setGain(int s);
 void APRS_setDirectivity(int s);
+void APRS_setCourse(int s);
+void APRS_setSpeed(int s);
 
 void APRS_sendPkt(void *_buffer, size_t length);
 void APRS_sendLoc(void *_buffer, size_t length);