mirror of
https://github.com/nasa/fprime.git
synced 2025-12-10 00:44:37 -06:00
2dcd21902d
* Testing with configured fixed-size types * Linux fixes * Final settings * Removing FwNativeIntType
123 lines
4.0 KiB
C++
123 lines
4.0 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/ActiveRateGroup.hpp>
|
|
#include <ActiveRateGroupCfg.hpp>
|
|
#include <FpConfig.hpp>
|
|
#include <Fw/Types/Assert.hpp>
|
|
#include <Os/Console.hpp>
|
|
|
|
namespace Svc {
|
|
|
|
ActiveRateGroup::ActiveRateGroup(const char* compName) :
|
|
ActiveRateGroupComponentBase(compName),
|
|
m_cycles(0),
|
|
m_maxTime(0),
|
|
m_cycleStarted(false),
|
|
m_numContexts(0),
|
|
m_overrunThrottle(0),
|
|
m_cycleSlips(0) {
|
|
}
|
|
|
|
void ActiveRateGroup::configure(U32 contexts[], FwIndexType numContexts) {
|
|
FW_ASSERT(contexts);
|
|
FW_ASSERT(numContexts == this->getNum_RateGroupMemberOut_OutputPorts(),
|
|
static_cast<FwAssertArgType>(numContexts),
|
|
static_cast<FwAssertArgType>(this->getNum_RateGroupMemberOut_OutputPorts()));
|
|
FW_ASSERT(FW_NUM_ARRAY_ELEMENTS(this->m_contexts) == this->getNum_RateGroupMemberOut_OutputPorts(),
|
|
static_cast<FwAssertArgType>(FW_NUM_ARRAY_ELEMENTS(this->m_contexts)),
|
|
static_cast<FwAssertArgType>(this->getNum_RateGroupMemberOut_OutputPorts()));
|
|
|
|
this->m_numContexts = numContexts;
|
|
// copy context values
|
|
for (FwIndexType entry = 0; entry < this->m_numContexts; entry++) {
|
|
this->m_contexts[entry] = contexts[entry];
|
|
}
|
|
}
|
|
|
|
ActiveRateGroup::~ActiveRateGroup() {
|
|
|
|
}
|
|
|
|
void ActiveRateGroup::preamble() {
|
|
this->log_DIAGNOSTIC_RateGroupStarted();
|
|
}
|
|
|
|
void ActiveRateGroup::CycleIn_handler(FwIndexType portNum, Os::RawTime& cycleStart) {
|
|
|
|
// Make sure it's been configured
|
|
FW_ASSERT(this->m_numContexts);
|
|
|
|
Os::RawTime endTime;
|
|
|
|
this->m_cycleStarted = false;
|
|
|
|
// invoke any members of the rate group
|
|
for (FwIndexType port = 0; port < this->m_numContexts; port++) {
|
|
if (this->isConnected_RateGroupMemberOut_OutputPort(port)) {
|
|
this->RateGroupMemberOut_out(port, static_cast<U32>(this->m_contexts[port]));
|
|
}
|
|
}
|
|
|
|
// grab timer for endTime of cycle
|
|
endTime.now();
|
|
|
|
// get rate group execution time
|
|
U32 cycleTime;
|
|
// Cast to void as the only possible error is overflow, which we can't handle other
|
|
// than capping cycleTime to max value of U32 (which is done in getDiffUsec anyways)
|
|
(void) endTime.getDiffUsec(cycleStart, cycleTime);
|
|
|
|
// check to see if the time has exceeded the previous maximum
|
|
if (cycleTime > this->m_maxTime) {
|
|
this->m_maxTime = cycleTime;
|
|
}
|
|
|
|
// 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 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 ActiveRateGroup::CycleIn_preMsgHook(FwIndexType portNum, Os::RawTime& cycleStart) {
|
|
// set flag to indicate cycle has started. Check in thread for overflow.
|
|
this->m_cycleStarted = true;
|
|
}
|
|
|
|
void ActiveRateGroup::PingIn_handler(FwIndexType portNum, U32 key) {
|
|
// return the key to health
|
|
this->PingOut_out(0,key);
|
|
}
|
|
|
|
|
|
}
|