From eb884543da99f34195d1827c2b189d63a7acc536 Mon Sep 17 00:00:00 2001
From: Stefan `Sec` Zehl <sec@42.org>
Date: Sun, 17 Jul 2011 02:00:02 +0200
Subject: [PATCH] Add support for r0ket.cfg (invert & mirror flags for now)

---
 firmware/applications/default.c | 69 +++++++++++++++++++++++++++++++++
 1 file changed, 69 insertions(+)

diff --git a/firmware/applications/default.c b/firmware/applications/default.c
index 5f3826f..f104b0b 100644
--- a/firmware/applications/default.c
+++ b/firmware/applications/default.c
@@ -1,8 +1,68 @@
 #include <sysinit.h>
 #include "basic/basic.h"
 
+#include "lcd/lcd.h"
+#include "lcd/print.h"
+#include "filesystem/ff.h"
+#include "usb/usbmsc.h"
+
 /**************************************************************************/
 
+FATFS FatFs[_VOLUMES];          /* File system object for logical drive */
+
+#define CONFIGLEN 2
+int lcdInitConfig(){
+    FIL file[2];            /* File objects */
+    BYTE buf[CONFIGLEN];
+    UINT readbytes;
+    int res;
+
+    lcdFill(0); // clear display buffer
+    res=f_mount(0, &FatFs[0]);
+    lcdPrint("mount:");
+    lcdPrintln(f_get_rc_string(res));
+    if(res){
+        return 1;
+    };
+
+    res=f_open(&file[0], "r0ket.cfg", FA_OPEN_EXISTING|FA_READ);
+    lcdPrint("open:");
+    lcdPrintln(f_get_rc_string(res));
+    if(res){
+        lcdPrintln("r0ket.cfg missing!");
+        return 1;
+    };
+
+    for(int i=0;i<CONFIGLEN;i++)
+        buf[i]=0;
+
+    res = f_read(&file[0], buf, 2, &readbytes);
+    lcdPrint("read:");
+    lcdPrintln(f_get_rc_string(res));
+    if(res){
+        return 1;
+    };
+
+    lcdPrint("r: ");
+    lcdPrintCharHex(buf[0]);
+    lcdPrintCharHex(buf[1]);
+    lcdNl();
+
+    if(buf[0] == '1')
+        lcdToggleFlag(LCD_INVERTED);
+    if(buf[1] == '1')
+        lcdToggleFlag(LCD_MIRRORX);
+
+    res=f_close(&file[0]);
+    lcdPrint("close:");
+    lcdPrintln(f_get_rc_string(res));
+    if(res){
+        return 1;
+    };
+    return 0;
+};
+
+
 void main_default(void) {
     systickInit(10);
 
@@ -10,6 +70,15 @@ void main_default(void) {
         ISPandReset(7);
     };
 
+    font=&Font_7x8;
+    if(lcdInitConfig()){
+        lcdDisplay(0);
+        getInputWait();
+    }else{
+        lcdDisplay(0);
+        delayms(300);
+    };
+
     return;
 };