AP_Common: add example sketch
This commit is contained in:
parent
2f7dee3ba5
commit
9b81e46e61
54
libraries/AP_Common/examples/AP_Common/AP_Common.pde
Normal file
54
libraries/AP_Common/examples/AP_Common/AP_Common.pde
Normal file
@ -0,0 +1,54 @@
|
||||
/// -*- tab-width: 4; Mode: C++; c-basic-offset: 4; indent-tabs-mode: nil -*-
|
||||
//
|
||||
// Unit tests for the AP_Common code
|
||||
//
|
||||
|
||||
#include <AP_HAL.h>
|
||||
#include <stdlib.h>
|
||||
#include <AP_Common.h>
|
||||
#include <AP_Progmem.h>
|
||||
#include <AP_Param.h>
|
||||
#include <AP_HAL_AVR.h>
|
||||
#include <AP_HAL_AVR_SITL.h>
|
||||
#include <AP_HAL_Empty.h>
|
||||
#include <AP_HAL_PX4.h>
|
||||
#include <AP_Math.h>
|
||||
|
||||
const AP_HAL::HAL& hal = AP_HAL_BOARD_DRIVER;
|
||||
|
||||
void test_high_low_byte(void)
|
||||
{
|
||||
uint16_t i;
|
||||
uint8_t high, low;
|
||||
|
||||
// test each value from 0 to 300
|
||||
for (i=0; i<=300; i++) {
|
||||
high = HIGHBYTE(i);
|
||||
low = LOWBYTE(i);
|
||||
hal.console->printf_P(PSTR("\ni:%u high:%u low:%u"),(unsigned int)i, (unsigned int)high, (unsigned int)low);
|
||||
}
|
||||
|
||||
// test values from 300 to 65400 at increments of 200
|
||||
for (i=301; i<=65400; i+=200) {
|
||||
high = HIGHBYTE(i);
|
||||
low = LOWBYTE(i);
|
||||
hal.console->printf_P(PSTR("\ni:%u high:%u low:%u"),(unsigned int)i, (unsigned int)high, (unsigned int)low);
|
||||
}
|
||||
}
|
||||
|
||||
/*
|
||||
* euler angle tests
|
||||
*/
|
||||
void setup(void)
|
||||
{
|
||||
hal.console->println("AP_Common tests\n");
|
||||
|
||||
test_high_low_byte();
|
||||
}
|
||||
|
||||
void loop(void)
|
||||
{
|
||||
// do nothing
|
||||
}
|
||||
|
||||
AP_HAL_MAIN();
|
Loading…
Reference in New Issue
Block a user