fly316/PX4-Autopilot
7
0
Fork 0
mirror of https://gitee.com/mirrors_PX4/PX4-Autopilot.git synced 2026-10-31 06:41:36 +08:00
Code Issues Packages Projects Releases Wiki Activity

Let it breathe

Browse Source
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
Download Patch File Download Diff File Expand all files Collapse all files
src/modules/px4iofirmware/px4io.c
+16 -3
View File
@@ -85,6 +85,9 @@ static volatile uint8_t msg_next_out, msg_next_in;
#define NUM_MSG 2 #define NUM_MSG 2
static char msg[NUM_MSG][40]; 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 * add a debug message to be printed on the console
*/ */
@@ -124,9 +127,16 @@ heartbeat_blink(void)
{ {
static bool heartbeat = false; static bool heartbeat = false;
LED_BLUE(heartbeat = !heartbeat); LED_BLUE(heartbeat = !heartbeat);
}
static void
ring_blink(void)
{
#ifdef GPIO_LED4 #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 counter = 0;
static unsigned brightness = max_brightness; static unsigned brightness = max_brightness;
@@ -135,7 +145,7 @@ heartbeat_blink(void)
if (brightness_counter < max_brightness) { 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); LED_RING(on);
brightness_counter++; brightness_counter++;
@@ -159,9 +169,10 @@ heartbeat_blink(void)
n = 62 - counter; n = 62 - counter;
} }
brightness = n * n;// designed to be ~1000 / (31.0f * 31.0f); brightness = (n * n) / 9;
brightness_counter = 0; brightness_counter = 0;
on_counter = 0; on_counter = 0;
counter++;
} }
#endif #endif
@@ -338,6 +349,8 @@ user_start(int argc, char *argv[])
heartbeat_blink(); heartbeat_blink();
} }
ring_blink();
check_reboot(); check_reboot();
/* check for debug activity (default: none) */ /* check for debug activity (default: none) */