2012-08-23 19:18:32 -03:00
|
|
|
|
|
|
|
#include <AP_Common.h>
|
2012-12-11 15:24:27 -04:00
|
|
|
#include <AP_Math.h>
|
|
|
|
#include <AP_Param.h>
|
2012-10-27 00:55:17 -03:00
|
|
|
#include <AP_Progmem.h>
|
2012-12-11 15:24:27 -04:00
|
|
|
|
2012-08-23 19:18:32 -03:00
|
|
|
#include <AP_HAL.h>
|
|
|
|
#include <AP_HAL_AVR.h>
|
|
|
|
|
2012-12-11 15:24:27 -04:00
|
|
|
#if CONFIG_HAL_BOARD == HAL_BOARD_APM1
|
2012-08-23 19:18:32 -03:00
|
|
|
const AP_HAL::HAL& hal = AP_HAL_AVR_APM1;
|
2012-12-11 15:24:27 -04:00
|
|
|
#elif CONFIG_HAL_BOARD == HAL_BOARD_APM2
|
|
|
|
const AP_HAL::HAL& hal = AP_HAL_AVR_APM2;
|
|
|
|
#endif
|
2012-08-23 19:18:32 -03:00
|
|
|
|
2012-11-28 18:52:13 -04:00
|
|
|
AP_HAL::DigitalSource *a_led;
|
|
|
|
AP_HAL::DigitalSource *b_led;
|
|
|
|
AP_HAL::DigitalSource *c_led;
|
|
|
|
|
2012-08-23 19:18:32 -03:00
|
|
|
void loop (void) {
|
|
|
|
hal.scheduler->delay(1000);
|
|
|
|
hal.gpio->write(13, 1);
|
2012-11-28 18:52:13 -04:00
|
|
|
|
|
|
|
a_led->write(1);
|
|
|
|
b_led->write(0);
|
|
|
|
c_led->write(1);
|
|
|
|
|
2012-08-23 19:18:32 -03:00
|
|
|
hal.scheduler->delay(1000);
|
|
|
|
hal.gpio->write(13, 0);
|
2012-11-28 18:52:13 -04:00
|
|
|
|
|
|
|
a_led->write(0);
|
|
|
|
b_led->write(1);
|
|
|
|
c_led->write(0);
|
2012-08-23 19:18:32 -03:00
|
|
|
}
|
|
|
|
|
|
|
|
void setup (void) {
|
|
|
|
hal.gpio->pinMode(13, GPIO_OUTPUT);
|
|
|
|
hal.gpio->write(13, 0);
|
2012-11-28 18:52:13 -04:00
|
|
|
|
|
|
|
a_led = hal.gpio->channel(27);
|
|
|
|
b_led = hal.gpio->channel(26);
|
|
|
|
c_led = hal.gpio->channel(25);
|
|
|
|
|
|
|
|
a_led->mode(GPIO_OUTPUT);
|
|
|
|
b_led->mode(GPIO_OUTPUT);
|
|
|
|
c_led->mode(GPIO_OUTPUT);
|
|
|
|
|
|
|
|
a_led->write(0);
|
|
|
|
b_led->write(0);
|
|
|
|
c_led->write(0);
|
2012-08-23 19:18:32 -03:00
|
|
|
}
|
|
|
|
|
2012-12-03 20:25:11 -04:00
|
|
|
AP_HAL_MAIN();
|