mirror of https://github.com/ArduPilot/ardupilot
53 lines
1.3 KiB
C++
53 lines
1.3 KiB
C++
#include "SIM_I2CDevice.h"
|
|
|
|
#include <AP_HAL/AP_HAL_Boards.h>
|
|
|
|
#ifndef AP_SIM_TOSHIBALED_ENABLED
|
|
#define AP_SIM_TOSHIBALED_ENABLED (CONFIG_HAL_BOARD == HAL_BOARD_SITL)
|
|
#endif
|
|
|
|
#if AP_SIM_TOSHIBALED_ENABLED
|
|
|
|
#include "SIM_RGBLED.h"
|
|
|
|
namespace SITL {
|
|
|
|
class ToshibaLEDDevReg : public I2CRegEnum {
|
|
public:
|
|
static constexpr uint8_t PWM0 = 0x01;
|
|
static constexpr uint8_t PWM1 = 0x02;
|
|
static constexpr uint8_t PWM2 = 0x03;
|
|
static constexpr uint8_t ENABLE = 0x04;
|
|
};
|
|
|
|
class ToshibaLED : public I2CDevice, protected I2CRegisters_8Bit
|
|
{
|
|
public:
|
|
void init() override {
|
|
rgbled.init();
|
|
|
|
add_register("PWM0", ToshibaLEDDevReg::PWM0, I2CRegisters::RegMode::WRONLY);
|
|
add_register("PWM1", ToshibaLEDDevReg::PWM1, I2CRegisters::RegMode::WRONLY);
|
|
add_register("PWM2", ToshibaLEDDevReg::PWM2, I2CRegisters::RegMode::WRONLY);
|
|
add_register("ENABLE", ToshibaLEDDevReg::ENABLE, I2CRegisters::RegMode::WRONLY);
|
|
}
|
|
|
|
void update(const class Aircraft &aircraft) override;
|
|
|
|
int rdwr(I2C::i2c_rdwr_ioctl_data *&data) override {
|
|
return I2CRegisters_8Bit::rdwr(data);
|
|
}
|
|
|
|
private:
|
|
uint8_t last_print_pwm0;
|
|
uint8_t last_print_pwm1;
|
|
uint8_t last_print_pwm2;
|
|
uint8_t last_print_enable;
|
|
|
|
SIM_RGBLED rgbled{"ToshibaLED"};
|
|
};
|
|
|
|
} // namespace SITL
|
|
|
|
#endif // AP_SIM_TOSHIBALED_ENABLED
|