From 7eaa5f4e4b51454e2c4e7dd852b1d74fcde84f23 Mon Sep 17 00:00:00 2001
From: Stefan `Sec` Zehl <sec@42.org>
Date: Tue, 2 Aug 2011 10:55:01 +0200
Subject: [PATCH] more utility/debugging/info stuff

---
 firmware/applications/final/util.c | 40 +++++++++++++++++++++++++++++-
 1 file changed, 39 insertions(+), 1 deletion(-)

diff --git a/firmware/applications/final/util.c b/firmware/applications/final/util.c
index 9876ea4..401a3f5 100644
--- a/firmware/applications/final/util.c
+++ b/firmware/applications/final/util.c
@@ -4,6 +4,7 @@
 #include "basic/basic.h"
 #include "basic/config.h"
 
+#include "lcd/render.h"
 #include "lcd/print.h"
 
 #include "usb/usbmsc.h"
@@ -40,7 +41,7 @@ void ChkBattery(void) {
             lcdPrintln("0");
         };
         lcdRefresh();
-        delayms_queue(100);
+//        delayms_queue(100);
     } while ((getInputRaw())==BTN_NONE);
 }
 
@@ -94,3 +95,40 @@ void uuid(void) {
     lcdPrintln(IntToStrX(GetUUID32(),4));
     lcdRefresh();
 }
+
+void Qstatus(void) {
+    int dx=0;
+    int dy=8;
+    lcdClear();
+    dx=DoString(0,dy+16,"Qdepth:");
+    while ((getInputRaw())!=BTN_ENTER){
+        DoInt(dx,dy+16,(the_queue.qend-the_queue.qstart+MAXQENTRIES)%MAXQENTRIES);
+        lcdDisplay();
+        if(getInputRaw()!=BTN_NONE)
+            work_queue();
+        else
+            delayms(10);
+    };
+    dy+=16;
+    dx=DoString(0,dy,"Done.");
+};
+
+void blink_led0(void){
+    gpioSetValue (RB_LED0, 1-gpioGetValue(RB_LED0));
+};
+
+void tick_alive(void){
+    static int foo=0;
+
+    if(GLOBAL(alivechk)==0)
+        return;
+
+	if(foo++>500/SYSTICKSPEED){
+		foo=0;
+        if(GLOBAL(alivechk)==2)
+            push_queue(blink_led0);
+        else
+            blink_led0();
+	};
+    return;
+};