CLI stepping leds

git-svn-id: https://arducopter.googlecode.com/svn/trunk@974 f9c3cf11-9bcb-44bc-f272-b75c42450872

ArducopterNG/Arducopter.h

@@ -327,6 +327,7 @@ int gled_speed;
 
 long cli_timer;
 byte cli_status = LOW;
+byte cli_step;
 
 long  t0;
 int   num_iter;

ArducopterNG/ArducopterNG.pde

@@ -189,7 +189,7 @@
 #endif
 
 /* Software version */
-#define VER 1.52    // Current software version (only numeric values)
+#define VER 1.53    // Current software version (only numeric values)
 
 // Sensors - declare one global instance
 AP_ADC_ADS7844		adc;

ArducopterNG/CLI.pde

@@ -74,6 +74,7 @@ void RunCLI () {
     // Blinking Red, Yellow, Green when in CLI mode
     if(millis() - cli_timer > 1000) {
       cli_timer = millis();
+/*
       if(cli_status == HIGH) { 
         LEDAllOFF();
         cli_status = LOW;
@@ -82,6 +83,8 @@ void RunCLI () {
         LEDAllON();
         cli_status = HIGH; 
       }
+      */
+      CLILedStep();
     }
 
 

ArducopterNG/Functions.pde

@@ -139,9 +139,30 @@ int limitRange(int data, int minLimit, int maxLimit) {
 }
 
 
+// Stepping G, Y, R Leds
+// Call CLILedStep(); to change led statuses
+// Used on CLI as showing that we are in CLI mode
+void CLILedStep () {
   
-void CLILeds (byte ledstep) {
-  
+  switch(cli_step) {
+  case 1:
+        digitalWrite(LED_Green, HIGH);
+        digitalWrite(LED_Yellow, LOW);
+        digitalWrite(LED_Red, LOW);
+  break;
+  case 2:
+        digitalWrite(LED_Green, LOW);
+        digitalWrite(LED_Yellow, HIGH);
+        digitalWrite(LED_Red, LOW);
+  break;
+  case 3:
+        digitalWrite(LED_Green, LOW);
+        digitalWrite(LED_Yellow, LOW);
+        digitalWrite(LED_Red, HIGH);
+  break;
+  }
+  cli_step ++; 
+  if(cli_step == 4) cli_step = 1;  
   
 }