ardupilot/libraries/SITL/SIM_BattMonitor_SMBus_Rotoye.cpp

#include "SIM_config.h"

#if AP_SIM_BATT_MONITOR_SMBUS_ROTOYE_ENABLED

#include "SIM_BattMonitor_SMBus_Rotoye.h"

#include <AP_HAL/utility/sparse-endian.h>

SITL::Rotoye::Rotoye() :
    SIM_BattMonitor_SMBus_Generic()
{
    add_register("External Temperature", SMBusBattRotoyeDevReg::TEMP_EXT, SITL::I2CRegisters::RegMode::RDONLY);

    set_register(SMBusBattRotoyeDevReg::SERIAL, (uint16_t)39);

    const char *manufacturer_name = "Rotoye";
    set_block(SMBusBattDevReg::MANUFACTURE_NAME, manufacturer_name);

    const char *device_name = "SITL_BatMon v4.03";
    set_block(SMBusBattDevReg::DEVICE_NAME, device_name);

    set_register(SMBusBattGenericDevReg::SERIAL, (uint16_t) 278);
}

void SITL::Rotoye::update(const class Aircraft &aircraft)
{
    SIM_BattMonitor_SMBus_Generic::update(aircraft);

    const uint32_t now = AP_HAL::millis();
    if (now - last_temperature_update_ms > 1000) {
        last_temperature_update_ms = now;
        int16_t outside_temp = get_reg_value(SMBusBattRotoyeDevReg::TEMP);
        set_register(SMBusBattRotoyeDevReg::TEMP_EXT, int16_t(outside_temp + 100));  // it's a little warmer inside.... (10 degrees here)
    }
}

#endif  // AP_SIM_BATT_MONITOR_SMBUS_ROTOYE_ENABLED