78 lines
3.1 KiB
C++
78 lines
3.1 KiB
C++
|
#include "Aerodynamics_input.hpp"
|
|||
|
|
namespace XNSim::C909::ATA04
|
|||
|
|
{
|
|||
|
|
Aerodynamics_input_Interface::Aerodynamics_input_Interface()
|
|||
|
|
{
|
|||
|
|
MAP_DATA_FUNC(l_04_i_aerocomac_alpha_f8);
|
|||
|
|
MAP_DATA_FUNC(l_04_i_aerocomac_alpdot_f8);
|
|||
|
|
MAP_DATA_FUNC(l_04_i_aerocomac_beta_f8);
|
|||
|
|
MAP_DATA_FUNC(l_04_i_aerocomac_press_alt_f8);
|
|||
|
|
MAP_DATA_FUNC(l_04_i_aerocomac_tas_f8);
|
|||
|
|
MAP_DATA_FUNC(l_04_i_aerocomac_mach_f8);
|
|||
|
|
MAP_DATA_FUNC(l_04_i_aerocomac_nx_f8);
|
|||
|
|
MAP_DATA_FUNC(l_04_i_aerocomac_ny_f8);
|
|||
|
|
MAP_DATA_FUNC(l_04_i_aerocomac_nz_f8);
|
|||
|
|
MAP_DATA_FUNC(l_04_i_aerocomac_p_f8);
|
|||
|
|
MAP_DATA_FUNC(l_04_i_aerocomac_q_f8);
|
|||
|
|
MAP_DATA_FUNC(l_04_i_aerocomac_r_f8);
|
|||
|
|
MAP_DATA_FUNC(l_04_i_aerocomac_qbar_f8);
|
|||
|
|
MAP_DATA_FUNC(l_04_i_aerocomac_blcg_f8);
|
|||
|
|
MAP_DATA_FUNC(l_04_i_aerocomac_bscg_f8);
|
|||
|
|
MAP_DATA_FUNC(l_04_i_aerocomac_wlcg_f8);
|
|||
|
|
MAP_DATA_FUNC(l_04_i_aerocomac_ail_f8);
|
|||
|
|
MAP_DATA_FUNC(l_04_i_aerocomac_elv_f8);
|
|||
|
|
MAP_DATA_FUNC(l_04_i_aerocomac_rud_f8);
|
|||
|
|
MAP_DATA_FUNC(l_04_i_aerocomac_stab_f8);
|
|||
|
|
MAP_DATA_FUNC(l_04_i_aerocomac_gear_f8);
|
|||
|
|
MAP_DATA_FUNC(l_04_i_aerocomac_flap_f8);
|
|||
|
|
MAP_DATA_FUNC(l_04_i_aerocomac_slat_f8);
|
|||
|
|
MAP_DATA_FUNC(l_04_i_aerocomac_spl_f8);
|
|||
|
|
MAP_DATA_FUNC(l_04_i_aerocomac_tnet_f8);
|
|||
|
|
MAP_DATA_FUNC(l_04_i_aerocomac_kice_f8);
|
|||
|
|
MAP_DATA_FUNC(l_04_i_aerocomac_alt_agl_f8);
|
|||
|
|
this->header[0] = 0xa6; // XNSim头，0xa6
|
|||
|
|
this->header[1] = 0xc0; // 机型头，0xc0表示C909
|
|||
|
|
this->header[2] = 0x04; // 章节头，0x04表示ATA04
|
|||
|
|
this->header[3] = 0x01; // 模型头，0x01表示GroundHandling
|
|||
|
|
this->header[4] = 0x00; // 结构体头，0x00表示输入结构体
|
|||
|
|
this->header[5] = 0x00; // 数据方向，0x00表示外部输入
|
|||
|
|
this->header[6] = 0x00; // 数据大小
|
|||
|
|
this->header[7] = 0x00; // 数据大小
|
|||
|
|
}
|
|||
|
|
Aerodynamics_input_Interface::~Aerodynamics_input_Interface()
|
|||
|
|
{
|
|||
|
|
}
|
|||
|
|
void Aerodynamics_input_Interface::Initialize(XNFrameworkPtr framework, uint32_t modelId,uint32_t DDS_type)
|
|||
|
|
{
|
|||
|
|
auto ddsManager = framework->GetDDSManager();
|
|||
|
|
if (!ddsManager) {
|
|||
|
|
LOG_ERROR("DDSManager is nullptr");
|
|||
|
|
return;
|
|||
|
|
}
|
|||
|
|
if (DDS_type == 0) {
|
|||
|
|
dataWriter = ddsManager->RegisterPublisher<XNSim::C909::ATA04::Aerodynamics_inputPubSubType>("XNSim::C909::ATA04::Aerodynamics_input", modelId);
|
|||
|
|
ddsManager->RegisterSubscriber<XNSim::C909::ATA04::Aerodynamics_inputPubSubType>("XNSim::C909::ATA04::Aerodynamics_input", modelId, std::bind(&Aerodynamics_input_Interface::inputDataListener, this, std::placeholders::_1));
|
|||
|
|
}
|
|||
|
|
else if (DDS_type == 1) {
|
|||
|
|
ddsManager->RegisterSubscriber<XNSim::C909::ATA04::Aerodynamics_inputPubSubType>("XNSim::C909::ATA04::Aerodynamics_input", modelId, std::bind(&Aerodynamics_input_Interface::inputDataListener, this, std::placeholders::_1));
|
|||
|
|
}
|
|||
|
|
else if (DDS_type == 2) {
|
|||
|
|
dataWriter = ddsManager->RegisterPublisher<XNSim::C909::ATA04::Aerodynamics_inputPubSubType>("XNSim::C909::ATA04::Aerodynamics_input", modelId);
|
|||
|
|
}
|
|||
|
|
}
|
|||
|
|
void Aerodynamics_input_Interface::clearOutData()
|
|||
|
|
{
|
|||
|
|
this->out_data = XNSim::C909::ATA04::Aerodynamics_input();
|
|||
|
|
}
|
|||
|
|
void Aerodynamics_input_Interface::sendOutData()
|
|||
|
|
{
|
|||
|
|
if (dataWriter) {
|
|||
|
|
dataWriter->write(&this->out_data);
|
|||
|
|
}
|
|||
|
|
}
|
|||
|
|
void Aerodynamics_input_Interface::inputDataListener(const XNSim::C909::ATA04::Aerodynamics_input &input)
|
|||
|
|
{
|
|||
|
|
this->data = input;
|
|||
|
|
}
|
|||
|
|
}
|