zrzk
/
zr-v4
1
0
Fork 0
Code Issues Pull Requests Projects Releases Wiki Activity
Browse Source

ToshibaLED: flashing green if disarmed with GPS lock 

solid blue if armed without GPS lock
master
Randy Mackay 12 years ago
parent
011915eb1c
commit
688dd5374e
1 changed files with 31 additions and 49 deletions
Whitespace
Show all changes Ignore whitespace when comparing lines Ignore changes in amount of whitespace Ignore changes in whitespace at EOL
Split View
Diff Options
Show Stats Download Patch File Download Diff File
  1. 80
      libraries/AP_Notify/ToshibaLED.cpp

80
libraries/AP_Notify/ToshibaLED.cpp
Unescape View File

@ -160,24 +160,33 @@ void ToshibaLED::update_colours(void) @@ -160,24 +160,33 @@ void ToshibaLED::update_colours(void)
// solid green or flashing green if armed
if (AP_Notify::flags.armed) {
// solid green if armed with 3d lock
// solid green if armed with GPS 3d lock
if (AP_Notify::flags.gps_status == 3) {
_red_des = TOSHIBA_LED_OFF;
_blue_des = TOSHIBA_LED_OFF;
_green_des = TOSHIBA_LED_DIM;
}else{
// flash green if armed with no gps lock
// solid blue if armed with no GPS lock
_red_des = TOSHIBA_LED_OFF;
_blue_des = TOSHIBA_LED_OFF;
_green_des = TOSHIBA_LED_DIM;
}
return;
}else{
// double flash yellow if failing pre-arm checks
if (!AP_Notify::flags.pre_arm_check) {
switch(step) {
case 0:
case 1:
case 2:
case 3:
case 4:
_red_des = TOSHIBA_LED_OFF;
case 5:
// yellow on
_red_des = TOSHIBA_LED_DIM;
_blue_des = TOSHIBA_LED_OFF;
_green_des = TOSHIBA_LED_DIM;
break;
case 5:
case 2:
case 3:
case 6:
case 7:
case 8:
@ -188,23 +197,27 @@ void ToshibaLED::update_colours(void) @@ -188,23 +197,27 @@ void ToshibaLED::update_colours(void)
_green_des = TOSHIBA_LED_OFF;
break;
}
}
return;
}else{
// double flash yellow if failing pre-arm checks
if (!AP_Notify::flags.pre_arm_check) {
}else{
// flashing green if disarmed with GPS 3d lock
// flashing blue if disarmed with no gps lock
switch(step) {
case 0:
case 1:
case 4:
case 5:
// yellow on
_red_des = TOSHIBA_LED_DIM;
_blue_des = TOSHIBA_LED_OFF;
_green_des = TOSHIBA_LED_DIM;
break;
case 2:
case 3:
case 4:
_red_des = TOSHIBA_LED_OFF;
if (AP_Notify::flags.gps_status == 3) {
// flashing green if disarmed with GPS 3d lock
_blue_des = TOSHIBA_LED_OFF;
_green_des = TOSHIBA_LED_DIM;
}else{
// flashing blue if disarmed with no gps lock
_blue_des = TOSHIBA_LED_DIM;
_green_des = TOSHIBA_LED_OFF;
}
break;
case 5:
case 6:
case 7:
case 8:
@ -215,37 +228,6 @@ void ToshibaLED::update_colours(void) @@ -215,37 +228,6 @@ void ToshibaLED::update_colours(void)
_green_des = TOSHIBA_LED_OFF;
break;
}
}else{
// solid blue if gps 3d lock
if (AP_Notify::flags.gps_status == 3) {
_red_des = TOSHIBA_LED_OFF;
_blue_des = TOSHIBA_LED_DIM;
_green_des = TOSHIBA_LED_OFF;
}else{
// flashing blue if no gps lock
switch(step) {
case 0:
case 1:
case 2:
case 3:
case 4:
// blue on
_red_des = TOSHIBA_LED_OFF;
_blue_des = TOSHIBA_LED_DIM;
_green_des = TOSHIBA_LED_OFF;
break;
case 5:
case 6:
case 7:
case 8:
case 9:
// all off
_red_des = TOSHIBA_LED_OFF;
_blue_des = TOSHIBA_LED_OFF;
_green_des = TOSHIBA_LED_OFF;
break;
}
}
}
}
}

Write Preview
Loading…
Cancel
Save