dark0707
/
px4-firmware
forked from Archive/PX4-Autopilot
1
0
Fork 0
Code Pull Requests Activity

Let it breathe

This commit is contained in:
Lorenz Meier 2014-11-16 00:57:23 +01:00
parent c0f32d44a2
commit 63707ef058
1 changed files with 16 additions and 3 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

19
src/modules/px4iofirmware/px4io.c
View File

@ -85,6 +85,9 @@ static volatile uint8_t msg_next_out, msg_next_in;
#define NUM_MSG 2
static char msg[NUM_MSG][40];
static void heartbeat_blink(void);
static void ring_blink(void);
/*
* add a debug message to be printed on the console
*/
@ -124,9 +127,16 @@ heartbeat_blink(void)
{
static bool heartbeat = false;
LED_BLUE(heartbeat = !heartbeat);
}
static void
ring_blink(void)
{
#ifdef GPIO_LED4
const unsigned max_brightness = 1000;
// XXX this led code does have
// intentionally a few magic numbers.
const unsigned max_brightness = 118;
static unsigned counter = 0;
static unsigned brightness = max_brightness;
@ -135,7 +145,7 @@ heartbeat_blink(void)
if (brightness_counter < max_brightness) {
bool on = ((on_counter * 100) / brightness_counter) <= ((brightness * 100) / max_brightness);
bool on = ((on_counter * 100) / brightness_counter+1) <= ((brightness * 100) / max_brightness+1);
LED_RING(on);
brightness_counter++;
@ -159,9 +169,10 @@ heartbeat_blink(void)
n = 62 - counter;
}
brightness = n * n;// designed to be ~1000 / (31.0f * 31.0f);
brightness = (n * n) / 9;
brightness_counter = 0;
on_counter = 0;
counter++;
}
#endif
@ -338,6 +349,8 @@ user_start(int argc, char *argv[])
heartbeat_blink();
}
ring_blink();
check_reboot();
/* check for debug activity (default: none) */