Diff: BBSerial.cpp

Revision:

3:4bb49a5dfa47

Child:

4:f0be0d8a0394

--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/BBSerial.cpp	Sat Jul 30 13:58:52 2016 +0000
@@ -0,0 +1,60 @@
+#include "BBSerial.h"
+
+#include "stdio.h"
+
+BBSerial::BBSerial() :
+uart(PTC17, PTC16) // tx, rx of uart3
+{
+    uart.baud(9600);
+    uart.format(8, SerialBase::Odd, 2);
+}
+
+
+void BBSerial::printf(const char* format, ...) {
+    va_list argptr;
+    va_start(argptr, format);
+    
+    char newFormat[200];
+    
+    // Add garbage and header in order to resolve first byte error
+    sprintf(newFormat, "GARBAGEAAAAA%sZZZZZ\n", format);
+    char buf[200];
+    vsprintf(buf, newFormat, argptr);
+    uart.printf("%s", buf);
+ 
+    va_end(argptr);   
+}
+
+int BBSerial::scanf(const char* format, ...) {
+    if(!uart.readable()) {
+        return 0;
+    }
+    va_list argptr;
+    va_start(argptr, format);
+    
+    char line[200];
+    uart.gets(line, 200);
+    line[199] = '\0';
+    
+    int read=0;
+    
+    int start = 0;
+    for (int i = 0; i < 10; i++) {
+        if(strncmp("AAAAA", &line[i], 5) == 0) {
+            start = i+5;
+        }
+    }
+    char *clean = &line[start];
+    
+    int end = strlen(clean)-6;
+    clean[end] = 0;
+    
+    if(start < 1) {
+        read = 0;
+    } else {
+        read = vsscanf(clean, format, argptr);
+    }
+      
+    va_end(argptr);   
+    return read;
+}
\ No newline at end of file