1 files changed, 44 insertions, 13 deletions

diff --git a/hal/uart.tpp b/hal/uart.tpp
index 8c120ec..e4b722e 100644
--- a/hal/uart.tpp
+++ b/hal/uart.tpp
@@ -26,22 +26,22 @@ extern "C" {
 namespace uart
 {
     template<unsigned dev>
-    bool rx_buffer_empty()
+    inline std::queue<uint8_t>& rx_buffer()
     {
-        return rx_buffer[dev -1].empty();
+        return uart::_rx_buffer[dev -1];
     }
 
     template<unsigned dev>
-    bool tx_buffer_full()
+    inline std::queue<uint8_t>& tx_buffer()
     {
-        return !tx_buffer[dev -1].empty();
+        return uart::_tx_buffer[dev -1];
     }
 
     template<unsigned dev>
     uint8_t read()
     {
-        uint8_t byte = rx_buffer[dev -1].front();
-        rx_buffer[dev -1].pop();
+        uint8_t byte = rx_buffer<dev>().front();
+        rx_buffer<dev>().pop();
 
         return byte;
     }
@@ -51,7 +51,7 @@ namespace uart
     {
         uint8_t *bptr = buffer;
         unsigned len = numbytes;
-        
+
         while (len--) {
             *(bptr++) = read<dev>();
         }
@@ -60,12 +60,20 @@ namespace uart
     template<unsigned dev>
     void write(const uint8_t byte)
     {
+        // disable send data flag
+        IEC1bits.U1TXIE = 0;
+
+        tx_buffer<dev>().push(byte);
 
+        // enable send data flag
+        IEC1bits.U1TXIE = 1;
     }
 
     template<unsigned dev>
     void write(const std::string &str)
     {
+        // TODO: if size of str is reasonale, push to queue AND THEN send
+        //       right now on each call the interrupt is enabled and disabled
         for (const char &c : str) {
             write<dev>(c);
         }
@@ -74,7 +82,12 @@ namespace uart
     template<unsigned dev>
     unsigned write(const uint8_t *buffer, const unsigned numbytes)
     {
+        uint8_t *bptr = buffer;
+        unsigned len = numbytes;
 
+        while (len--) {
+            write<dev>(*(bptr++));
+        }
     }
 }
 
@@ -83,26 +96,44 @@ namespace uart
 
 // debug
 #include "pin.tpp"
-pin<2> led_blue(&LATBbits, &TRISBbits, &PORTEbits);
+pin<2> led_blue(&LATBbits, &TRISBbits, &PORTBbits);
+pin<3> led_green(&LATBbits, &TRISBbits, &PORTBbits);
 
 void __ISR(_UART_1_VECTOR, IPL1AUTO) usart_1_isr()
 {
     if (IFS1bits.U1RXIF) {
         // debug
         led_blue.toggle();
-        while (U1STAbits.URXDA) {
-            uart::rx_buffer[0].push(static_cast<uint8_t>(U1RXREG));
-        }
+
+        // wait for data to be available
+        while (!U1STAbits.URXDA);
+        uart::rx_buffer<1>().push(static_cast<uint8_t>(U1RXREG));
 
         IFS1bits.U1RXIF = 0;
-    } else if (IFS1bits.U1TXIF) {
+
+    } 
+    // on each interrupt call, send one character
+    else if (IFS1bits.U1TXIF) {
+        // if empty, disable send data flag
+        if (uart::tx_buffer<1>().empty()) {
+            IEC1bits.U1TXIE = 0;
+            return;
+        }
+
+        led_green.toggle();
+
+        // write data
+        U1TXREG = static_cast<decltype(U1TXREG)>(uart::tx_buffer<1>().front());
+        uart::tx_buffer<1>().pop();
+
         IFS1bits.U1TXIF = 0;
+
     } else {
         if (U1STAbits.OERR == 1) {
             U1STAbits.OERR = 0;
         }
 
-        IFS1bits.U1TXIF = 0;
+        IFS1bits.U1EIF = 0;
     }
 }