2020-08-03 00:24:27 -03:00
|
|
|
#include "SIM_ToshibaLED.h"
|
|
|
|
|
2021-10-11 02:06:06 -03:00
|
|
|
#if AP_SIM_TOSHIBALED_ENABLED
|
|
|
|
|
2020-08-03 00:24:27 -03:00
|
|
|
#include <stdio.h>
|
|
|
|
|
2020-11-12 00:19:13 -04:00
|
|
|
void SITL::ToshibaLED::update(const class Aircraft &aircraft)
|
2020-08-03 00:24:27 -03:00
|
|
|
{
|
2020-11-12 00:19:13 -04:00
|
|
|
if (last_print_pwm0 == get_register(ToshibaLEDDevReg::PWM0) &&
|
|
|
|
last_print_pwm1 == get_register(ToshibaLEDDevReg::PWM1) &&
|
|
|
|
last_print_pwm2 == get_register(ToshibaLEDDevReg::PWM2) &&
|
|
|
|
last_print_enable == get_register(ToshibaLEDDevReg::ENABLE)) {
|
|
|
|
return;
|
2020-08-03 00:24:27 -03:00
|
|
|
}
|
2020-11-12 00:19:13 -04:00
|
|
|
|
|
|
|
last_print_pwm0 = get_register(ToshibaLEDDevReg::PWM0);
|
|
|
|
last_print_pwm1 = get_register(ToshibaLEDDevReg::PWM1);
|
|
|
|
last_print_pwm2 = get_register(ToshibaLEDDevReg::PWM2);
|
|
|
|
last_print_enable = get_register(ToshibaLEDDevReg::ENABLE);
|
|
|
|
// gcs().send_text(MAV_SEVERITY_INFO, "SIM_ToshibaLED: PWM0=%u PWM1=%u PWM2=%u ENABLE=%u", last_print_pwm0, last_print_pwm1, last_print_pwm2, last_print_enable);
|
2020-08-03 00:24:27 -03:00
|
|
|
}
|
2021-10-11 02:06:06 -03:00
|
|
|
|
|
|
|
#endif
|