mirror of
https://github.com/nasa/fprime.git
synced 2025-12-10 17:47:10 -06:00
3cccd731d9
Instead of adding the name argument to a constructor when FW_OBJECT_NAMES is enabled, always supply a name argument. Add a marco that conditionally sets the name to "" if FW_OBJECT_NAMES is not set. This cleans up a lot of the conditional compilation switches that weren't being tested and would silently break, while still stripping the strings from the binary.
114 lines
3.8 KiB
C++
114 lines
3.8 KiB
C++
/*
|
|
* \author: Tim Canham
|
|
* \file:
|
|
* \brief
|
|
*
|
|
* This file implements the ActiveRateGroup component,
|
|
* which invokes a set of components the comprise the rate group.
|
|
*
|
|
* Copyright 2014-2015, by the California Institute of Technology.
|
|
* ALL RIGHTS RESERVED. United States Government Sponsorship
|
|
* acknowledged.
|
|
*
|
|
*/
|
|
|
|
#include <Svc/ActiveRateGroup/ActiveRateGroupImpl.hpp>
|
|
#include <ActiveRateGroupImplCfg.hpp>
|
|
#include <Fw/Types/BasicTypes.hpp>
|
|
#include <Fw/Types/Assert.hpp>
|
|
#include <Os/Log.hpp>
|
|
|
|
namespace Svc {
|
|
|
|
ActiveRateGroupImpl::ActiveRateGroupImpl(const char* compName, NATIVE_UINT_TYPE contexts[], NATIVE_UINT_TYPE numContexts) :
|
|
ActiveRateGroupComponentBase(compName),
|
|
m_cycles(0),
|
|
m_maxTime(0),
|
|
m_cycleStarted(false),
|
|
m_overrunThrottle(0),
|
|
m_cycleSlips(0) {
|
|
FW_ASSERT(contexts);
|
|
FW_ASSERT(numContexts == static_cast<NATIVE_UINT_TYPE>(this->getNum_RateGroupMemberOut_OutputPorts()),numContexts,this->getNum_RateGroupMemberOut_OutputPorts());
|
|
FW_ASSERT(FW_NUM_ARRAY_ELEMENTS(this->m_contexts) == this->getNum_RateGroupMemberOut_OutputPorts(),
|
|
static_cast<NATIVE_INT_TYPE>(FW_NUM_ARRAY_ELEMENTS(this->m_contexts)),
|
|
this->getNum_RateGroupMemberOut_OutputPorts());
|
|
|
|
// copy context values
|
|
for (NATIVE_INT_TYPE entry = 0; entry < this->getNum_RateGroupMemberOut_OutputPorts(); entry++) {
|
|
this->m_contexts[entry] = contexts[entry];
|
|
}
|
|
}
|
|
|
|
void ActiveRateGroupImpl::init(NATIVE_INT_TYPE queueDepth, NATIVE_INT_TYPE instance) {
|
|
ActiveRateGroupComponentBase::init(queueDepth,instance);
|
|
}
|
|
|
|
ActiveRateGroupImpl::~ActiveRateGroupImpl(void) {
|
|
|
|
}
|
|
|
|
void ActiveRateGroupImpl::preamble(void) {
|
|
this->log_DIAGNOSTIC_RateGroupStarted();
|
|
}
|
|
|
|
void ActiveRateGroupImpl::CycleIn_handler(NATIVE_INT_TYPE portNum, Svc::TimerVal& cycleStart) {
|
|
|
|
TimerVal end;
|
|
|
|
this->m_cycleStarted = false;
|
|
|
|
// invoke any members of the rate group
|
|
for (NATIVE_INT_TYPE port = 0; port < this->getNum_RateGroupMemberOut_OutputPorts(); port++) {
|
|
if (this->isConnected_RateGroupMemberOut_OutputPort(port)) {
|
|
this->RateGroupMemberOut_out(port,this->m_contexts[port]);
|
|
}
|
|
}
|
|
|
|
// grab timer for end of cycle
|
|
end.take();
|
|
|
|
// get rate group execution time
|
|
U32 cycle_time = end.diffUSec(cycleStart);
|
|
|
|
// check to see if the time has exceeded the previous maximum
|
|
if (cycle_time > this->m_maxTime) {
|
|
this->m_maxTime = cycle_time;
|
|
}
|
|
|
|
// update cycle telemetry
|
|
this->tlmWrite_RgMaxTime(this->m_maxTime);
|
|
|
|
// check for cycle slip. That will happen if new cycle message has been received
|
|
// which will cause flag will be set again.
|
|
if (this->m_cycleStarted) {
|
|
this->m_cycleSlips++;
|
|
if (this->m_overrunThrottle < ACTIVE_RATE_GROUP_OVERRUN_THROTTLE) {
|
|
this->log_WARNING_HI_RateGroupCycleSlip(this->m_cycles);
|
|
this->m_overrunThrottle++;
|
|
}
|
|
// update cycle cycle slips
|
|
this->tlmWrite_RgCycleSlips(this->m_cycleSlips);
|
|
} else { // if cycle is okay start decrementing throttle value
|
|
if (this->m_overrunThrottle > 0) {
|
|
this->m_overrunThrottle--;
|
|
}
|
|
}
|
|
|
|
// increment cycle
|
|
this->m_cycles++;
|
|
|
|
}
|
|
|
|
void ActiveRateGroupImpl::CycleIn_preMsgHook(NATIVE_INT_TYPE portNum, Svc::TimerVal& cycleStart) {
|
|
// set flag to indicate cycle has started. Check in thread for overflow.
|
|
this->m_cycleStarted = true;
|
|
}
|
|
|
|
void ActiveRateGroupImpl::PingIn_handler(NATIVE_INT_TYPE portNum, U32 key) {
|
|
// return the key to health
|
|
this->PingOut_out(0,key);
|
|
}
|
|
|
|
|
|
}
|