mirror of
https://github.com/nasa/fprime.git
synced 2025-12-10 00:44:37 -06:00
91 lines
2.8 KiB
C++
91 lines
2.8 KiB
C++
#include <Fw/FPrimeBasicTypes.hpp>
|
|
#include <Fw/Types/Assert.hpp>
|
|
#include <Os/Console.hpp>
|
|
#include <Ref/RecvBuffApp/RecvBuffComponentImpl.hpp>
|
|
|
|
#include <cstdio>
|
|
|
|
#define DEBUG_LVL 1
|
|
|
|
namespace Ref {
|
|
|
|
RecvBuffImpl::RecvBuffImpl(const char* compName) : RecvBuffComponentBase(compName) {
|
|
this->m_firstBuffReceived = 0;
|
|
this->m_sensor1 = 1000.0;
|
|
this->m_sensor2 = 10.0;
|
|
this->m_stats.set_BuffRecv(0);
|
|
this->m_stats.set_BuffErr(0);
|
|
this->m_stats.set_PacketStatus(PacketRecvStatus::PACKET_STATE_NO_PACKETS);
|
|
}
|
|
|
|
RecvBuffImpl::~RecvBuffImpl() {}
|
|
|
|
void RecvBuffImpl::Data_handler(FwIndexType portNum, Drv::DataBuffer& buff) {
|
|
this->m_stats.set_BuffRecv(++this->m_buffsReceived);
|
|
// reset deserialization of buffer
|
|
buff.resetDeser();
|
|
// deserialize packet ID
|
|
U32 id = 0;
|
|
Fw::SerializeStatus stat = buff.deserializeTo(id);
|
|
FW_ASSERT(stat == Fw::FW_SERIALIZE_OK, static_cast<FwAssertArgType>(stat));
|
|
// deserialize data
|
|
U8 testData[24] = {0};
|
|
FwSizeType size = sizeof(testData);
|
|
stat = buff.deserializeTo(testData, size);
|
|
FW_ASSERT(stat == Fw::FW_SERIALIZE_OK, static_cast<FwAssertArgType>(stat));
|
|
// deserialize checksum
|
|
U32 csum = 0;
|
|
stat = buff.deserializeTo(csum);
|
|
FW_ASSERT(stat == Fw::FW_SERIALIZE_OK, static_cast<FwAssertArgType>(stat));
|
|
// if first packet, send event
|
|
if (not this->m_firstBuffReceived) {
|
|
this->log_ACTIVITY_LO_FirstPacketReceived(id);
|
|
this->m_stats.set_PacketStatus(PacketRecvStatus::PACKET_STATE_OK);
|
|
this->m_firstBuffReceived = true;
|
|
}
|
|
|
|
// compute checksum
|
|
U32 sum = 0;
|
|
for (U32 byte = 0; byte < size; byte++) {
|
|
sum += testData[byte];
|
|
}
|
|
// check checksum
|
|
if (sum != csum) {
|
|
// increment error count
|
|
this->m_stats.set_BuffErr(++this->m_errBuffs);
|
|
// send error event
|
|
this->log_WARNING_HI_PacketChecksumError(id);
|
|
// update stats
|
|
this->m_stats.set_PacketStatus(PacketRecvStatus::PACKET_STATE_ERRORS);
|
|
}
|
|
// update sensor values
|
|
this->m_sensor1 += 5.0;
|
|
this->m_sensor2 += 1.2;
|
|
// update channels
|
|
this->tlmWrite_Sensor1(this->m_sensor1);
|
|
this->tlmWrite_Sensor2(this->m_sensor2);
|
|
this->tlmWrite_PktState(this->m_stats);
|
|
}
|
|
|
|
void RecvBuffImpl::parameterUpdated(FwPrmIdType id) {
|
|
this->log_ACTIVITY_LO_BuffRecvParameterUpdated(id);
|
|
Fw::ParamValid valid;
|
|
switch (id) {
|
|
case PARAMID_PARAMETER1: {
|
|
U32 val = this->paramGet_parameter1(valid);
|
|
this->tlmWrite_Parameter1(val);
|
|
break;
|
|
}
|
|
case PARAMID_PARAMETER2: {
|
|
I16 val = this->paramGet_parameter2(valid);
|
|
this->tlmWrite_Parameter2(val);
|
|
break;
|
|
}
|
|
default:
|
|
FW_ASSERT(0, id);
|
|
break;
|
|
}
|
|
}
|
|
|
|
} // namespace Ref
|