Implement uartPrintf()

firmware/src/commands.c

@@ -6,13 +6,9 @@
 
 #include <string.h>
 #include <stdbool.h>
-#include <stdio.h>
 #include <stdlib.h>
 #include <util/delay.h>
 
-// Internal function prototypes
-void _uartPutAsciiBlock(DataBuffer buffer);
-
 // Mode: ASCII (false) or binary (true)
 bool binary_mode = false;
 
@@ -23,6 +19,10 @@ void executeCommand(CommandLine cmdLine) {
         // INIT command: Initializes connection.
         commandInit(cmdLine.arg);
     }
+    else if (strcmp(cmdLine.command, "HELP") == 0) {
+        // HELP command: Print a list of supported commands.
+        commandHelp(cmdLine.arg);
+    }
     else if (strcmp(cmdLine.command, "READ") == 0) {
         // READ command: Takes a hex address range (or single address) as argument,
         // reads data and returns it in hexadecimal ASCII format.
@@ -32,6 +32,10 @@ void executeCommand(CommandLine cmdLine) {
         // WRITE command: Takes a hex address as argument, reads data from UART and writes it to the EEPROM.
         commandRead(cmdLine.arg);
     }
+    else if (strcmp(cmdLine.command, "ERASE") == 0) {
+        // ERASE command: Takes a hex address range as argument and writes 0x00 bytes to the specified range.
+        commandRead(cmdLine.arg);
+    }
     else if (strcmp(cmdLine.command, "TESTREAD") == 0) {
         // TESTREAD command: for testing purposes, reads a few bytes and returns them in a human readable format.
         commandTestRead();
@@ -68,6 +72,21 @@ void commandInit(char* arg) {
     }
 }
 
+void commandHelp() {
+    uartPutLine("HELP - Supported commands:");
+    uartPutLine("HELP - HELP");
+    uartPutLine("HELP - INIT [BINARY|ASCII]");
+    uartPutLine("HELP - READ 0000:0FFF");
+    uartPutLine("HELP - WRITE 0000");
+    uartPutLine("HELP - ERASE 0000:0FFF");
+
+    // TODO remove those
+    uartPutLine("HELP - TESTREAD (only for testing)");
+    uartPutLine("HELP - TESTWRITE (only for testing)");
+
+    uartPutLine("OK");
+}
+
 void commandRead(char* arg) {
     if (arg == NULL) {
         uartPutLine("ERR READ needs an address or address range");
@@ -104,25 +123,17 @@ void commandRead(char* arg) {
             }
         } else {
             // Fancy ASCII output
-            _uartPutAsciiBlock(buffer);
+            uartPrintf("<%d>", buffer.bytes);
+
+            for (int i = 0; i < buffer.bytes; i++) {
+                uartPrintf(" %02X", buffer.data[i]);
+            }
+            uartPutLine(NULL);
         }
 
     } while (buffer.bytes > 0);
 }
 
-void _uartPutAsciiBlock(DataBuffer buffer) {
-    char outBuffer[20];
-    sprintf(outBuffer, "<%d>", buffer.bytes);
-    uartPutString(outBuffer);
-
-    for (int i = 0; i < buffer.bytes; i++) {
-        sprintf(outBuffer, " %02X", buffer.data[i]);
-        uartPutString(outBuffer);
-    }
-
-    uartPutLine(NULL);
-}
-
 void commandWrite(char* arg) {
     if (arg == NULL) {
         uartPutLine("ERR WRITE needs a start address");
@@ -153,26 +164,20 @@ void commandErase() {
 
 // TESTREAD command: for testing purposes, reads a few bytes and returns them in a human readable format.
 void commandTestRead() {
-    uint8_t byte;
-    char outBuffer[20];
-
     eepromSetReadMode();
 
     for (int i = 0x00; i < 0x20; i++) {
-        itoa(i, outBuffer, 16);
-        uartPutString("TESTREAD 0x");
-        uartPutString(outBuffer);
-        uartPutString(": ");
+        uartPrintf("TESTREAD 0x%02X: ", i);
 
-        byte = eepromReadByte(i);
-        itoa(byte, outBuffer, 16);
+        uint8_t byte = eepromReadByte(i);
 
-        uartPutChar(byte);
-        uartPutString(" (0x");
-        uartPutString(outBuffer);
-        uartPutString(")");
+        if (byte >= 32 && byte <= 126) {
+            uartPutChar(byte);
+        } else {
+            uartPutChar('?');
+        }
 
-        uartPutLine(NULL);
+        uartPrintf(" (0x%02X)\n");
     }
 }
 

firmware/src/commands.h

@@ -6,7 +6,8 @@
 
 void executeCommand(CommandLine cmdLine);
 
-void commandInit();
+void commandHelp();
+void commandInit(char* arg);
 void commandRead(char* arg);
 void commandWrite(char* arg);
 void commandErase();

firmware/src/main.c

@@ -15,7 +15,7 @@ int main(void) {
     _delay_ms(100);
 
     // Write initial message via UART
-    uartPutLine("INFO -- EEPROM programmer by binaryDiv");
+    uartPutLine("INFO - EEPROM programmer by binaryDiv");
 
     while(1) {
         // Run main loop endlessly

firmware/src/uart.c

@@ -2,6 +2,8 @@
 #include "uart.h"
 
 #include <avr/io.h>
+#include <stdarg.h>
+#include <stdio.h>
 #include <util/setbaud.h>
 
 // Initialize UART
@@ -54,6 +56,19 @@ void uartPutLine(char* data) {
     uartPutChar('\n');
 }
 
+// Transmit a sprintf formatted string (maximum buffer: 256 bytes!)
+void uartPrintf(const char* format, ...) {
+    char outBuffer[256];
+
+    va_list args;
+    va_start(args, format);
+
+    vsprintf(outBuffer, format, args);
+    uartPutString(outBuffer);
+
+    va_end(args);
+}
+
 // Receive a single character (blocking)
 unsigned char uartGetChar() {
     // Block until a character has been received

firmware/src/uart.h

@@ -16,6 +16,9 @@ void uartPutString(char* data);
 // Transmit a string followed by a line break
 void uartPutLine(char* data);
 
+// Transmit a sprintf formatted string (maximum buffer: 256 bytes!)
+void uartPrintf(const char* format, ...);
+
 // Read a single character (blocking)
 unsigned char uartGetChar();