Quaternion: show "Quaternion test" on startup if enabled

This commit is contained in:
Andrew Tridgell 2012-03-03 22:38:34 +11:00
parent 934a05bbc6
commit 04826065ef
2 changed files with 7 additions and 0 deletions

View File

@ -1162,6 +1162,9 @@ static void report_gps()
static void report_version()
{
Serial.printf_P(PSTR("FW Ver: %d\n"),(int)g.format_version.get());
#if QUATERNION_ENABLE == ENABLED
Serial.printf_P(PSTR("Quaternion test\n"));
#endif
print_divider();
print_blanks(2);
}

View File

@ -103,6 +103,10 @@ static void init_ardupilot()
"\n\nFree RAM: %u\n"),
memcheck_available_memory());
#if QUATERNION_ENABLE == ENABLED
Serial.printf_P(PSTR("Quaternion test\n"));
#endif
//
// Initialize Wire and SPI libraries
//