mirror of
https://github.com/nasa/fprime.git
synced 2025-12-10 17:47:10 -06:00
2dcd21902d
* Testing with configured fixed-size types * Linux fixes * Final settings * Removing FwNativeIntType
72 lines
2.5 KiB
C++
72 lines
2.5 KiB
C++
/*
|
|
* \author: Tim Canham
|
|
* \file:
|
|
* \brief
|
|
*
|
|
* This file implements the PassiveRateGroup 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 <FpConfig.hpp>
|
|
#include <Fw/Types/Assert.hpp>
|
|
#include <Os/Console.hpp>
|
|
#include <Svc/PassiveRateGroup/PassiveRateGroup.hpp>
|
|
|
|
namespace Svc {
|
|
PassiveRateGroup::PassiveRateGroup(const char* compName)
|
|
: PassiveRateGroupComponentBase(compName), m_cycles(0), m_maxTime(0), m_numContexts(0) {
|
|
}
|
|
|
|
PassiveRateGroup::~PassiveRateGroup() {}
|
|
|
|
void PassiveRateGroup::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] = static_cast<U32>(contexts[entry]);
|
|
}
|
|
}
|
|
|
|
|
|
void PassiveRateGroup::CycleIn_handler(FwIndexType portNum, Os::RawTime& cycleStart) {
|
|
Os::RawTime endTime;
|
|
FW_ASSERT(this->m_numContexts);
|
|
|
|
// invoke any members of the rate group
|
|
for (FwIndexType 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 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;
|
|
}
|
|
this->tlmWrite_MaxCycleTime(this->m_maxTime);
|
|
this->tlmWrite_CycleTime(cycleTime);
|
|
this->tlmWrite_CycleCount(++this->m_cycles);
|
|
}
|
|
|
|
} // namespace Svc
|