Diff: UsaPack.cpp

Revision:

3:526f824b50ef

Parent:

2:1096fc8201a3

Child:

4:844eff5a2fa8

diff -r 1096fc8201a3 -r 526f824b50ef UsaPack.cpp
--- a/UsaPack.cpp	Sat Apr 24 04:38:39 2021 +0000
+++ b/UsaPack.cpp	Mon Apr 26 11:33:25 2021 +0000
@@ -7,20 +7,37 @@
     {
         char c;
         c = serial.getc();
-        uart_buffer[uart_index] = c;
-        uart_index = (uart_index + 1) % uart_size;
+        receive_buffer[receive_index] = c;
+        receive_index = (receive_index + 1) % receive_size;
         if (c == '\0')
         {
             Decode();
-            uart_index = 0;
+            receive_index = 0;
+        }
+    }
+}
+
+void UsaPack::SendByte()
+{
+    while (serial.writable())
+    {
+        if (send_index != send_end_index)
+        {
+            serial.putc(send_buffer[send_index]);
+            send_index = (send_index + 1) % send_size;
+        }
+        else
+        {
+            serial.attach(NULL, Serial::TxIrq);
+            break;
         }
     }
 }
 
 void UsaPack::Decode()
 {
-    char data[uart_size];
-    CobsDecode(uart_buffer, uart_index-2, data);
+    char data[receive_size];
+    CobsDecode(receive_buffer, receive_index-2, data);
     union
     {
         char c[4];
@@ -44,12 +61,12 @@
 }
 
 UsaPack::UsaPack(PinName tx, PinName rx, int baud)
-    :serial(tx, rx, baud), uart_index(0), package_index(0)
+    :serial(tx, rx, baud), receive_index(0), package_index(0), send_index(0), send_end_index(0)
 {
     serial.attach(this, &UsaPack::Receive, Serial::RxIrq);
-    for (int i = 0; i < uart_size; i++)
+    for (int i = 0; i < receive_size; i++)
     {
-        uart_buffer[i] = '\0';
+        receive_buffer[i] = '\0';
     }
 }