45 lines
1.9 KiB
C++
45 lines
1.9 KiB
C++
#include "WeightBalance_heartbeat.hpp"
|
|
const std::string XNSim::C909::ATA04::WeightBalance_heartbeat_Interface::topic_name = "XNSim::C909::ATA04::WeightBalance_heartbeat";
|
|
namespace XNSim::C909::ATA04
|
|
{
|
|
WeightBalance_heartbeat_Interface::WeightBalance_heartbeat_Interface()
|
|
{
|
|
MAP_DATA_FUNC(weightbody_model_heartbeat);
|
|
}
|
|
WeightBalance_heartbeat_Interface::~WeightBalance_heartbeat_Interface()
|
|
{
|
|
}
|
|
void WeightBalance_heartbeat_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::WeightBalance_heartbeatPubSubType>("XNSim::C909::ATA04::WeightBalance_heartbeat", modelId);
|
|
ddsManager->RegisterSubscriber<XNSim::C909::ATA04::WeightBalance_heartbeatPubSubType>("XNSim::C909::ATA04::WeightBalance_heartbeat", modelId, std::bind(&WeightBalance_heartbeat_Interface::inputDataListener, this, std::placeholders::_1));
|
|
}
|
|
else if (DDS_type == 1) {
|
|
ddsManager->RegisterSubscriber<XNSim::C909::ATA04::WeightBalance_heartbeatPubSubType>("XNSim::C909::ATA04::WeightBalance_heartbeat", modelId, std::bind(&WeightBalance_heartbeat_Interface::inputDataListener, this, std::placeholders::_1));
|
|
}
|
|
else if (DDS_type == 2) {
|
|
dataWriter = ddsManager->RegisterPublisher<XNSim::C909::ATA04::WeightBalance_heartbeatPubSubType>("XNSim::C909::ATA04::WeightBalance_heartbeat", modelId);
|
|
}
|
|
}
|
|
void WeightBalance_heartbeat_Interface::clearOutData()
|
|
{
|
|
this->out_data = XNSim::C909::ATA04::WeightBalance_heartbeat();
|
|
}
|
|
void WeightBalance_heartbeat_Interface::sendOutData()
|
|
{
|
|
if (dataWriter) {
|
|
dataWriter->write(&this->out_data);
|
|
}
|
|
}
|
|
void WeightBalance_heartbeat_Interface::inputDataListener(const XNSim::C909::ATA04::WeightBalance_heartbeat &input)
|
|
{
|
|
this->data = input;
|
|
}
|
|
}
|