mirror of https://github.com/ArduPilot/ardupilot
33 lines
563 B
C++
33 lines
563 B
C++
|
#include "SIM_config.h"
|
||
|
|
|
||
|
|
#if AP_SIM_GPIO_LED_2_ENABLED
|
||
|
|
|
||
|
|
#include "SIM_GPIO_LED_2.h"
|
||
|
|
|
||
|
|
#include <SITL/SITL.h>
|
||
|
|
|
||
|
|
using namespace SITL;
|
||
|
|
|
||
|
|
void GPIO_LED_2::init()
|
||
|
|
{
|
||
|
|
leds.init();
|
||
|
|
}
|
||
|
|
|
||
|
|
void GPIO_LED_2::update(const class Aircraft &aircraft)
|
||
|
|
{
|
||
|
|
if (!init_done) {
|
||
|
|
init();
|
||
|
|
init_done = true;
|
||
|
|
}
|
||
|
|
|
||
|
|
const uint16_t pin_mask = AP::sitl()->pin_mask.get();
|
||
|
|
const bool new_led_states[2] {
|
||
|
|
((pin_mask & uint16_t((1U<<LED_A_PIN))) != 0),
|
||
|
|
((pin_mask & uint16_t((1U<<LED_B_PIN))) != 0)
|
||
|
|
};
|
||
|
|
|
||
|
|
leds.set_state(new_led_states);
|
||
|
|
}
|
||
|
|
|
||
|
|
#endif
|