aepko/Ardupilot2
1
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity

Toshiba_LED_PX4: local #defines for led brightness

Browse Source
This commit is contained in:
Randy Mackay 2013-08-14 12:21:44 +09:00 committed by Andrew Tridgell
parent 52ef77393c
commit 2658cda4bc
2 changed files with 47 additions and 43 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

84
libraries/AP_Notify/ToshibaLED_PX4.cpp
View File

@ -112,14 +112,14 @@ void ToshibaLED_PX4::_scheduled_update(uint32_t now)
if (AP_Notify::flags.initialising) {
if (step & 1) {
// odd steps display red light
_red_des = TOSHIBA_LED_DIM;
_blue_des = TOSHIBA_LED_OFF;
_green_des = TOSHIBA_LED_OFF;
_red_des = TOSHIBA_PX4_LED_DIM;
_blue_des = TOSHIBA_PX4_LED_OFF;
_green_des = TOSHIBA_PX4_LED_OFF;
}else{
// even display blue light
_red_des = TOSHIBA_LED_OFF;
_blue_des = TOSHIBA_LED_DIM;
_green_des = TOSHIBA_LED_OFF;
_red_des = TOSHIBA_PX4_LED_OFF;
_blue_des = TOSHIBA_PX4_LED_DIM;
_green_des = TOSHIBA_PX4_LED_OFF;
}
// exit so no other status modify this pattern
@ -132,31 +132,31 @@ void ToshibaLED_PX4::_scheduled_update(uint32_t now)
case 0:
case 3:
case 6:
_red_des = TOSHIBA_LED_DIM;
_blue_des = TOSHIBA_LED_OFF;
_green_des = TOSHIBA_LED_OFF;
_red_des = TOSHIBA_PX4_LED_DIM;
_blue_des = TOSHIBA_PX4_LED_OFF;
_green_des = TOSHIBA_PX4_LED_OFF;
break;
case 1:
case 4:
case 7:
_red_des = TOSHIBA_LED_OFF;
_blue_des = TOSHIBA_LED_DIM;
_green_des = TOSHIBA_LED_OFF;
_red_des = TOSHIBA_PX4_LED_OFF;
_blue_des = TOSHIBA_PX4_LED_DIM;
_green_des = TOSHIBA_PX4_LED_OFF;
break;
case 2:
case 5:
case 8:
_red_des = TOSHIBA_LED_OFF;
_blue_des = TOSHIBA_LED_OFF;
_green_des = TOSHIBA_LED_DIM;
_red_des = TOSHIBA_PX4_LED_OFF;
_blue_des = TOSHIBA_PX4_LED_OFF;
_green_des = TOSHIBA_PX4_LED_DIM;
break;
case 9:
_red_des = TOSHIBA_LED_OFF;
_blue_des = TOSHIBA_LED_OFF;
_green_des = TOSHIBA_LED_OFF;
_red_des = TOSHIBA_PX4_LED_OFF;
_blue_des = TOSHIBA_PX4_LED_OFF;
_green_des = TOSHIBA_PX4_LED_OFF;
break;
}
// exit so no other status modify this pattern
@ -167,9 +167,9 @@ void ToshibaLED_PX4::_scheduled_update(uint32_t now)
if (AP_Notify::flags.armed) {
// solid green if armed with 3d lock
if (AP_Notify::flags.gps_status == 3) {
_red_des = TOSHIBA_LED_OFF;
_blue_des = TOSHIBA_LED_OFF;
_green_des = TOSHIBA_LED_DIM;
_red_des = TOSHIBA_PX4_LED_OFF;
_blue_des = TOSHIBA_PX4_LED_OFF;
_green_des = TOSHIBA_PX4_LED_DIM;
}else{
// flash green if armed with no gps lock
switch(step) {
@ -178,18 +178,18 @@ void ToshibaLED_PX4::_scheduled_update(uint32_t now)
case 2:
case 3:
case 4:
_red_des = TOSHIBA_LED_DIM;
_blue_des = TOSHIBA_LED_DIM;
_green_des = TOSHIBA_LED_DIM;
_red_des = TOSHIBA_PX4_LED_DIM;
_blue_des = TOSHIBA_PX4_LED_DIM;
_green_des = TOSHIBA_PX4_LED_DIM;
break;
case 5:
case 6:
case 7:
case 8:
case 9:
_red_des = TOSHIBA_LED_OFF;
_blue_des = TOSHIBA_LED_OFF;
_green_des = TOSHIBA_LED_OFF;
_red_des = TOSHIBA_PX4_LED_OFF;
_blue_des = TOSHIBA_PX4_LED_OFF;
_green_des = TOSHIBA_PX4_LED_OFF;
break;
}
}
@ -202,9 +202,9 @@ void ToshibaLED_PX4::_scheduled_update(uint32_t now)
case 2:
case 3:
case 4:
_red_des = TOSHIBA_LED_DIM;
_blue_des = TOSHIBA_LED_OFF;
_green_des = TOSHIBA_LED_DIM;
_red_des = TOSHIBA_PX4_LED_DIM;
_blue_des = TOSHIBA_PX4_LED_OFF;
_green_des = TOSHIBA_PX4_LED_DIM;
break;
case 5:
case 6:
@ -212,17 +212,17 @@ void ToshibaLED_PX4::_scheduled_update(uint32_t now)
case 8:
case 9:
// even display blue light
_red_des = TOSHIBA_LED_OFF;
_blue_des = TOSHIBA_LED_OFF;
_green_des = TOSHIBA_LED_OFF;
_red_des = TOSHIBA_PX4_LED_OFF;
_blue_des = TOSHIBA_PX4_LED_OFF;
_green_des = TOSHIBA_PX4_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;
_red_des = TOSHIBA_PX4_LED_OFF;
_blue_des = TOSHIBA_PX4_LED_DIM;
_green_des = TOSHIBA_PX4_LED_OFF;
}else{
// flashing blue if no gps lock
switch(step) {
@ -231,9 +231,9 @@ void ToshibaLED_PX4::_scheduled_update(uint32_t now)
case 2:
case 3:
case 4:
_red_des = TOSHIBA_LED_OFF;
_blue_des = TOSHIBA_LED_DIM;
_green_des = TOSHIBA_LED_OFF;
_red_des = TOSHIBA_PX4_LED_OFF;
_blue_des = TOSHIBA_PX4_LED_DIM;
_green_des = TOSHIBA_PX4_LED_OFF;
break;
case 5:
case 6:
@ -241,9 +241,9 @@ void ToshibaLED_PX4::_scheduled_update(uint32_t now)
case 8:
case 9:
// even display blue light
_red_des = TOSHIBA_LED_OFF;
_blue_des = TOSHIBA_LED_OFF;
_green_des = TOSHIBA_LED_OFF;
_red_des = TOSHIBA_PX4_LED_OFF;
_blue_des = TOSHIBA_PX4_LED_OFF;
_green_des = TOSHIBA_PX4_LED_OFF;
break;
}
}

6
libraries/AP_Notify/ToshibaLED_PX4.h
View File

@ -14,9 +14,13 @@
#define __TOSHIBA_LED_PX4_H__
#include <AP_HAL.h>
#include <AP_Notify.h>
#define TOSHIBA_PX4_LED_BRIGHT 0xFF // full brightness
#define TOSHIBA_PX4_LED_MEDIUM 0x80 // medium brightness
#define TOSHIBA_PX4_LED_DIM 0x11 // dim
#define TOSHIBA_PX4_LED_OFF 0x00 // off
class ToshibaLED_PX4 {
public: