|
|
|
@ -96,26 +96,35 @@ static void clear_leds()
@@ -96,26 +96,35 @@ static void clear_leds()
|
|
|
|
|
#if MOTOR_LEDS == 1 |
|
|
|
|
static void update_motor_leds(void) |
|
|
|
|
{ |
|
|
|
|
// blink rear |
|
|
|
|
static bool blink = false; |
|
|
|
|
|
|
|
|
|
if (blink){ |
|
|
|
|
digitalWrite(RE_LED, HIGH); |
|
|
|
|
digitalWrite(FR_LED, HIGH); |
|
|
|
|
digitalWrite(RI_LED, LOW); |
|
|
|
|
digitalWrite(LE_LED, LOW); |
|
|
|
|
}else{ |
|
|
|
|
if (motor_armed == true){ |
|
|
|
|
if (low_batt == true){ |
|
|
|
|
// blink rear |
|
|
|
|
static bool blink = false; |
|
|
|
|
|
|
|
|
|
if (blink){ |
|
|
|
|
digitalWrite(RE_LED, HIGH); |
|
|
|
|
digitalWrite(FR_LED, HIGH); |
|
|
|
|
digitalWrite(RI_LED, LOW); |
|
|
|
|
digitalWrite(LE_LED, LOW); |
|
|
|
|
}else{ |
|
|
|
|
digitalWrite(RE_LED, LOW); |
|
|
|
|
digitalWrite(FR_LED, LOW); |
|
|
|
|
digitalWrite(RI_LED, HIGH); |
|
|
|
|
digitalWrite(LE_LED, HIGH); |
|
|
|
|
} |
|
|
|
|
blink = !blink; |
|
|
|
|
}else{ |
|
|
|
|
digitalWrite(RE_LED, HIGH); |
|
|
|
|
digitalWrite(FR_LED, HIGH); |
|
|
|
|
digitalWrite(RI_LED, HIGH); |
|
|
|
|
digitalWrite(LE_LED, HIGH); |
|
|
|
|
} |
|
|
|
|
}else { |
|
|
|
|
digitalWrite(RE_LED, LOW); |
|
|
|
|
digitalWrite(FR_LED, LOW); |
|
|
|
|
digitalWrite(RI_LED, HIGH); |
|
|
|
|
digitalWrite(LE_LED, HIGH); |
|
|
|
|
digitalWrite(RI_LED, LOW); |
|
|
|
|
digitalWrite(LE_LED, LOW); |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
blink = !blink; |
|
|
|
|
|
|
|
|
|
// the variable low_batt is here to let people know the voltage is low or the pack capacity is finished |
|
|
|
|
// I don't know what folks want here. |
|
|
|
|
// low_batt |
|
|
|
|
} |
|
|
|
|
#endif |
|
|
|
|
|
|
|
|
|