mirror of
https://github.com/nasa/fprime.git
synced 2025-12-11 23:38:06 -06:00
b76d8c9a0c
* lestarch: adding logical types implementation into Linux/StandardTypes.hpp * lestarch: removing VxWorks StandardTypes from repository * updated fprime types for correct compilation with vxworks and baremetal * lestarch: refactoring types and configuration header w.r.t type design * lestarch: replacing usages of AssertArg with FwAssertArgType * lestarch: missspelled configuration * lestarch: minor compilation fixes * lestarch: renaming StandardTypes.hpp -> PlatformTypes.hpp * lestarch: updating PRI tokens * lestarch: replacing BasicTypes.hpp includes with FpConfig.hpp * lestarch: UT and compilation fixes for types refactor * lestarch: sp * lestarch: fixing RPI issues in PassiveConsoleTextLogger * lestarch: converting RPI build to debug * lestarch: removing duplicate config imports * lestarch: fixing documentation * lestarch: fixing up multiple definitions and RPI compilation problems * lestarch: reverting debug build * lestarch: reverting platform types to class-based constants * lestarch: reworking basic types * lestarch: configured types refactor into classes * lestarch: fixing bugs with static constants in classes * lestarch: fixing platform types spelling and documentation * lestarch: adding include guards to types headers Co-authored-by: Kevin F Ortega <kevin.f.ortega@jpl.nasa.gov>
77 lines
2.9 KiB
C++
77 lines
2.9 KiB
C++
#include <Svc/RateGroupDriver/RateGroupDriver.hpp>
|
|
#include <FpConfig.hpp>
|
|
#include <cstring>
|
|
#include <Fw/Types/Assert.hpp>
|
|
#include <cstdio>
|
|
|
|
namespace Svc {
|
|
|
|
RateGroupDriver::RateGroupDriver(const char* compName) :
|
|
RateGroupDriverComponentBase(compName),
|
|
m_numDividers(0),m_ticks(0),m_rollover(1) {
|
|
|
|
}
|
|
|
|
void RateGroupDriver::configure(NATIVE_INT_TYPE dividers[], NATIVE_INT_TYPE numDividers)
|
|
{
|
|
|
|
// check arguments
|
|
FW_ASSERT(dividers);
|
|
FW_ASSERT(numDividers);
|
|
this->m_numDividers = numDividers;
|
|
FW_ASSERT(numDividers <= static_cast<NATIVE_INT_TYPE>(FW_NUM_ARRAY_ELEMENTS(this->m_dividers)),
|
|
numDividers,
|
|
static_cast<NATIVE_INT_TYPE>(FW_NUM_ARRAY_ELEMENTS(this->m_dividers)));
|
|
// verify port/table size matches
|
|
FW_ASSERT(FW_NUM_ARRAY_ELEMENTS(this->m_dividers) == this->getNum_CycleOut_OutputPorts(),
|
|
static_cast<NATIVE_INT_TYPE>(FW_NUM_ARRAY_ELEMENTS(this->m_dividers)),
|
|
this->getNum_CycleOut_OutputPorts());
|
|
// clear table
|
|
::memset(this->m_dividers,0,sizeof(this->m_dividers));
|
|
// copy provided array of dividers
|
|
for (NATIVE_INT_TYPE entry = 0; entry < numDividers; entry++) {
|
|
this->m_dividers[entry] = dividers[entry];
|
|
// rollover value should be product of all dividers to make sure integer rollover doesn't jump cycles
|
|
// only use non-zero dividers
|
|
if (dividers[entry] != 0) {
|
|
this->m_rollover *= dividers[entry];
|
|
}
|
|
}
|
|
|
|
}
|
|
|
|
RateGroupDriver::~RateGroupDriver() {
|
|
|
|
}
|
|
|
|
void RateGroupDriver::init(NATIVE_INT_TYPE instanceId) {
|
|
RateGroupDriverComponentBase::init(instanceId);
|
|
}
|
|
|
|
void RateGroupDriver::CycleIn_handler(NATIVE_INT_TYPE portNum, Svc::TimerVal& cycleStart) {
|
|
|
|
// Make sure that the dividers have been configured:
|
|
// If this asserts, add the configure() call to initialization.
|
|
FW_ASSERT(this->m_numDividers);
|
|
|
|
// Loop through each divider. For a given port, the port will be called when the divider value
|
|
// divides evenly into the number of ticks. For example, if the divider value for a port is 4,
|
|
// it would be called every fourth invocation of the CycleIn port.
|
|
for (NATIVE_INT_TYPE entry = 0; entry < this->m_numDividers; entry++) {
|
|
if (this->m_dividers[entry] != 0) {
|
|
if (this->isConnected_CycleOut_OutputPort(entry)) {
|
|
if ((this->m_ticks % this->m_dividers[entry]) == 0) {
|
|
this->CycleOut_out(entry,cycleStart);
|
|
}
|
|
}
|
|
}
|
|
}
|
|
|
|
// rollover the tick value when the tick count reaches the rollover value
|
|
// the rollover value is the product of all the dividers. See comment in constructor.
|
|
this->m_ticks = (this->m_ticks + 1) % this->m_rollover;
|
|
|
|
}
|
|
|
|
}
|