From: Andy Spencer <andy753421@gmail.com>
Date: Sun, 9 Feb 2014 20:24:39 +0000 (+0000)
Subject: Add debug LED
X-Git-Url: http://pileus.org/git/?p=~andy%2Fcsm213a-hw;a=commitdiff_plain;h=32734968400fa660fe7581d1e9ade29e0f912cd3

Add debug LED
---

diff --git a/yue/main.cpp b/yue/main.cpp
index e08c06d..c82b9ca 100644
--- a/yue/main.cpp
+++ b/yue/main.cpp
@@ -22,6 +22,7 @@
 #define LGT_SNS_DEFAULT   1.0
 #define TCH_SNS_DEFAULT   1.0
 #define A2D_SNS_DEFAULT   1.0
+#define LED_OUT_DEFAULT   0.5
 
 #define MIN_RATE          1E-4  // 1 kHz
 #define MAX_RATE          10.0  // 0.1 Hz
@@ -75,14 +76,17 @@ typedef struct {
 } command_t;
 
 // Define Devices & Pins
-MMA8451Q  accSensor(PTE25, PTE24, MMA8451_I2C_ADDRESS);
-MAG3110   magSensor(PTE25, PTE24);
-TSISensor tchSensor;
-AnalogIn  lgtSensor(PTE22);
-AnalogIn  a2dSensor(A0);
+MMA8451Q   accSensor(PTE25, PTE24, MMA8451_I2C_ADDRESS);
+MAG3110    magSensor(PTE25, PTE24);
+TSISensor  tchSensor;
+AnalogIn   lgtSensor(PTE22);
+AnalogIn   a2dSensor(A0);
 
-Serial serial(USBTX, USBRX);
-Ticker clock1;
+DigitalOut led1(LED1);
+DigitalOut led2(LED2);
+
+Serial     serial(USBTX, USBRX);
+Ticker     clock1;
 
 // Global Variables
 // Initial interval: in seconds
@@ -91,12 +95,14 @@ float magTmr = MAG_SNS_DEFAULT;
 float tchTmr = TCH_SNS_DEFAULT;
 float lgtTmr = LGT_SNS_DEFAULT;
 float a2dTmr = A2D_SNS_DEFAULT;
+float ledTmr = LED_OUT_DEFAULT;
 
 bool accEnable = true;
 bool magEnable = false;
 bool lgtEnable = false;
 bool tchEnable = false;
 bool a2dEnable = false;
+bool ledEnable = true;
 
 bool useStr = true;
 bool useHex = false;
@@ -233,14 +239,16 @@ void clock1_interrupt(void){
     static int lgtCnt;
     static int tchCnt;
     static int a2dCnt;
+    static int ledCnt;
 
     accCnt++;
     magCnt++;
     lgtCnt++;
     tchCnt++;
     a2dCnt++;
+    ledCnt++;
 
-    // TODO: send data through Serial
+    // Send data through Serial
     if (accEnable && (accCnt<0 || accCnt>=accTmr/TIME_ACCURACY)){
         sendAccInfo();
         accCnt = 0;
@@ -262,6 +270,12 @@ void clock1_interrupt(void){
         a2dCnt = 0;
     }
 
+    // Toggel LED for debugging
+    if (ledEnable && (ledCnt<0 || ledCnt>=ledTmr/TIME_ACCURACY)){
+        led1   = !led1;
+	ledCnt = 0;
+    }
+
     sdma_flush();
 }