Merge pull request 'Localpool Updates' (#374) from KSat/fsfw:mueller/localpool-updates into development
Reviewed-on: fsfw/fsfw#374
This commit is contained in:
commit
559c8d0637
@ -18,15 +18,13 @@ class PoolVariableIF;
|
|||||||
class DataSetIF {
|
class DataSetIF {
|
||||||
public:
|
public:
|
||||||
static constexpr uint8_t INTERFACE_ID = CLASS_ID::DATA_SET_CLASS;
|
static constexpr uint8_t INTERFACE_ID = CLASS_ID::DATA_SET_CLASS;
|
||||||
static constexpr ReturnValue_t INVALID_PARAMETER_DEFINITION =
|
static constexpr ReturnValue_t INVALID_PARAMETER_DEFINITION = MAKE_RETURN_CODE(1);
|
||||||
MAKE_RETURN_CODE( 0x01 );
|
static constexpr ReturnValue_t SET_WAS_ALREADY_READ = MAKE_RETURN_CODE(2);
|
||||||
static constexpr ReturnValue_t SET_WAS_ALREADY_READ = MAKE_RETURN_CODE( 0x02 );
|
static constexpr ReturnValue_t COMMITING_WITHOUT_READING = MAKE_RETURN_CODE(3);
|
||||||
static constexpr ReturnValue_t COMMITING_WITHOUT_READING =
|
|
||||||
MAKE_RETURN_CODE(0x03);
|
|
||||||
|
|
||||||
static constexpr ReturnValue_t DATA_SET_UNINITIALISED = MAKE_RETURN_CODE( 0x04 );
|
static constexpr ReturnValue_t DATA_SET_UNINITIALISED = MAKE_RETURN_CODE(4);
|
||||||
static constexpr ReturnValue_t DATA_SET_FULL = MAKE_RETURN_CODE( 0x05 );
|
static constexpr ReturnValue_t DATA_SET_FULL = MAKE_RETURN_CODE(5);
|
||||||
static constexpr ReturnValue_t POOL_VAR_NULL = MAKE_RETURN_CODE( 0x06 );
|
static constexpr ReturnValue_t POOL_VAR_NULL = MAKE_RETURN_CODE(6);
|
||||||
|
|
||||||
/**
|
/**
|
||||||
* @brief This is an empty virtual destructor,
|
* @brief This is an empty virtual destructor,
|
||||||
|
@ -1,5 +1,8 @@
|
|||||||
#include "PoolDataSetBase.h"
|
#include "PoolDataSetBase.h"
|
||||||
#include "../serviceinterface/ServiceInterfaceStream.h"
|
#include "ReadCommitIFAttorney.h"
|
||||||
|
|
||||||
|
#include "../serviceinterface/ServiceInterface.h"
|
||||||
|
|
||||||
#include <cstring>
|
#include <cstring>
|
||||||
|
|
||||||
PoolDataSetBase::PoolDataSetBase(PoolVariableIF** registeredVariablesArray,
|
PoolDataSetBase::PoolDataSetBase(PoolVariableIF** registeredVariablesArray,
|
||||||
@ -11,26 +14,28 @@ PoolDataSetBase::PoolDataSetBase(PoolVariableIF** registeredVariablesArray,
|
|||||||
PoolDataSetBase::~PoolDataSetBase() {}
|
PoolDataSetBase::~PoolDataSetBase() {}
|
||||||
|
|
||||||
|
|
||||||
ReturnValue_t PoolDataSetBase::registerVariable(
|
ReturnValue_t PoolDataSetBase::registerVariable(PoolVariableIF *variable) {
|
||||||
PoolVariableIF *variable) {
|
|
||||||
if (state != States::STATE_SET_UNINITIALISED) {
|
if (state != States::STATE_SET_UNINITIALISED) {
|
||||||
#if FSFW_CPP_OSTREAM_ENABLED == 1
|
#if FSFW_CPP_OSTREAM_ENABLED == 1
|
||||||
sif::error << "DataSet::registerVariable: "
|
sif::error << "DataSet::registerVariable: Call made in wrong position." << std::endl;
|
||||||
"Call made in wrong position." << std::endl;
|
#else
|
||||||
|
sif::printError("DataSet::registerVariable: Call made in wrong position.");
|
||||||
#endif
|
#endif
|
||||||
return DataSetIF::DATA_SET_UNINITIALISED;
|
return DataSetIF::DATA_SET_UNINITIALISED;
|
||||||
}
|
}
|
||||||
if (variable == nullptr) {
|
if (variable == nullptr) {
|
||||||
#if FSFW_CPP_OSTREAM_ENABLED == 1
|
#if FSFW_CPP_OSTREAM_ENABLED == 1
|
||||||
sif::error << "DataSet::registerVariable: "
|
sif::error << "DataSet::registerVariable: Pool variable is nullptr." << std::endl;
|
||||||
"Pool variable is nullptr." << std::endl;
|
#else
|
||||||
|
sif::printError("DataSet::registerVariable: Pool variable is nullptr.\n");
|
||||||
#endif
|
#endif
|
||||||
return DataSetIF::POOL_VAR_NULL;
|
return DataSetIF::POOL_VAR_NULL;
|
||||||
}
|
}
|
||||||
if (fillCount >= maxFillCount) {
|
if (fillCount >= maxFillCount) {
|
||||||
#if FSFW_CPP_OSTREAM_ENABLED == 1
|
#if FSFW_CPP_OSTREAM_ENABLED == 1
|
||||||
sif::error << "DataSet::registerVariable: "
|
sif::error << "DataSet::registerVariable: DataSet is full." << std::endl;
|
||||||
"DataSet is full." << std::endl;
|
#else
|
||||||
|
sif::printError("DataSet::registerVariable: DataSet is full.\n");
|
||||||
#endif
|
#endif
|
||||||
return DataSetIF::DATA_SET_FULL;
|
return DataSetIF::DATA_SET_FULL;
|
||||||
}
|
}
|
||||||
@ -56,10 +61,12 @@ ReturnValue_t PoolDataSetBase::read(MutexIF::TimeoutType timeoutType,
|
|||||||
}
|
}
|
||||||
else {
|
else {
|
||||||
#if FSFW_CPP_OSTREAM_ENABLED == 1
|
#if FSFW_CPP_OSTREAM_ENABLED == 1
|
||||||
sif::error << "DataSet::read(): "
|
sif::error << "DataSet::read(): Call made in wrong position. Don't forget to commit"
|
||||||
"Call made in wrong position. Don't forget to commit"
|
|
||||||
" member datasets!" << std::endl;
|
" member datasets!" << std::endl;
|
||||||
#endif
|
#else
|
||||||
|
sif::printError("DataSet::read(): Call made in wrong position. Don't forget to commit"
|
||||||
|
" member datasets!\n");
|
||||||
|
#endif /* FSFW_CPP_OSTREAM_ENABLED == 1 */
|
||||||
result = SET_WAS_ALREADY_READ;
|
result = SET_WAS_ALREADY_READ;
|
||||||
}
|
}
|
||||||
|
|
||||||
@ -76,24 +83,21 @@ uint16_t PoolDataSetBase::getFillCount() const {
|
|||||||
ReturnValue_t PoolDataSetBase::readVariable(uint16_t count) {
|
ReturnValue_t PoolDataSetBase::readVariable(uint16_t count) {
|
||||||
ReturnValue_t result = HasReturnvaluesIF::RETURN_OK;
|
ReturnValue_t result = HasReturnvaluesIF::RETURN_OK;
|
||||||
if(registeredVariables[count] == nullptr) {
|
if(registeredVariables[count] == nullptr) {
|
||||||
// configuration error.
|
/* Configuration error. */
|
||||||
return HasReturnvaluesIF::RETURN_FAILED;
|
return HasReturnvaluesIF::RETURN_FAILED;
|
||||||
}
|
}
|
||||||
|
|
||||||
// These checks are often performed by the respective
|
/* These checks are often performed by the respective variable implementation too, but I guess
|
||||||
// variable implementation too, but I guess a double check does not hurt.
|
a double check does not hurt. */
|
||||||
if (registeredVariables[count]->getReadWriteMode() !=
|
if (registeredVariables[count]->getReadWriteMode() != PoolVariableIF::VAR_WRITE and
|
||||||
PoolVariableIF::VAR_WRITE and
|
registeredVariables[count]->getDataPoolId() != PoolVariableIF::NO_PARAMETER) {
|
||||||
registeredVariables[count]->getDataPoolId()
|
|
||||||
!= PoolVariableIF::NO_PARAMETER)
|
|
||||||
{
|
|
||||||
if(protectEveryReadCommitCall) {
|
if(protectEveryReadCommitCall) {
|
||||||
result = registeredVariables[count]->read(
|
result = registeredVariables[count]->read(timeoutTypeForSingleVars,
|
||||||
timeoutTypeForSingleVars,
|
|
||||||
mutexTimeoutForSingleVars);
|
mutexTimeoutForSingleVars);
|
||||||
}
|
}
|
||||||
else {
|
else {
|
||||||
result = registeredVariables[count]->readWithoutLock();
|
/* The readWithoutLock function is protected, so we use the attorney here */
|
||||||
|
result = ReadCommitIFAttorney::readWithoutLock(registeredVariables[count]);
|
||||||
}
|
}
|
||||||
|
|
||||||
if(result != HasReturnvaluesIF::RETURN_OK) {
|
if(result != HasReturnvaluesIF::RETURN_OK) {
|
||||||
@ -118,17 +122,15 @@ void PoolDataSetBase::handleAlreadyReadDatasetCommit(
|
|||||||
MutexIF::TimeoutType timeoutType, uint32_t lockTimeout) {
|
MutexIF::TimeoutType timeoutType, uint32_t lockTimeout) {
|
||||||
lockDataPool(timeoutType, lockTimeout);
|
lockDataPool(timeoutType, lockTimeout);
|
||||||
for (uint16_t count = 0; count < fillCount; count++) {
|
for (uint16_t count = 0; count < fillCount; count++) {
|
||||||
if (registeredVariables[count]->getReadWriteMode()
|
if ((registeredVariables[count]->getReadWriteMode() != PoolVariableIF::VAR_READ) and
|
||||||
!= PoolVariableIF::VAR_READ
|
(registeredVariables[count]->getDataPoolId() != PoolVariableIF::NO_PARAMETER)) {
|
||||||
&& registeredVariables[count]->getDataPoolId()
|
|
||||||
!= PoolVariableIF::NO_PARAMETER) {
|
|
||||||
if(protectEveryReadCommitCall) {
|
if(protectEveryReadCommitCall) {
|
||||||
registeredVariables[count]->commit(
|
registeredVariables[count]->commit(timeoutTypeForSingleVars,
|
||||||
timeoutTypeForSingleVars,
|
|
||||||
mutexTimeoutForSingleVars);
|
mutexTimeoutForSingleVars);
|
||||||
}
|
}
|
||||||
else {
|
else {
|
||||||
registeredVariables[count]->commitWithoutLock();
|
/* The commitWithoutLock function is protected, so we use the attorney here */
|
||||||
|
ReadCommitIFAttorney::commitWithoutLock(registeredVariables[count]);
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
@ -141,17 +143,15 @@ ReturnValue_t PoolDataSetBase::handleUnreadDatasetCommit(
|
|||||||
ReturnValue_t result = HasReturnvaluesIF::RETURN_OK;
|
ReturnValue_t result = HasReturnvaluesIF::RETURN_OK;
|
||||||
lockDataPool(timeoutType, lockTimeout);
|
lockDataPool(timeoutType, lockTimeout);
|
||||||
for (uint16_t count = 0; count < fillCount; count++) {
|
for (uint16_t count = 0; count < fillCount; count++) {
|
||||||
if (registeredVariables[count]->getReadWriteMode()
|
if ((registeredVariables[count]->getReadWriteMode() == PoolVariableIF::VAR_WRITE) and
|
||||||
== PoolVariableIF::VAR_WRITE
|
(registeredVariables[count]->getDataPoolId() != PoolVariableIF::NO_PARAMETER)) {
|
||||||
&& registeredVariables[count]->getDataPoolId()
|
|
||||||
!= PoolVariableIF::NO_PARAMETER) {
|
|
||||||
if(protectEveryReadCommitCall) {
|
if(protectEveryReadCommitCall) {
|
||||||
result = registeredVariables[count]->commit(
|
result = registeredVariables[count]->commit(timeoutTypeForSingleVars,
|
||||||
timeoutTypeForSingleVars,
|
|
||||||
mutexTimeoutForSingleVars);
|
mutexTimeoutForSingleVars);
|
||||||
}
|
}
|
||||||
else {
|
else {
|
||||||
result = registeredVariables[count]->commitWithoutLock();
|
/* The commitWithoutLock function is protected, so we use the attorney here */
|
||||||
|
ReadCommitIFAttorney::commitWithoutLock(registeredVariables[count]);
|
||||||
}
|
}
|
||||||
|
|
||||||
} else if (registeredVariables[count]->getDataPoolId()
|
} else if (registeredVariables[count]->getDataPoolId()
|
||||||
@ -184,8 +184,7 @@ ReturnValue_t PoolDataSetBase::serialize(uint8_t** buffer, size_t* size,
|
|||||||
const size_t maxSize, SerializeIF::Endianness streamEndianness) const {
|
const size_t maxSize, SerializeIF::Endianness streamEndianness) const {
|
||||||
ReturnValue_t result = HasReturnvaluesIF::RETURN_FAILED;
|
ReturnValue_t result = HasReturnvaluesIF::RETURN_FAILED;
|
||||||
for (uint16_t count = 0; count < fillCount; count++) {
|
for (uint16_t count = 0; count < fillCount; count++) {
|
||||||
result = registeredVariables[count]->serialize(buffer, size, maxSize,
|
result = registeredVariables[count]->serialize(buffer, size, maxSize, streamEndianness);
|
||||||
streamEndianness);
|
|
||||||
if (result != HasReturnvaluesIF::RETURN_OK) {
|
if (result != HasReturnvaluesIF::RETURN_OK) {
|
||||||
return result;
|
return result;
|
||||||
}
|
}
|
||||||
|
@ -29,7 +29,8 @@
|
|||||||
* @author Bastian Baetz
|
* @author Bastian Baetz
|
||||||
* @ingroup data_pool
|
* @ingroup data_pool
|
||||||
*/
|
*/
|
||||||
class PoolDataSetBase: public PoolDataSetIF,
|
class PoolDataSetBase:
|
||||||
|
public PoolDataSetIF,
|
||||||
public SerializeIF,
|
public SerializeIF,
|
||||||
public HasReturnvaluesIF {
|
public HasReturnvaluesIF {
|
||||||
public:
|
public:
|
||||||
|
@ -8,7 +8,9 @@
|
|||||||
* @brief Extendes the DataSetIF by adding abstract functions to lock
|
* @brief Extendes the DataSetIF by adding abstract functions to lock
|
||||||
* and unlock a data pool and read/commit semantics.
|
* and unlock a data pool and read/commit semantics.
|
||||||
*/
|
*/
|
||||||
class PoolDataSetIF: public DataSetIF, public ReadCommitIF {
|
class PoolDataSetIF:
|
||||||
|
public DataSetIF,
|
||||||
|
public ReadCommitIF {
|
||||||
public:
|
public:
|
||||||
virtual~ PoolDataSetIF() {};
|
virtual~ PoolDataSetIF() {};
|
||||||
|
|
||||||
|
@ -32,8 +32,18 @@ public:
|
|||||||
return readResult;
|
return readResult;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
/**
|
||||||
|
* @brief Can be used to suppress commit on destruction.
|
||||||
|
*/
|
||||||
|
void setNoCommitMode(bool commit) {
|
||||||
|
this->noCommit = commit;
|
||||||
|
}
|
||||||
|
|
||||||
|
/**
|
||||||
|
* @brief Default destructor which will take care of commiting changed values.
|
||||||
|
*/
|
||||||
~PoolReadHelper() {
|
~PoolReadHelper() {
|
||||||
if(readObject != nullptr) {
|
if(readObject != nullptr and not noCommit) {
|
||||||
readObject->commit(timeoutType, mutexTimeout);
|
readObject->commit(timeoutType, mutexTimeout);
|
||||||
}
|
}
|
||||||
|
|
||||||
@ -42,6 +52,7 @@ public:
|
|||||||
private:
|
private:
|
||||||
ReadCommitIF* readObject = nullptr;
|
ReadCommitIF* readObject = nullptr;
|
||||||
ReturnValue_t readResult = HasReturnvaluesIF::RETURN_OK;
|
ReturnValue_t readResult = HasReturnvaluesIF::RETURN_OK;
|
||||||
|
bool noCommit = false;
|
||||||
MutexIF::TimeoutType timeoutType = MutexIF::TimeoutType::WAITING;
|
MutexIF::TimeoutType timeoutType = MutexIF::TimeoutType::WAITING;
|
||||||
uint32_t mutexTimeout = 20;
|
uint32_t mutexTimeout = 20;
|
||||||
};
|
};
|
||||||
|
@ -1,9 +1,10 @@
|
|||||||
#ifndef FSFW_DATAPOOL_POOLVARIABLEIF_H_
|
#ifndef FSFW_DATAPOOL_POOLVARIABLEIF_H_
|
||||||
#define FSFW_DATAPOOL_POOLVARIABLEIF_H_
|
#define FSFW_DATAPOOL_POOLVARIABLEIF_H_
|
||||||
|
|
||||||
|
#include "ReadCommitIF.h"
|
||||||
#include "../returnvalues/HasReturnvaluesIF.h"
|
#include "../returnvalues/HasReturnvaluesIF.h"
|
||||||
#include "../serialize/SerializeIF.h"
|
#include "../serialize/SerializeIF.h"
|
||||||
#include "ReadCommitIF.h"
|
|
||||||
|
|
||||||
/**
|
/**
|
||||||
* @brief This interface is used to control data pool
|
* @brief This interface is used to control data pool
|
||||||
@ -18,10 +19,10 @@
|
|||||||
* @author Bastian Baetz
|
* @author Bastian Baetz
|
||||||
* @ingroup data_pool
|
* @ingroup data_pool
|
||||||
*/
|
*/
|
||||||
class PoolVariableIF : public SerializeIF,
|
class PoolVariableIF :
|
||||||
|
public SerializeIF,
|
||||||
public ReadCommitIF {
|
public ReadCommitIF {
|
||||||
friend class PoolDataSetBase;
|
|
||||||
friend class LocalPoolDataSetBase;
|
|
||||||
public:
|
public:
|
||||||
static constexpr uint8_t INTERFACE_ID = CLASS_ID::POOL_VARIABLE_IF;
|
static constexpr uint8_t INTERFACE_ID = CLASS_ID::POOL_VARIABLE_IF;
|
||||||
static constexpr ReturnValue_t INVALID_READ_WRITE_MODE = MAKE_RETURN_CODE(0xA0);
|
static constexpr ReturnValue_t INVALID_READ_WRITE_MODE = MAKE_RETURN_CODE(0xA0);
|
||||||
|
@ -9,6 +9,7 @@
|
|||||||
* semantics.
|
* semantics.
|
||||||
*/
|
*/
|
||||||
class ReadCommitIF {
|
class ReadCommitIF {
|
||||||
|
friend class ReadCommitIFAttorney;
|
||||||
public:
|
public:
|
||||||
virtual ~ReadCommitIF() {}
|
virtual ~ReadCommitIF() {}
|
||||||
virtual ReturnValue_t read(MutexIF::TimeoutType timeoutType,
|
virtual ReturnValue_t read(MutexIF::TimeoutType timeoutType,
|
||||||
@ -18,9 +19,8 @@ public:
|
|||||||
|
|
||||||
protected:
|
protected:
|
||||||
|
|
||||||
//! Optional and protected because this is interesting for classes grouping
|
/* Optional and protected because this is interesting for classes grouping members with commit
|
||||||
//! members with commit and read semantics where the lock is only necessary
|
and read semantics where the lock is only necessary once. */
|
||||||
//! once.
|
|
||||||
virtual ReturnValue_t readWithoutLock() {
|
virtual ReturnValue_t readWithoutLock() {
|
||||||
return read(MutexIF::TimeoutType::WAITING, 20);
|
return read(MutexIF::TimeoutType::WAITING, 20);
|
||||||
}
|
}
|
||||||
|
32
datapool/ReadCommitIFAttorney.h
Normal file
32
datapool/ReadCommitIFAttorney.h
Normal file
@ -0,0 +1,32 @@
|
|||||||
|
#ifndef FSFW_DATAPOOL_READCOMMITIFATTORNEY_H_
|
||||||
|
#define FSFW_DATAPOOL_READCOMMITIFATTORNEY_H_
|
||||||
|
|
||||||
|
#include <fsfw/datapool/ReadCommitIF.h>
|
||||||
|
#include <fsfw/returnvalues/HasReturnvaluesIF.h>
|
||||||
|
|
||||||
|
/**
|
||||||
|
* @brief This class determines which members are allowed to access protected members
|
||||||
|
* of the ReadCommitIF.
|
||||||
|
*/
|
||||||
|
class ReadCommitIFAttorney {
|
||||||
|
private:
|
||||||
|
static ReturnValue_t readWithoutLock(ReadCommitIF* readCommitIF) {
|
||||||
|
if(readCommitIF == nullptr) {
|
||||||
|
return HasReturnvaluesIF::RETURN_FAILED;
|
||||||
|
}
|
||||||
|
return readCommitIF->readWithoutLock();
|
||||||
|
}
|
||||||
|
|
||||||
|
static ReturnValue_t commitWithoutLock(ReadCommitIF* readCommitIF) {
|
||||||
|
if(readCommitIF == nullptr) {
|
||||||
|
return HasReturnvaluesIF::RETURN_FAILED;
|
||||||
|
}
|
||||||
|
return readCommitIF->commitWithoutLock();
|
||||||
|
}
|
||||||
|
|
||||||
|
friend class PoolDataSetBase;
|
||||||
|
};
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
#endif /* FSFW_DATAPOOL_READCOMMITIFATTORNEY_H_ */
|
@ -23,11 +23,21 @@ class LocalPoolObjectBase;
|
|||||||
* @details
|
* @details
|
||||||
* Any class implementing this interface shall also have a LocalDataPoolManager member class which
|
* Any class implementing this interface shall also have a LocalDataPoolManager member class which
|
||||||
* contains the actual pool data structure and exposes the public interface for it.
|
* contains the actual pool data structure and exposes the public interface for it.
|
||||||
|
*
|
||||||
* The local data pool can be accessed using helper classes by using the
|
* The local data pool can be accessed using helper classes by using the
|
||||||
* LocalPoolVariable, LocalPoolVector or LocalDataSet classes. Every local pool variable can
|
* LocalPoolVariable, LocalPoolVector or LocalDataSet classes. Every local pool variable can
|
||||||
* be uniquely identified by a global pool ID (gp_id_t) and every dataset tied
|
* be uniquely identified by a global pool ID (gp_id_t) and every dataset tied
|
||||||
* to a pool manager can be uniqely identified by a global structure ID (sid_t).
|
* to a pool manager can be uniqely identified by a global structure ID (sid_t).
|
||||||
*
|
*
|
||||||
|
* All software objects which want to use the local pool of another object shall also use this
|
||||||
|
* interface, for example to get a handle to the subscription interface. The interface
|
||||||
|
* can be retrieved using the object manager, provided the target object is a SystemObject.
|
||||||
|
* For example, the following line of code can be used to retrieve the interface
|
||||||
|
*
|
||||||
|
* HasLocalDataPoolIF* poolIF = objectManager->get<HasLocalDataPoolIF>(objects::SOME_OBJECT);
|
||||||
|
* if(poolIF != nullptr) {
|
||||||
|
* doSomething()
|
||||||
|
* }
|
||||||
*/
|
*/
|
||||||
class HasLocalDataPoolIF {
|
class HasLocalDataPoolIF {
|
||||||
friend class HasLocalDpIFManagerAttorney;
|
friend class HasLocalDpIFManagerAttorney;
|
||||||
|
@ -98,7 +98,7 @@ ReturnValue_t LocalDataPoolManager::initializeHousekeepingPoolEntriesOnce() {
|
|||||||
|
|
||||||
ReturnValue_t LocalDataPoolManager::performHkOperation() {
|
ReturnValue_t LocalDataPoolManager::performHkOperation() {
|
||||||
ReturnValue_t status = HasReturnvaluesIF::RETURN_OK;
|
ReturnValue_t status = HasReturnvaluesIF::RETURN_OK;
|
||||||
for(auto& receiver: hkReceiversMap) {
|
for(auto& receiver: hkReceivers) {
|
||||||
switch(receiver.reportingType) {
|
switch(receiver.reportingType) {
|
||||||
case(ReportingType::PERIODIC): {
|
case(ReportingType::PERIODIC): {
|
||||||
if(receiver.dataType == DataType::LOCAL_POOL_VARIABLE) {
|
if(receiver.dataType == DataType::LOCAL_POOL_VARIABLE) {
|
||||||
@ -375,12 +375,12 @@ ReturnValue_t LocalDataPoolManager::subscribeForPeriodicPacket(sid_t sid,
|
|||||||
owner->getPeriodicOperationFrequency(), isDiagnostics);
|
owner->getPeriodicOperationFrequency(), isDiagnostics);
|
||||||
}
|
}
|
||||||
|
|
||||||
hkReceiversMap.push_back(hkReceiver);
|
hkReceivers.push_back(hkReceiver);
|
||||||
return HasReturnvaluesIF::RETURN_OK;
|
return HasReturnvaluesIF::RETURN_OK;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|
||||||
ReturnValue_t LocalDataPoolManager::subscribeForUpdatePackets(sid_t sid,
|
ReturnValue_t LocalDataPoolManager::subscribeForUpdatePacket(sid_t sid,
|
||||||
bool isDiagnostics, bool reportingEnabled,
|
bool isDiagnostics, bool reportingEnabled,
|
||||||
object_id_t packetDestination) {
|
object_id_t packetDestination) {
|
||||||
AcceptsHkPacketsIF* hkReceiverObject =
|
AcceptsHkPacketsIF* hkReceiverObject =
|
||||||
@ -404,13 +404,13 @@ ReturnValue_t LocalDataPoolManager::subscribeForUpdatePackets(sid_t sid,
|
|||||||
LocalPoolDataSetAttorney::setDiagnostic(*dataSet, isDiagnostics);
|
LocalPoolDataSetAttorney::setDiagnostic(*dataSet, isDiagnostics);
|
||||||
}
|
}
|
||||||
|
|
||||||
hkReceiversMap.push_back(hkReceiver);
|
hkReceivers.push_back(hkReceiver);
|
||||||
|
|
||||||
handleHkUpdateResetListInsertion(hkReceiver.dataType, hkReceiver.dataId);
|
handleHkUpdateResetListInsertion(hkReceiver.dataType, hkReceiver.dataId);
|
||||||
return HasReturnvaluesIF::RETURN_OK;
|
return HasReturnvaluesIF::RETURN_OK;
|
||||||
}
|
}
|
||||||
|
|
||||||
ReturnValue_t LocalDataPoolManager::subscribeForSetUpdateMessages(
|
ReturnValue_t LocalDataPoolManager::subscribeForSetUpdateMessage(
|
||||||
const uint32_t setId, object_id_t destinationObject,
|
const uint32_t setId, object_id_t destinationObject,
|
||||||
MessageQueueId_t targetQueueId, bool generateSnapshot) {
|
MessageQueueId_t targetQueueId, bool generateSnapshot) {
|
||||||
struct HkReceiver hkReceiver;
|
struct HkReceiver hkReceiver;
|
||||||
@ -425,13 +425,13 @@ ReturnValue_t LocalDataPoolManager::subscribeForSetUpdateMessages(
|
|||||||
hkReceiver.reportingType = ReportingType::UPDATE_NOTIFICATION;
|
hkReceiver.reportingType = ReportingType::UPDATE_NOTIFICATION;
|
||||||
}
|
}
|
||||||
|
|
||||||
hkReceiversMap.push_back(hkReceiver);
|
hkReceivers.push_back(hkReceiver);
|
||||||
|
|
||||||
handleHkUpdateResetListInsertion(hkReceiver.dataType, hkReceiver.dataId);
|
handleHkUpdateResetListInsertion(hkReceiver.dataType, hkReceiver.dataId);
|
||||||
return HasReturnvaluesIF::RETURN_OK;
|
return HasReturnvaluesIF::RETURN_OK;
|
||||||
}
|
}
|
||||||
|
|
||||||
ReturnValue_t LocalDataPoolManager::subscribeForVariableUpdateMessages(
|
ReturnValue_t LocalDataPoolManager::subscribeForVariableUpdateMessage(
|
||||||
const lp_id_t localPoolId, object_id_t destinationObject,
|
const lp_id_t localPoolId, object_id_t destinationObject,
|
||||||
MessageQueueId_t targetQueueId, bool generateSnapshot) {
|
MessageQueueId_t targetQueueId, bool generateSnapshot) {
|
||||||
struct HkReceiver hkReceiver;
|
struct HkReceiver hkReceiver;
|
||||||
@ -446,7 +446,7 @@ ReturnValue_t LocalDataPoolManager::subscribeForVariableUpdateMessages(
|
|||||||
hkReceiver.reportingType = ReportingType::UPDATE_NOTIFICATION;
|
hkReceiver.reportingType = ReportingType::UPDATE_NOTIFICATION;
|
||||||
}
|
}
|
||||||
|
|
||||||
hkReceiversMap.push_back(hkReceiver);
|
hkReceivers.push_back(hkReceiver);
|
||||||
|
|
||||||
handleHkUpdateResetListInsertion(hkReceiver.dataType, hkReceiver.dataId);
|
handleHkUpdateResetListInsertion(hkReceiver.dataType, hkReceiver.dataId);
|
||||||
return HasReturnvaluesIF::RETURN_OK;
|
return HasReturnvaluesIF::RETURN_OK;
|
||||||
@ -829,8 +829,8 @@ ReturnValue_t LocalDataPoolManager::generateSetStructurePacket(sid_t sid,
|
|||||||
}
|
}
|
||||||
|
|
||||||
void LocalDataPoolManager::clearReceiversList() {
|
void LocalDataPoolManager::clearReceiversList() {
|
||||||
// clear the vector completely and releases allocated memory.
|
/* Clear the vector completely and releases allocated memory. */
|
||||||
HkReceivers().swap(hkReceiversMap);
|
HkReceivers().swap(hkReceivers);
|
||||||
}
|
}
|
||||||
|
|
||||||
MutexIF* LocalDataPoolManager::getLocalPoolMutex() {
|
MutexIF* LocalDataPoolManager::getLocalPoolMutex() {
|
||||||
|
@ -137,7 +137,7 @@ public:
|
|||||||
* @param packetDestination
|
* @param packetDestination
|
||||||
* @return
|
* @return
|
||||||
*/
|
*/
|
||||||
ReturnValue_t subscribeForUpdatePackets(sid_t sid, bool reportingEnabled,
|
ReturnValue_t subscribeForUpdatePacket(sid_t sid, bool reportingEnabled,
|
||||||
bool isDiagnostics,
|
bool isDiagnostics,
|
||||||
object_id_t packetDestination = defaultHkDestination) override;
|
object_id_t packetDestination = defaultHkDestination) override;
|
||||||
|
|
||||||
@ -155,7 +155,7 @@ public:
|
|||||||
* Otherwise, only an notification message is sent.
|
* Otherwise, only an notification message is sent.
|
||||||
* @return
|
* @return
|
||||||
*/
|
*/
|
||||||
ReturnValue_t subscribeForSetUpdateMessages(const uint32_t setId,
|
ReturnValue_t subscribeForSetUpdateMessage(const uint32_t setId,
|
||||||
object_id_t destinationObject,
|
object_id_t destinationObject,
|
||||||
MessageQueueId_t targetQueueId,
|
MessageQueueId_t targetQueueId,
|
||||||
bool generateSnapshot) override;
|
bool generateSnapshot) override;
|
||||||
@ -174,7 +174,7 @@ public:
|
|||||||
* Otherwise, only an notification message is sent.
|
* Otherwise, only an notification message is sent.
|
||||||
* @return
|
* @return
|
||||||
*/
|
*/
|
||||||
ReturnValue_t subscribeForVariableUpdateMessages(const lp_id_t localPoolId,
|
ReturnValue_t subscribeForVariableUpdateMessage(const lp_id_t localPoolId,
|
||||||
object_id_t destinationObject,
|
object_id_t destinationObject,
|
||||||
MessageQueueId_t targetQueueId,
|
MessageQueueId_t targetQueueId,
|
||||||
bool generateSnapshot) override;
|
bool generateSnapshot) override;
|
||||||
@ -271,7 +271,10 @@ public:
|
|||||||
MutexIF* getMutexHandle();
|
MutexIF* getMutexHandle();
|
||||||
|
|
||||||
virtual LocalDataPoolManager* getPoolManagerHandle() override;
|
virtual LocalDataPoolManager* getPoolManagerHandle() override;
|
||||||
private:
|
|
||||||
|
protected:
|
||||||
|
|
||||||
|
/** Core data structure for the actual pool data */
|
||||||
localpool::DataPool localPoolMap;
|
localpool::DataPool localPoolMap;
|
||||||
/** Every housekeeping data manager has a mutex to protect access
|
/** Every housekeeping data manager has a mutex to protect access
|
||||||
to it's data pool. */
|
to it's data pool. */
|
||||||
@ -307,7 +310,7 @@ private:
|
|||||||
/** This vector will contain the list of HK receivers. */
|
/** This vector will contain the list of HK receivers. */
|
||||||
using HkReceivers = std::vector<struct HkReceiver>;
|
using HkReceivers = std::vector<struct HkReceiver>;
|
||||||
|
|
||||||
HkReceivers hkReceiversMap;
|
HkReceivers hkReceivers;
|
||||||
|
|
||||||
struct HkUpdateResetHelper {
|
struct HkUpdateResetHelper {
|
||||||
DataType dataType = DataType::DATA_SET;
|
DataType dataType = DataType::DATA_SET;
|
||||||
@ -317,7 +320,8 @@ private:
|
|||||||
};
|
};
|
||||||
|
|
||||||
using HkUpdateResetList = std::vector<struct HkUpdateResetHelper>;
|
using HkUpdateResetList = std::vector<struct HkUpdateResetHelper>;
|
||||||
// Will only be created when needed.
|
/** This list is used to manage creating multiple update packets and only resetting
|
||||||
|
the update flag if all of them were created. Will only be created when needed. */
|
||||||
HkUpdateResetList* hkUpdateResetList = nullptr;
|
HkUpdateResetList* hkUpdateResetList = nullptr;
|
||||||
|
|
||||||
/** This is the map holding the actual data. Should only be initialized
|
/** This is the map holding the actual data. Should only be initialized
|
||||||
@ -341,16 +345,14 @@ private:
|
|||||||
* Read a variable by supplying its local pool ID and assign the pool
|
* Read a variable by supplying its local pool ID and assign the pool
|
||||||
* entry to the supplied PoolEntry pointer. The type of the pool entry
|
* entry to the supplied PoolEntry pointer. The type of the pool entry
|
||||||
* is deduced automatically. This call is not thread-safe!
|
* is deduced automatically. This call is not thread-safe!
|
||||||
* For now, only friend classes like LocalPoolVar may access this
|
* For now, only classes designated by the LocalDpManagerAttorney may use this function.
|
||||||
* function.
|
|
||||||
* @tparam T Type of the pool entry
|
* @tparam T Type of the pool entry
|
||||||
* @param localPoolId Pool ID of the variable to read
|
* @param localPoolId Pool ID of the variable to read
|
||||||
* @param poolVar [out] Corresponding pool entry will be assigned to the
|
* @param poolVar [out] Corresponding pool entry will be assigned to the
|
||||||
* supplied pointer.
|
* supplied pointer.
|
||||||
* @return
|
* @return
|
||||||
*/
|
*/
|
||||||
template <class T> ReturnValue_t fetchPoolEntry(lp_id_t localPoolId,
|
template <class T> ReturnValue_t fetchPoolEntry(lp_id_t localPoolId, PoolEntry<T> **poolEntry);
|
||||||
PoolEntry<T> **poolEntry);
|
|
||||||
|
|
||||||
/**
|
/**
|
||||||
* This function is used to fill the local data pool map with pool
|
* This function is used to fill the local data pool map with pool
|
||||||
@ -362,15 +364,13 @@ private:
|
|||||||
|
|
||||||
MutexIF* getLocalPoolMutex() override;
|
MutexIF* getLocalPoolMutex() override;
|
||||||
|
|
||||||
ReturnValue_t serializeHkPacketIntoStore(
|
ReturnValue_t serializeHkPacketIntoStore(HousekeepingPacketDownlink& hkPacket,
|
||||||
HousekeepingPacketDownlink& hkPacket,
|
|
||||||
store_address_t& storeId, bool forDownlink, size_t* serializedSize);
|
store_address_t& storeId, bool forDownlink, size_t* serializedSize);
|
||||||
|
|
||||||
void performPeriodicHkGeneration(HkReceiver& hkReceiver);
|
void performPeriodicHkGeneration(HkReceiver& hkReceiver);
|
||||||
ReturnValue_t togglePeriodicGeneration(sid_t sid, bool enable,
|
ReturnValue_t togglePeriodicGeneration(sid_t sid, bool enable, bool isDiagnostics);
|
||||||
|
ReturnValue_t changeCollectionInterval(sid_t sid, float newCollectionInterval,
|
||||||
bool isDiagnostics);
|
bool isDiagnostics);
|
||||||
ReturnValue_t changeCollectionInterval(sid_t sid,
|
|
||||||
float newCollectionInterval, bool isDiagnostics);
|
|
||||||
ReturnValue_t generateSetStructurePacket(sid_t sid, bool isDiagnostics);
|
ReturnValue_t generateSetStructurePacket(sid_t sid, bool isDiagnostics);
|
||||||
|
|
||||||
void handleHkUpdateResetListInsertion(DataType dataType, DataId dataId);
|
void handleHkUpdateResetListInsertion(DataType dataType, DataId dataId);
|
||||||
@ -378,25 +378,19 @@ private:
|
|||||||
DataId dataId, MarkChangedIF* toReset);
|
DataId dataId, MarkChangedIF* toReset);
|
||||||
void resetHkUpdateResetHelper();
|
void resetHkUpdateResetHelper();
|
||||||
|
|
||||||
ReturnValue_t handleHkUpdate(HkReceiver& hkReceiver,
|
ReturnValue_t handleHkUpdate(HkReceiver& hkReceiver, ReturnValue_t& status);
|
||||||
ReturnValue_t& status);
|
ReturnValue_t handleNotificationUpdate(HkReceiver& hkReceiver, ReturnValue_t& status);
|
||||||
ReturnValue_t handleNotificationUpdate(HkReceiver& hkReceiver,
|
ReturnValue_t handleNotificationSnapshot(HkReceiver& hkReceiver, ReturnValue_t& status);
|
||||||
ReturnValue_t& status);
|
ReturnValue_t addUpdateToStore(HousekeepingSnapshot& updatePacket, store_address_t& storeId);
|
||||||
ReturnValue_t handleNotificationSnapshot(HkReceiver& hkReceiver,
|
|
||||||
ReturnValue_t& status);
|
|
||||||
ReturnValue_t addUpdateToStore(HousekeepingSnapshot& updatePacket,
|
|
||||||
store_address_t& storeId);
|
|
||||||
|
|
||||||
void printWarningOrError(sif::OutputTypes outputType,
|
void printWarningOrError(sif::OutputTypes outputType, const char* functionName,
|
||||||
const char* functionName,
|
|
||||||
ReturnValue_t errorCode = HasReturnvaluesIF::RETURN_FAILED,
|
ReturnValue_t errorCode = HasReturnvaluesIF::RETURN_FAILED,
|
||||||
const char* errorPrint = nullptr);
|
const char* errorPrint = nullptr);
|
||||||
};
|
};
|
||||||
|
|
||||||
|
|
||||||
template<class T> inline
|
template<class T> inline
|
||||||
ReturnValue_t LocalDataPoolManager::fetchPoolEntry(lp_id_t localPoolId,
|
ReturnValue_t LocalDataPoolManager::fetchPoolEntry(lp_id_t localPoolId, PoolEntry<T> **poolEntry) {
|
||||||
PoolEntry<T> **poolEntry) {
|
|
||||||
auto poolIter = localPoolMap.find(localPoolId);
|
auto poolIter = localPoolMap.find(localPoolId);
|
||||||
if (poolIter == localPoolMap.end()) {
|
if (poolIter == localPoolMap.end()) {
|
||||||
printWarningOrError(sif::OutputTypes::OUT_WARNING, "fetchPoolEntry",
|
printWarningOrError(sif::OutputTypes::OUT_WARNING, "fetchPoolEntry",
|
||||||
|
@ -3,6 +3,7 @@
|
|||||||
#include "internal/HasLocalDpIFUserAttorney.h"
|
#include "internal/HasLocalDpIFUserAttorney.h"
|
||||||
|
|
||||||
#include "../serviceinterface/ServiceInterface.h"
|
#include "../serviceinterface/ServiceInterface.h"
|
||||||
|
#include "../globalfunctions/bitutility.h"
|
||||||
#include "../datapoollocal/LocalDataPoolManager.h"
|
#include "../datapoollocal/LocalDataPoolManager.h"
|
||||||
#include "../housekeeping/PeriodicHousekeepingHelper.h"
|
#include "../housekeeping/PeriodicHousekeepingHelper.h"
|
||||||
#include "../serialize/SerializeAdapter.h"
|
#include "../serialize/SerializeAdapter.h"
|
||||||
@ -96,14 +97,14 @@ ReturnValue_t LocalPoolDataSetBase::serializeWithValidityBuffer(uint8_t **buffer
|
|||||||
SerializeIF::Endianness streamEndianness) const {
|
SerializeIF::Endianness streamEndianness) const {
|
||||||
ReturnValue_t result = HasReturnvaluesIF::RETURN_OK;
|
ReturnValue_t result = HasReturnvaluesIF::RETURN_OK;
|
||||||
uint8_t validityMaskSize = std::ceil(static_cast<float>(fillCount)/8.0);
|
uint8_t validityMaskSize = std::ceil(static_cast<float>(fillCount)/8.0);
|
||||||
uint8_t validityMask[validityMaskSize];
|
uint8_t validityMask[validityMaskSize] = {};
|
||||||
uint8_t validBufferIndex = 0;
|
uint8_t validBufferIndex = 0;
|
||||||
uint8_t validBufferIndexBit = 0;
|
uint8_t validBufferIndexBit = 0;
|
||||||
for (uint16_t count = 0; count < fillCount; count++) {
|
for (uint16_t count = 0; count < fillCount; count++) {
|
||||||
if(registeredVariables[count]->isValid()) {
|
if(registeredVariables[count]->isValid()) {
|
||||||
// set validity buffer here.
|
/* Set bit at correct position */
|
||||||
this->bitSetter(validityMask + validBufferIndex,
|
bitutil::bitSet(validityMask + validBufferIndex, validBufferIndexBit);
|
||||||
validBufferIndexBit);
|
}
|
||||||
if(validBufferIndexBit == 7) {
|
if(validBufferIndexBit == 7) {
|
||||||
validBufferIndex ++;
|
validBufferIndex ++;
|
||||||
validBufferIndexBit = 0;
|
validBufferIndexBit = 0;
|
||||||
@ -111,7 +112,7 @@ ReturnValue_t LocalPoolDataSetBase::serializeWithValidityBuffer(uint8_t **buffer
|
|||||||
else {
|
else {
|
||||||
validBufferIndexBit ++;
|
validBufferIndexBit ++;
|
||||||
}
|
}
|
||||||
}
|
|
||||||
result = registeredVariables[count]->serialize(buffer, size, maxSize,
|
result = registeredVariables[count]->serialize(buffer, size, maxSize,
|
||||||
streamEndianness);
|
streamEndianness);
|
||||||
if (result != HasReturnvaluesIF::RETURN_OK) {
|
if (result != HasReturnvaluesIF::RETURN_OK) {
|
||||||
@ -148,7 +149,7 @@ ReturnValue_t LocalPoolDataSetBase::deSerializeWithValidityBuffer(
|
|||||||
uint8_t validBufferIndexBit = 0;
|
uint8_t validBufferIndexBit = 0;
|
||||||
for (uint16_t count = 0; count < fillCount; count++) {
|
for (uint16_t count = 0; count < fillCount; count++) {
|
||||||
// set validity buffer here.
|
// set validity buffer here.
|
||||||
bool nextVarValid = this->bitGetter(*buffer +
|
bool nextVarValid = bitutil::bitGet(*buffer +
|
||||||
validBufferIndex, validBufferIndexBit);
|
validBufferIndex, validBufferIndexBit);
|
||||||
registeredVariables[count]->setValid(nextVarValid);
|
registeredVariables[count]->setValid(nextVarValid);
|
||||||
|
|
||||||
@ -173,7 +174,7 @@ ReturnValue_t LocalPoolDataSetBase::unlockDataPool() {
|
|||||||
ReturnValue_t LocalPoolDataSetBase::serializeLocalPoolIds(uint8_t** buffer,
|
ReturnValue_t LocalPoolDataSetBase::serializeLocalPoolIds(uint8_t** buffer,
|
||||||
size_t* size, size_t maxSize,SerializeIF::Endianness streamEndianness,
|
size_t* size, size_t maxSize,SerializeIF::Endianness streamEndianness,
|
||||||
bool serializeFillCount) const {
|
bool serializeFillCount) const {
|
||||||
// Serialize as uint8_t
|
/* Serialize fill count as uint8_t */
|
||||||
uint8_t fillCount = this->fillCount;
|
uint8_t fillCount = this->fillCount;
|
||||||
if(serializeFillCount) {
|
if(serializeFillCount) {
|
||||||
SerializeAdapter::serialize(&fillCount, buffer, size, maxSize,
|
SerializeAdapter::serialize(&fillCount, buffer, size, maxSize,
|
||||||
@ -246,21 +247,6 @@ ReturnValue_t LocalPoolDataSetBase::serialize(uint8_t **buffer, size_t *size,
|
|||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
void LocalPoolDataSetBase::bitSetter(uint8_t* byte, uint8_t position) const {
|
|
||||||
if(position > 7) {
|
|
||||||
#if FSFW_CPP_OSTREAM_ENABLED == 1
|
|
||||||
sif::warning << "LocalPoolDataSetBase::bitSetter: Invalid position!"
|
|
||||||
<< std::endl;
|
|
||||||
#else
|
|
||||||
sif::printWarning("LocalPoolDataSetBase::bitSetter: "
|
|
||||||
"Invalid position!\n\r");
|
|
||||||
#endif
|
|
||||||
return;
|
|
||||||
}
|
|
||||||
uint8_t shiftNumber = position + (7 - 2 * position);
|
|
||||||
*byte |= 1 << shiftNumber;
|
|
||||||
}
|
|
||||||
|
|
||||||
void LocalPoolDataSetBase::setDiagnostic(bool isDiagnostics) {
|
void LocalPoolDataSetBase::setDiagnostic(bool isDiagnostics) {
|
||||||
this->diagnostic = isDiagnostics;
|
this->diagnostic = isDiagnostics;
|
||||||
}
|
}
|
||||||
@ -296,19 +282,6 @@ sid_t LocalPoolDataSetBase::getSid() const {
|
|||||||
return sid;
|
return sid;
|
||||||
}
|
}
|
||||||
|
|
||||||
bool LocalPoolDataSetBase::bitGetter(const uint8_t* byte,
|
|
||||||
uint8_t position) const {
|
|
||||||
if(position > 7) {
|
|
||||||
#if FSFW_CPP_OSTREAM_ENABLED == 1
|
|
||||||
sif::debug << "Pool Raw Access: Bit setting invalid position"
|
|
||||||
<< std::endl;
|
|
||||||
#endif
|
|
||||||
return false;
|
|
||||||
}
|
|
||||||
uint8_t shiftNumber = position + (7 - 2 * position);
|
|
||||||
return *byte & (1 << shiftNumber);
|
|
||||||
}
|
|
||||||
|
|
||||||
bool LocalPoolDataSetBase::isValid() const {
|
bool LocalPoolDataSetBase::isValid() const {
|
||||||
return this->valid;
|
return this->valid;
|
||||||
}
|
}
|
||||||
@ -328,3 +301,4 @@ object_id_t LocalPoolDataSetBase::getCreatorObjectId() {
|
|||||||
}
|
}
|
||||||
return objects::NO_OBJECT;
|
return objects::NO_OBJECT;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
@ -218,13 +218,6 @@ protected:
|
|||||||
*/
|
*/
|
||||||
ReturnValue_t unlockDataPool() override;
|
ReturnValue_t unlockDataPool() override;
|
||||||
|
|
||||||
/**
|
|
||||||
* Set n-th bit of a byte, with n being the position from 0
|
|
||||||
* (most significant bit) to 7 (least significant bit)
|
|
||||||
*/
|
|
||||||
void bitSetter(uint8_t* byte, uint8_t position) const;
|
|
||||||
bool bitGetter(const uint8_t* byte, uint8_t position) const;
|
|
||||||
|
|
||||||
PeriodicHousekeepingHelper* periodicHelper = nullptr;
|
PeriodicHousekeepingHelper* periodicHelper = nullptr;
|
||||||
LocalDataPoolManager* poolManager = nullptr;
|
LocalDataPoolManager* poolManager = nullptr;
|
||||||
|
|
||||||
|
@ -1,10 +1,12 @@
|
|||||||
#include "LocalPoolObjectBase.h"
|
#include "LocalPoolObjectBase.h"
|
||||||
#include "LocalDataPoolManager.h"
|
#include "LocalDataPoolManager.h"
|
||||||
#include "internal/HasLocalDpIFUserAttorney.h"
|
#include "AccessLocalPoolF.h"
|
||||||
#include "HasLocalDataPoolIF.h"
|
#include "HasLocalDataPoolIF.h"
|
||||||
|
#include "internal/HasLocalDpIFUserAttorney.h"
|
||||||
|
|
||||||
#include "../objectmanager/ObjectManagerIF.h"
|
#include "../objectmanager/ObjectManagerIF.h"
|
||||||
|
|
||||||
|
|
||||||
LocalPoolObjectBase::LocalPoolObjectBase(lp_id_t poolId, HasLocalDataPoolIF* hkOwner,
|
LocalPoolObjectBase::LocalPoolObjectBase(lp_id_t poolId, HasLocalDataPoolIF* hkOwner,
|
||||||
DataSetIF* dataSet, pool_rwm_t setReadWriteMode):
|
DataSetIF* dataSet, pool_rwm_t setReadWriteMode):
|
||||||
localPoolId(poolId), readWriteMode(setReadWriteMode) {
|
localPoolId(poolId), readWriteMode(setReadWriteMode) {
|
||||||
@ -93,6 +95,10 @@ void LocalPoolObjectBase::setReadWriteMode(pool_rwm_t newReadWriteMode) {
|
|||||||
void LocalPoolObjectBase::reportReadCommitError(const char* variableType,
|
void LocalPoolObjectBase::reportReadCommitError(const char* variableType,
|
||||||
ReturnValue_t error, bool read, object_id_t objectId, lp_id_t lpId) {
|
ReturnValue_t error, bool read, object_id_t objectId, lp_id_t lpId) {
|
||||||
#if FSFW_DISABLE_PRINTOUT == 0
|
#if FSFW_DISABLE_PRINTOUT == 0
|
||||||
|
const char* variablePrintout = variableType;
|
||||||
|
if(variablePrintout == nullptr) {
|
||||||
|
variablePrintout = "Unknown Type";
|
||||||
|
}
|
||||||
const char* type = nullptr;
|
const char* type = nullptr;
|
||||||
if(read) {
|
if(read) {
|
||||||
type = "read";
|
type = "read";
|
||||||
@ -119,12 +125,12 @@ void LocalPoolObjectBase::reportReadCommitError(const char* variableType,
|
|||||||
}
|
}
|
||||||
|
|
||||||
#if FSFW_CPP_OSTREAM_ENABLED == 1
|
#if FSFW_CPP_OSTREAM_ENABLED == 1
|
||||||
sif::warning << variableType << ": " << type << " call | " << errMsg << " | Owner: 0x"
|
sif::warning << variablePrintout << ": " << type << " call | " << errMsg << " | Owner: 0x"
|
||||||
<< std::hex << std::setw(8) << std::setfill('0') << objectId << std::dec
|
<< std::hex << std::setw(8) << std::setfill('0') << objectId << std::dec
|
||||||
<< " LPID: " << lpId << std::endl;
|
<< " LPID: " << lpId << std::endl;
|
||||||
#else
|
#else
|
||||||
sif::printWarning("%s: %s call | %s | Owner: 0x%08x LPID: %lu\n",
|
sif::printWarning("%s: %s call | %s | Owner: 0x%08x LPID: %lu\n",
|
||||||
variableType, type, errMsg, objectId, lpId);
|
variablePrintout, type, errMsg, objectId, lpId);
|
||||||
#endif /* FSFW_CPP_OSTREAM_ENABLED == 1 */
|
#endif /* FSFW_CPP_OSTREAM_ENABLED == 1 */
|
||||||
#endif /* FSFW_DISABLE_PRINTOUT == 0 */
|
#endif /* FSFW_DISABLE_PRINTOUT == 0 */
|
||||||
}
|
}
|
||||||
|
@ -17,12 +17,8 @@ public:
|
|||||||
* to generate housekeeping packets which are downlinked directly.
|
* to generate housekeeping packets which are downlinked directly.
|
||||||
* @return
|
* @return
|
||||||
*/
|
*/
|
||||||
virtual ReturnValue_t subscribeForPeriodicPacket(sid_t sid,
|
virtual ReturnValue_t subscribeForPeriodicPacket(sid_t sid, bool enableReporting,
|
||||||
bool enableReporting,
|
float collectionInterval, bool isDiagnostics, object_id_t packetDestination) = 0;
|
||||||
float collectionInterval, bool isDiagnostics,
|
|
||||||
object_id_t packetDestination) = 0;
|
|
||||||
|
|
||||||
|
|
||||||
/**
|
/**
|
||||||
* @brief Subscribe for the generation of packets if the dataset
|
* @brief Subscribe for the generation of packets if the dataset
|
||||||
* is marked as changed.
|
* is marked as changed.
|
||||||
@ -33,11 +29,8 @@ public:
|
|||||||
* @param packetDestination
|
* @param packetDestination
|
||||||
* @return
|
* @return
|
||||||
*/
|
*/
|
||||||
virtual ReturnValue_t subscribeForUpdatePackets(sid_t sid,
|
virtual ReturnValue_t subscribeForUpdatePacket(sid_t sid, bool reportingEnabled,
|
||||||
bool reportingEnabled,
|
bool isDiagnostics, object_id_t packetDestination) = 0;
|
||||||
bool isDiagnostics,
|
|
||||||
object_id_t packetDestination) = 0;
|
|
||||||
|
|
||||||
/**
|
/**
|
||||||
* @brief Subscribe for a notification message which will be sent
|
* @brief Subscribe for a notification message which will be sent
|
||||||
* if a dataset has changed.
|
* if a dataset has changed.
|
||||||
@ -52,10 +45,9 @@ public:
|
|||||||
* Otherwise, only an notification message is sent.
|
* Otherwise, only an notification message is sent.
|
||||||
* @return
|
* @return
|
||||||
*/
|
*/
|
||||||
virtual ReturnValue_t subscribeForSetUpdateMessages(const uint32_t setId,
|
virtual ReturnValue_t subscribeForSetUpdateMessage(const uint32_t setId,
|
||||||
object_id_t destinationObject, MessageQueueId_t targetQueueId,
|
object_id_t destinationObject, MessageQueueId_t targetQueueId,
|
||||||
bool generateSnapshot) = 0;
|
bool generateSnapshot) = 0;
|
||||||
|
|
||||||
/**
|
/**
|
||||||
* @brief Subscribe for an notification message which will be sent if a
|
* @brief Subscribe for an notification message which will be sent if a
|
||||||
* pool variable has changed.
|
* pool variable has changed.
|
||||||
@ -70,12 +62,9 @@ public:
|
|||||||
* only an notification message is sent.
|
* only an notification message is sent.
|
||||||
* @return
|
* @return
|
||||||
*/
|
*/
|
||||||
virtual ReturnValue_t subscribeForVariableUpdateMessages(
|
virtual ReturnValue_t subscribeForVariableUpdateMessage(const lp_id_t localPoolId,
|
||||||
const lp_id_t localPoolId,
|
object_id_t destinationObject, MessageQueueId_t targetQueueId,
|
||||||
object_id_t destinationObject,
|
|
||||||
MessageQueueId_t targetQueueId,
|
|
||||||
bool generateSnapshot) = 0;
|
bool generateSnapshot) = 0;
|
||||||
|
|
||||||
};
|
};
|
||||||
|
|
||||||
#endif /* FSFW_DATAPOOLLOCAL_PROVIDESDATAPOOLSUBSCRIPTION_H_ */
|
#endif /* FSFW_DATAPOOLLOCAL_PROVIDESDATAPOOLSUBSCRIPTION_H_ */
|
||||||
|
@ -24,7 +24,6 @@ private:
|
|||||||
return manager.getMutexHandle();
|
return manager.getMutexHandle();
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|
||||||
template<typename T> friend class LocalPoolVariable;
|
template<typename T> friend class LocalPoolVariable;
|
||||||
template<typename T, uint16_t vecSize> friend class LocalPoolVector;
|
template<typename T, uint16_t vecSize> friend class LocalPoolVector;
|
||||||
};
|
};
|
||||||
|
@ -21,8 +21,8 @@ static constexpr uint8_t INTERFACE_ID = CLASS_ID::LOCAL_POOL_OWNER_IF;
|
|||||||
static constexpr ReturnValue_t POOL_ENTRY_NOT_FOUND = MAKE_RETURN_CODE(0x00);
|
static constexpr ReturnValue_t POOL_ENTRY_NOT_FOUND = MAKE_RETURN_CODE(0x00);
|
||||||
static constexpr ReturnValue_t POOL_ENTRY_TYPE_CONFLICT = MAKE_RETURN_CODE(0x01);
|
static constexpr ReturnValue_t POOL_ENTRY_TYPE_CONFLICT = MAKE_RETURN_CODE(0x01);
|
||||||
|
|
||||||
//! This is the core data structure of the local data pools. Users should insert all desired
|
/** This is the core data structure of the local data pools. Users should insert all desired
|
||||||
//! pool variables, using the std::map interface.
|
pool variables, using the std::map interface. */
|
||||||
using DataPool = std::map<lp_id_t, PoolEntryIF*>;
|
using DataPool = std::map<lp_id_t, PoolEntryIF*>;
|
||||||
using DataPoolMapIter = DataPool::iterator;
|
using DataPoolMapIter = DataPool::iterator;
|
||||||
|
|
||||||
|
@ -7,6 +7,7 @@ target_sources(${LIB_FSFW_NAME}
|
|||||||
PeriodicOperationDivider.cpp
|
PeriodicOperationDivider.cpp
|
||||||
timevalOperations.cpp
|
timevalOperations.cpp
|
||||||
Type.cpp
|
Type.cpp
|
||||||
|
bitutility.cpp
|
||||||
)
|
)
|
||||||
|
|
||||||
add_subdirectory(math)
|
add_subdirectory(math)
|
33
globalfunctions/bitutility.cpp
Normal file
33
globalfunctions/bitutility.cpp
Normal file
@ -0,0 +1,33 @@
|
|||||||
|
#include "bitutility.h"
|
||||||
|
|
||||||
|
void bitutil::bitSet(uint8_t *byte, uint8_t position) {
|
||||||
|
if(position > 7) {
|
||||||
|
return;
|
||||||
|
}
|
||||||
|
uint8_t shiftNumber = position + (7 - 2 * position);
|
||||||
|
*byte |= 1 << shiftNumber;
|
||||||
|
}
|
||||||
|
|
||||||
|
void bitutil::bitToggle(uint8_t *byte, uint8_t position) {
|
||||||
|
if(position > 7) {
|
||||||
|
return;
|
||||||
|
}
|
||||||
|
uint8_t shiftNumber = position + (7 - 2 * position);
|
||||||
|
*byte ^= 1 << shiftNumber;
|
||||||
|
}
|
||||||
|
|
||||||
|
void bitutil::bitClear(uint8_t *byte, uint8_t position) {
|
||||||
|
if(position > 7) {
|
||||||
|
return;
|
||||||
|
}
|
||||||
|
uint8_t shiftNumber = position + (7 - 2 * position);
|
||||||
|
*byte &= ~(1 << shiftNumber);
|
||||||
|
}
|
||||||
|
|
||||||
|
bool bitutil::bitGet(const uint8_t *byte, uint8_t position) {
|
||||||
|
if(position > 7) {
|
||||||
|
return false;
|
||||||
|
}
|
||||||
|
uint8_t shiftNumber = position + (7 - 2 * position);
|
||||||
|
return *byte & (1 << shiftNumber);
|
||||||
|
}
|
18
globalfunctions/bitutility.h
Normal file
18
globalfunctions/bitutility.h
Normal file
@ -0,0 +1,18 @@
|
|||||||
|
#ifndef FSFW_GLOBALFUNCTIONS_BITUTIL_H_
|
||||||
|
#define FSFW_GLOBALFUNCTIONS_BITUTIL_H_
|
||||||
|
|
||||||
|
#include <cstdint>
|
||||||
|
|
||||||
|
namespace bitutil {
|
||||||
|
|
||||||
|
/* Helper functions for manipulating the individual bits of a byte.
|
||||||
|
Position refers to n-th bit of a byte, going from 0 (most significant bit) to
|
||||||
|
7 (least significant bit) */
|
||||||
|
void bitSet(uint8_t* byte, uint8_t position);
|
||||||
|
void bitToggle(uint8_t* byte, uint8_t position);
|
||||||
|
void bitClear(uint8_t* byte, uint8_t position);
|
||||||
|
bool bitGet(const uint8_t* byte, uint8_t position);
|
||||||
|
|
||||||
|
}
|
||||||
|
|
||||||
|
#endif /* FSFW_GLOBALFUNCTIONS_BITUTIL_H_ */
|
@ -10,7 +10,11 @@
|
|||||||
* which are destined to be downlinked into the store.
|
* which are destined to be downlinked into the store.
|
||||||
* @details
|
* @details
|
||||||
* The housekeeping packets are stored into the IPC store and forwarded
|
* The housekeeping packets are stored into the IPC store and forwarded
|
||||||
* to the designated housekeeping handler.
|
* to the designated housekeeping handler. The packet will consist of the following fields
|
||||||
|
* - SID (8 byte): Structure ID, with the first 4 bytes being the object ID and the last four
|
||||||
|
* bytes being the set ID
|
||||||
|
* - Housekeeping Data: The rest of the packet will be the serialized housekeeping data. A validity
|
||||||
|
* buffer might be appended at the end, depending on the set configuration.
|
||||||
*/
|
*/
|
||||||
class HousekeepingPacketDownlink: public SerialLinkedListAdapter<SerializeIF> {
|
class HousekeepingPacketDownlink: public SerialLinkedListAdapter<SerializeIF> {
|
||||||
public:
|
public:
|
||||||
|
@ -1,4 +1,4 @@
|
|||||||
#include "../../serviceinterface/ServiceInterfaceStream.h"
|
#include "../../serviceinterface/ServiceInterface.h"
|
||||||
#include "../../timemanager/Clock.h"
|
#include "../../timemanager/Clock.h"
|
||||||
|
|
||||||
#include <chrono>
|
#include <chrono>
|
||||||
|
@ -1,5 +1,6 @@
|
|||||||
#include "QueueMapManager.h"
|
#include "QueueMapManager.h"
|
||||||
|
|
||||||
|
#include "../../serviceinterface/ServiceInterface.h"
|
||||||
#include "../../ipc/MutexFactory.h"
|
#include "../../ipc/MutexFactory.h"
|
||||||
#include "../../ipc/MutexHelper.h"
|
#include "../../ipc/MutexHelper.h"
|
||||||
|
|
||||||
|
@ -1,8 +1,13 @@
|
|||||||
#include "LocalPoolOwnerBase.h"
|
#include "LocalPoolOwnerBase.h"
|
||||||
|
|
||||||
#include <catch2/catch_test_macros.hpp>
|
#include <catch2/catch_test_macros.hpp>
|
||||||
|
#include <catch2/catch_approx.hpp>
|
||||||
|
|
||||||
#include <fsfw/datapoollocal/HasLocalDataPoolIF.h>
|
#include <fsfw/datapoollocal/HasLocalDataPoolIF.h>
|
||||||
#include <fsfw/datapoollocal/StaticLocalDataSet.h>
|
#include <fsfw/datapoollocal/StaticLocalDataSet.h>
|
||||||
|
#include <fsfw/datapool/PoolReadHelper.h>
|
||||||
|
#include <fsfw/globalfunctions/bitutility.h>
|
||||||
|
|
||||||
#include <unittest/core/CatchDefinitions.h>
|
#include <unittest/core/CatchDefinitions.h>
|
||||||
|
|
||||||
TEST_CASE("LocalDataSet" , "[LocDataSetTest]") {
|
TEST_CASE("LocalDataSet" , "[LocDataSetTest]") {
|
||||||
@ -12,11 +17,193 @@ TEST_CASE("LocalDataSet" , "[LocDataSetTest]") {
|
|||||||
REQUIRE(poolOwner->initializeHkManager() == retval::CATCH_OK);
|
REQUIRE(poolOwner->initializeHkManager() == retval::CATCH_OK);
|
||||||
REQUIRE(poolOwner->initializeHkManagerAfterTaskCreation()
|
REQUIRE(poolOwner->initializeHkManagerAfterTaskCreation()
|
||||||
== retval::CATCH_OK);
|
== retval::CATCH_OK);
|
||||||
const uint32_t setId = 0;
|
LocalPoolStaticTestDataSet localSet;
|
||||||
|
|
||||||
SECTION("BasicTest") {
|
SECTION("BasicTest") {
|
||||||
StaticLocalDataSet<3> localSet = StaticLocalDataSet<3>(
|
/* Test some basic functions */
|
||||||
sid_t(objects::TEST_LOCAL_POOL_OWNER_BASE, setId));
|
CHECK(localSet.getLocalPoolIdsSerializedSize(false) == 3 * sizeof(lp_id_t));
|
||||||
|
CHECK(localSet.getLocalPoolIdsSerializedSize(true) ==
|
||||||
|
3 * sizeof(lp_id_t) + sizeof(uint8_t));
|
||||||
|
CHECK(localSet.getSid() == lpool::testSid);
|
||||||
|
CHECK(localSet.getCreatorObjectId() == objects::TEST_LOCAL_POOL_OWNER_BASE);
|
||||||
|
size_t maxSize = localSet.getLocalPoolIdsSerializedSize(true);
|
||||||
|
uint8_t localPoolIdBuff[maxSize];
|
||||||
|
/* Skip size field */
|
||||||
|
lp_id_t* lpIds = reinterpret_cast<lp_id_t*>(localPoolIdBuff + 1);
|
||||||
|
size_t serSize = 0;
|
||||||
|
uint8_t *localPoolIdBuffPtr = reinterpret_cast<uint8_t*>(localPoolIdBuff);
|
||||||
|
|
||||||
|
/* Test local pool ID serialization */
|
||||||
|
CHECK(localSet.serializeLocalPoolIds(&localPoolIdBuffPtr, &serSize,
|
||||||
|
maxSize, SerializeIF::Endianness::MACHINE) == retval::CATCH_OK);
|
||||||
|
CHECK(serSize == maxSize);
|
||||||
|
CHECK(localPoolIdBuff[0] == 3);
|
||||||
|
CHECK(lpIds[0] == localSet.localPoolVarUint8.getDataPoolId());
|
||||||
|
CHECK(lpIds[1] == localSet.localPoolVarFloat.getDataPoolId());
|
||||||
|
CHECK(lpIds[2] == localSet.localPoolUint16Vec.getDataPoolId());
|
||||||
|
/* Now serialize without fill count */
|
||||||
|
lpIds = reinterpret_cast<lp_id_t*>(localPoolIdBuff);
|
||||||
|
localPoolIdBuffPtr = localPoolIdBuff;
|
||||||
|
serSize = 0;
|
||||||
|
CHECK(localSet.serializeLocalPoolIds(&localPoolIdBuffPtr, &serSize,
|
||||||
|
maxSize, SerializeIF::Endianness::MACHINE, false) == retval::CATCH_OK);
|
||||||
|
CHECK(serSize == maxSize - sizeof(uint8_t));
|
||||||
|
CHECK(lpIds[0] == localSet.localPoolVarUint8.getDataPoolId());
|
||||||
|
CHECK(lpIds[1] == localSet.localPoolVarFloat.getDataPoolId());
|
||||||
|
CHECK(lpIds[2] == localSet.localPoolUint16Vec.getDataPoolId());
|
||||||
|
|
||||||
|
{
|
||||||
|
/* Test read operation. Values should be all zeros */
|
||||||
|
PoolReadHelper readHelper(&localSet);
|
||||||
|
REQUIRE(readHelper.getReadResult() == retval::CATCH_OK);
|
||||||
|
CHECK(not localSet.isValid());
|
||||||
|
CHECK(localSet.localPoolVarUint8.value == 0);
|
||||||
|
CHECK(not localSet.localPoolVarUint8.isValid());
|
||||||
|
CHECK(localSet.localPoolVarFloat.value == Catch::Approx(0.0));
|
||||||
|
CHECK(not localSet.localPoolVarUint8.isValid());
|
||||||
|
CHECK(localSet.localPoolUint16Vec.value[0] == 0);
|
||||||
|
CHECK(localSet.localPoolUint16Vec.value[1] == 0);
|
||||||
|
CHECK(localSet.localPoolUint16Vec.value[2] == 0);
|
||||||
|
CHECK(not localSet.localPoolVarUint8.isValid());
|
||||||
|
|
||||||
|
/* Now set new values, commit should be done by read helper automatically */
|
||||||
|
localSet.localPoolVarUint8 = 232;
|
||||||
|
localSet.localPoolVarFloat = -2324.322;
|
||||||
|
localSet.localPoolUint16Vec.value[0] = 232;
|
||||||
|
localSet.localPoolUint16Vec.value[1] = 23923;
|
||||||
|
localSet.localPoolUint16Vec.value[2] = 1;
|
||||||
|
localSet.setValidity(true, true);
|
||||||
}
|
}
|
||||||
|
|
||||||
|
/* Zero out some values for next test */
|
||||||
|
localSet.localPoolVarUint8 = 0;
|
||||||
|
localSet.localPoolVarFloat = 0;
|
||||||
|
|
||||||
|
{
|
||||||
|
/* Now we read again and check whether our zeroed values were overwritten with
|
||||||
|
the values in the pool */
|
||||||
|
PoolReadHelper readHelper(&localSet);
|
||||||
|
REQUIRE(readHelper.getReadResult() == retval::CATCH_OK);
|
||||||
|
CHECK(localSet.isValid());
|
||||||
|
CHECK(localSet.localPoolVarUint8.value == 232);
|
||||||
|
CHECK(localSet.localPoolVarUint8.isValid());
|
||||||
|
CHECK(localSet.localPoolVarFloat.value == Catch::Approx(-2324.322));
|
||||||
|
CHECK(localSet.localPoolVarFloat.isValid());
|
||||||
|
CHECK(localSet.localPoolUint16Vec.value[0] == 232);
|
||||||
|
CHECK(localSet.localPoolUint16Vec.value[1] == 23923);
|
||||||
|
CHECK(localSet.localPoolUint16Vec.value[2] == 1);
|
||||||
|
CHECK(localSet.localPoolUint16Vec.isValid());
|
||||||
|
|
||||||
|
/* Now we serialize these values into a buffer without the validity buffer */
|
||||||
|
localSet.setValidityBufferGeneration(false);
|
||||||
|
maxSize = localSet.getSerializedSize();
|
||||||
|
CHECK(maxSize == sizeof(uint8_t) + sizeof(uint16_t) * 3 + sizeof(float));
|
||||||
|
serSize = 0;
|
||||||
|
/* Already reserve additional space for validity buffer, will be needed later */
|
||||||
|
uint8_t buffer[maxSize + 1];
|
||||||
|
uint8_t* buffPtr = buffer;
|
||||||
|
CHECK(localSet.serialize(&buffPtr, &serSize, maxSize,
|
||||||
|
SerializeIF::Endianness::MACHINE) == retval::CATCH_OK);
|
||||||
|
uint8_t rawUint8 = buffer[0];
|
||||||
|
CHECK(rawUint8 == 232);
|
||||||
|
float rawFloat = 0.0;
|
||||||
|
std::memcpy(&rawFloat, buffer + sizeof(uint8_t), sizeof(float));
|
||||||
|
CHECK(rawFloat == Catch::Approx(-2324.322));
|
||||||
|
|
||||||
|
uint16_t rawUint16Vec[3];
|
||||||
|
std::memcpy(&rawUint16Vec, buffer + sizeof(uint8_t) + sizeof(float),
|
||||||
|
3 * sizeof(uint16_t));
|
||||||
|
CHECK(rawUint16Vec[0] == 232);
|
||||||
|
CHECK(rawUint16Vec[1] == 23923);
|
||||||
|
CHECK(rawUint16Vec[2] == 1);
|
||||||
|
|
||||||
|
size_t sizeToDeserialize = maxSize;
|
||||||
|
/* Now we zeros out the raw entries and deserialize back into the dataset */
|
||||||
|
std::memset(buffer, 0, sizeof(buffer));
|
||||||
|
const uint8_t* constBuffPtr = buffer;
|
||||||
|
CHECK(localSet.deSerialize(&constBuffPtr, &sizeToDeserialize,
|
||||||
|
SerializeIF::Endianness::MACHINE) == retval::CATCH_OK);
|
||||||
|
/* Check whether deserialization was successfull */
|
||||||
|
CHECK(localSet.localPoolVarUint8.value == 0);
|
||||||
|
CHECK(localSet.localPoolVarFloat.value == Catch::Approx(0.0));
|
||||||
|
CHECK(localSet.localPoolVarUint8.value == 0);
|
||||||
|
CHECK(localSet.localPoolUint16Vec.value[0] == 0);
|
||||||
|
CHECK(localSet.localPoolUint16Vec.value[1] == 0);
|
||||||
|
CHECK(localSet.localPoolUint16Vec.value[2] == 0);
|
||||||
|
/* Validity should be unchanged */
|
||||||
|
CHECK(localSet.localPoolVarUint8.isValid());
|
||||||
|
CHECK(localSet.localPoolVarFloat.isValid());
|
||||||
|
CHECK(localSet.localPoolUint16Vec.isValid());
|
||||||
|
|
||||||
|
/* Now we do the same process but with the validity buffer */
|
||||||
|
localSet.localPoolVarUint8 = 232;
|
||||||
|
localSet.localPoolVarFloat = -2324.322;
|
||||||
|
localSet.localPoolUint16Vec.value[0] = 232;
|
||||||
|
localSet.localPoolUint16Vec.value[1] = 23923;
|
||||||
|
localSet.localPoolUint16Vec.value[2] = 1;
|
||||||
|
localSet.localPoolVarUint8.setValid(true);
|
||||||
|
localSet.localPoolVarFloat.setValid(false);
|
||||||
|
localSet.localPoolUint16Vec.setValid(true);
|
||||||
|
localSet.setValidityBufferGeneration(true);
|
||||||
|
maxSize = localSet.getSerializedSize();
|
||||||
|
CHECK(maxSize == sizeof(uint8_t) + sizeof(uint16_t) * 3 + sizeof(float) + 1);
|
||||||
|
serSize = 0;
|
||||||
|
buffPtr = buffer;
|
||||||
|
CHECK(localSet.serialize(&buffPtr, &serSize, maxSize,
|
||||||
|
SerializeIF::Endianness::MACHINE) == retval::CATCH_OK);
|
||||||
|
CHECK(rawUint8 == 232);
|
||||||
|
std::memcpy(&rawFloat, buffer + sizeof(uint8_t), sizeof(float));
|
||||||
|
CHECK(rawFloat == Catch::Approx(-2324.322));
|
||||||
|
|
||||||
|
std::memcpy(&rawUint16Vec, buffer + sizeof(uint8_t) + sizeof(float),
|
||||||
|
3 * sizeof(uint16_t));
|
||||||
|
CHECK(rawUint16Vec[0] == 232);
|
||||||
|
CHECK(rawUint16Vec[1] == 23923);
|
||||||
|
CHECK(rawUint16Vec[2] == 1);
|
||||||
|
/* We can do it like this because the buffer only has one byte for
|
||||||
|
less than 8 variables */
|
||||||
|
uint8_t* validityByte = buffer + sizeof(buffer) - 1;
|
||||||
|
CHECK(bitutil::bitGet(validityByte, 0) == true);
|
||||||
|
CHECK(bitutil::bitGet(validityByte, 1) == false);
|
||||||
|
CHECK(bitutil::bitGet(validityByte, 2) == true);
|
||||||
|
|
||||||
|
/* Now we manipulate the validity buffer for the deserialization */
|
||||||
|
bitutil::bitClear(validityByte, 0);
|
||||||
|
bitutil::bitSet(validityByte, 1);
|
||||||
|
bitutil::bitClear(validityByte, 2);
|
||||||
|
/* Zero out everything except validity buffer */
|
||||||
|
std::memset(buffer, 0, sizeof(buffer) - 1);
|
||||||
|
sizeToDeserialize = maxSize;
|
||||||
|
constBuffPtr = buffer;
|
||||||
|
CHECK(localSet.deSerialize(&constBuffPtr, &sizeToDeserialize,
|
||||||
|
SerializeIF::Endianness::MACHINE) == retval::CATCH_OK);
|
||||||
|
/* Check whether deserialization was successfull */
|
||||||
|
CHECK(localSet.localPoolVarUint8.value == 0);
|
||||||
|
CHECK(localSet.localPoolVarFloat.value == Catch::Approx(0.0));
|
||||||
|
CHECK(localSet.localPoolVarUint8.value == 0);
|
||||||
|
CHECK(localSet.localPoolUint16Vec.value[0] == 0);
|
||||||
|
CHECK(localSet.localPoolUint16Vec.value[1] == 0);
|
||||||
|
CHECK(localSet.localPoolUint16Vec.value[2] == 0);
|
||||||
|
CHECK(not localSet.localPoolVarUint8.isValid());
|
||||||
|
CHECK(localSet.localPoolVarFloat.isValid());
|
||||||
|
CHECK(not localSet.localPoolUint16Vec.isValid());
|
||||||
|
|
||||||
|
}
|
||||||
|
|
||||||
|
/* Common fault test cases */
|
||||||
|
LocalPoolObjectBase* variableHandle = poolOwner->getPoolObjectHandle(lpool::uint32VarId);
|
||||||
|
CHECK(variableHandle != nullptr);
|
||||||
|
CHECK(localSet.registerVariable(variableHandle) ==
|
||||||
|
static_cast<int>(DataSetIF::DATA_SET_FULL));
|
||||||
|
variableHandle = nullptr;
|
||||||
|
REQUIRE(localSet.registerVariable(variableHandle) ==
|
||||||
|
static_cast<int>(DataSetIF::POOL_VAR_NULL));
|
||||||
|
|
||||||
|
}
|
||||||
|
|
||||||
|
/* we need to reset the subscription list because the pool owner
|
||||||
|
is a global object. */
|
||||||
|
CHECK(poolOwner->reset() == retval::CATCH_OK);
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|
||||||
|
@ -160,7 +160,7 @@ TEST_CASE("LocalPoolManagerTest" , "[LocManTest]") {
|
|||||||
CHECK(messageSent.getCommand() == static_cast<int>(
|
CHECK(messageSent.getCommand() == static_cast<int>(
|
||||||
HousekeepingMessage::UPDATE_NOTIFICATION_VARIABLE));
|
HousekeepingMessage::UPDATE_NOTIFICATION_VARIABLE));
|
||||||
/* Now subscribe for the dataset update (HK and update) again with subscription interface */
|
/* Now subscribe for the dataset update (HK and update) again with subscription interface */
|
||||||
REQUIRE(subscriptionIF->subscribeForSetUpdateMessages(lpool::testSetId,
|
REQUIRE(subscriptionIF->subscribeForSetUpdateMessage(lpool::testSetId,
|
||||||
objects::NO_OBJECT, objects::HK_RECEIVER_MOCK, false) == retval::CATCH_OK);
|
objects::NO_OBJECT, objects::HK_RECEIVER_MOCK, false) == retval::CATCH_OK);
|
||||||
REQUIRE(poolOwner->subscribeWrapperSetUpdateHk() == retval::CATCH_OK);
|
REQUIRE(poolOwner->subscribeWrapperSetUpdateHk() == retval::CATCH_OK);
|
||||||
|
|
||||||
@ -192,7 +192,7 @@ TEST_CASE("LocalPoolManagerTest" , "[LocManTest]") {
|
|||||||
|
|
||||||
/* we need to reset the subscription list because the pool owner
|
/* we need to reset the subscription list because the pool owner
|
||||||
is a global object. */
|
is a global object. */
|
||||||
poolOwner->resetSubscriptionList();
|
CHECK(poolOwner->reset() == retval::CATCH_OK);
|
||||||
mqMock->clearMessages(true);
|
mqMock->clearMessages(true);
|
||||||
}
|
}
|
||||||
|
|
||||||
|
@ -10,6 +10,7 @@
|
|||||||
#include <testcfg/objects/systemObjectList.h>
|
#include <testcfg/objects/systemObjectList.h>
|
||||||
#include <fsfw/datapoollocal/StaticLocalDataSet.h>
|
#include <fsfw/datapoollocal/StaticLocalDataSet.h>
|
||||||
#include <fsfw/unittest/tests/mocks/MessageQueueMockBase.h>
|
#include <fsfw/unittest/tests/mocks/MessageQueueMockBase.h>
|
||||||
|
#include "../../../datapool/PoolReadHelper.h"
|
||||||
|
|
||||||
namespace lpool {
|
namespace lpool {
|
||||||
static constexpr lp_id_t uint8VarId = 0;
|
static constexpr lp_id_t uint8VarId = 0;
|
||||||
@ -31,6 +32,23 @@ static const gp_id_t uint64Vec2Id = gp_id_t(objects::TEST_LOCAL_POOL_OWNER_BASE,
|
|||||||
}
|
}
|
||||||
|
|
||||||
|
|
||||||
|
class LocalPoolStaticTestDataSet: public StaticLocalDataSet<3> {
|
||||||
|
public:
|
||||||
|
LocalPoolStaticTestDataSet():
|
||||||
|
StaticLocalDataSet(lpool::testSid) {
|
||||||
|
}
|
||||||
|
|
||||||
|
LocalPoolStaticTestDataSet(HasLocalDataPoolIF* owner, uint32_t setId):
|
||||||
|
StaticLocalDataSet(owner, setId) {
|
||||||
|
}
|
||||||
|
|
||||||
|
lp_var_t<uint8_t> localPoolVarUint8 = lp_var_t<uint8_t>(lpool::uint8VarGpid, this);
|
||||||
|
lp_var_t<float> localPoolVarFloat = lp_var_t<float>(lpool::floatVarGpid, this);
|
||||||
|
lp_vec_t<uint16_t, 3> localPoolUint16Vec = lp_vec_t<uint16_t, 3>(lpool::uint16Vec3Gpid, this);
|
||||||
|
|
||||||
|
private:
|
||||||
|
};
|
||||||
|
|
||||||
class LocalPoolTestDataSet: public LocalDataSet {
|
class LocalPoolTestDataSet: public LocalDataSet {
|
||||||
public:
|
public:
|
||||||
LocalPoolTestDataSet():
|
LocalPoolTestDataSet():
|
||||||
@ -41,19 +59,6 @@ public:
|
|||||||
LocalDataSet(owner, setId, lpool::dataSetMaxVariables) {
|
LocalDataSet(owner, setId, lpool::dataSetMaxVariables) {
|
||||||
}
|
}
|
||||||
|
|
||||||
// ReturnValue_t assignPointers() {
|
|
||||||
// PoolVariableIF** rawVarArray = getContainer();
|
|
||||||
// localPoolVarUint8 = dynamic_cast<lp_var_t<uint8_t>*>(rawVarArray[0]);
|
|
||||||
// localPoolVarFloat = dynamic_cast<lp_var_t<float>*>(rawVarArray[1]);
|
|
||||||
// localPoolUint16Vec = dynamic_cast<lp_vec_t<uint16_t, 3>*>(
|
|
||||||
// rawVarArray[2]);
|
|
||||||
// if(localPoolVarUint8 == nullptr or localPoolVarFloat == nullptr or
|
|
||||||
// localPoolUint16Vec == nullptr) {
|
|
||||||
// return HasReturnvaluesIF::RETURN_FAILED;
|
|
||||||
// }
|
|
||||||
// return HasReturnvaluesIF::RETURN_OK;
|
|
||||||
// }
|
|
||||||
|
|
||||||
lp_var_t<uint8_t> localPoolVarUint8 = lp_var_t<uint8_t>(lpool::uint8VarGpid, this);
|
lp_var_t<uint8_t> localPoolVarUint8 = lp_var_t<uint8_t>(lpool::uint8VarGpid, this);
|
||||||
lp_var_t<float> localPoolVarFloat = lp_var_t<float>(lpool::floatVarGpid, this);
|
lp_var_t<float> localPoolVarFloat = lp_var_t<float>(lpool::floatVarGpid, this);
|
||||||
lp_vec_t<uint16_t, 3> localPoolUint16Vec = lp_vec_t<uint16_t, 3>(lpool::uint16Vec3Gpid, this);
|
lp_vec_t<uint16_t, 3> localPoolUint16Vec = lp_vec_t<uint16_t, 3>(lpool::uint16Vec3Gpid, this);
|
||||||
@ -164,25 +169,62 @@ public:
|
|||||||
}
|
}
|
||||||
|
|
||||||
ReturnValue_t subscribeWrapperSetUpdate() {
|
ReturnValue_t subscribeWrapperSetUpdate() {
|
||||||
return poolManager.subscribeForSetUpdateMessages(lpool::testSetId,
|
return poolManager.subscribeForSetUpdateMessage(lpool::testSetId,
|
||||||
objects::NO_OBJECT, objects::HK_RECEIVER_MOCK, false);
|
objects::NO_OBJECT, objects::HK_RECEIVER_MOCK, false);
|
||||||
}
|
}
|
||||||
|
|
||||||
ReturnValue_t subscribeWrapperSetUpdateSnapshot() {
|
ReturnValue_t subscribeWrapperSetUpdateSnapshot() {
|
||||||
return poolManager.subscribeForSetUpdateMessages(lpool::testSetId,
|
return poolManager.subscribeForSetUpdateMessage(lpool::testSetId,
|
||||||
objects::NO_OBJECT, objects::HK_RECEIVER_MOCK, true);
|
objects::NO_OBJECT, objects::HK_RECEIVER_MOCK, true);
|
||||||
}
|
}
|
||||||
|
|
||||||
ReturnValue_t subscribeWrapperSetUpdateHk(bool diagnostics = false) {
|
ReturnValue_t subscribeWrapperSetUpdateHk(bool diagnostics = false) {
|
||||||
return poolManager.subscribeForUpdatePackets(lpool::testSid, diagnostics,
|
return poolManager.subscribeForUpdatePacket(lpool::testSid, diagnostics,
|
||||||
false, objects::HK_RECEIVER_MOCK);
|
false, objects::HK_RECEIVER_MOCK);
|
||||||
}
|
}
|
||||||
|
|
||||||
ReturnValue_t subscribeWrapperVariableUpdate(lp_id_t localPoolId) {
|
ReturnValue_t subscribeWrapperVariableUpdate(lp_id_t localPoolId) {
|
||||||
return poolManager.subscribeForVariableUpdateMessages(localPoolId,
|
return poolManager.subscribeForVariableUpdateMessage(localPoolId,
|
||||||
MessageQueueIF::NO_QUEUE, objects::HK_RECEIVER_MOCK, false);
|
MessageQueueIF::NO_QUEUE, objects::HK_RECEIVER_MOCK, false);
|
||||||
}
|
}
|
||||||
|
|
||||||
|
ReturnValue_t reset() {
|
||||||
|
resetSubscriptionList();
|
||||||
|
ReturnValue_t status = HasReturnvaluesIF::RETURN_OK;
|
||||||
|
{
|
||||||
|
PoolReadHelper readHelper(&dataset);
|
||||||
|
if(readHelper.getReadResult() != HasReturnvaluesIF::RETURN_OK) {
|
||||||
|
status = readHelper.getReadResult();
|
||||||
|
}
|
||||||
|
dataset.localPoolVarUint8.value = 0;
|
||||||
|
dataset.localPoolVarFloat.value = 0.0;
|
||||||
|
dataset.localPoolUint16Vec.value[0] = 0;
|
||||||
|
dataset.localPoolUint16Vec.value[1] = 0;
|
||||||
|
dataset.localPoolUint16Vec.value[2] = 0;
|
||||||
|
dataset.setValidity(false, true);
|
||||||
|
}
|
||||||
|
|
||||||
|
{
|
||||||
|
PoolReadHelper readHelper(&testUint32);
|
||||||
|
if(readHelper.getReadResult() != HasReturnvaluesIF::RETURN_OK) {
|
||||||
|
status = readHelper.getReadResult();
|
||||||
|
}
|
||||||
|
testUint32.value = 0;
|
||||||
|
testUint32.setValid(false);
|
||||||
|
}
|
||||||
|
|
||||||
|
{
|
||||||
|
PoolReadHelper readHelper(&testInt64Vec);
|
||||||
|
if(readHelper.getReadResult() != HasReturnvaluesIF::RETURN_OK) {
|
||||||
|
status = readHelper.getReadResult();
|
||||||
|
}
|
||||||
|
testInt64Vec.value[0] = 0;
|
||||||
|
testInt64Vec.value[1] = 0;
|
||||||
|
testInt64Vec.setValid(false);
|
||||||
|
}
|
||||||
|
return status;
|
||||||
|
}
|
||||||
|
|
||||||
void resetSubscriptionList() {
|
void resetSubscriptionList() {
|
||||||
poolManager.clearReceiversList();
|
poolManager.clearReceiversList();
|
||||||
}
|
}
|
||||||
@ -191,14 +233,12 @@ public:
|
|||||||
LocalPoolTestDataSet dataset;
|
LocalPoolTestDataSet dataset;
|
||||||
private:
|
private:
|
||||||
|
|
||||||
lp_var_t<uint8_t> testUint8 = lp_var_t<uint8_t>(this, lpool::uint8VarId,
|
lp_var_t<uint8_t> testUint8 = lp_var_t<uint8_t>(this, lpool::uint8VarId);
|
||||||
&dataset);
|
lp_var_t<float> testFloat = lp_var_t<float>(this, lpool::floatVarId);
|
||||||
lp_var_t<float> testFloat = lp_var_t<float>(this, lpool::floatVarId,
|
|
||||||
&dataset);
|
|
||||||
lp_var_t<uint32_t> testUint32 = lp_var_t<uint32_t>(this, lpool::uint32VarId);
|
lp_var_t<uint32_t> testUint32 = lp_var_t<uint32_t>(this, lpool::uint32VarId);
|
||||||
|
|
||||||
lp_vec_t<uint16_t, 3> testUint16Vec = lp_vec_t<uint16_t, 3>(this,
|
lp_vec_t<uint16_t, 3> testUint16Vec = lp_vec_t<uint16_t, 3>(this,
|
||||||
lpool::uint16Vec3Id, &dataset);
|
lpool::uint16Vec3Id);
|
||||||
lp_vec_t<int64_t, 2> testInt64Vec = lp_vec_t<int64_t, 2>(this,
|
lp_vec_t<int64_t, 2> testInt64Vec = lp_vec_t<int64_t, 2>(this,
|
||||||
lpool::int64Vec2Id);
|
lpool::int64Vec2Id);
|
||||||
|
|
||||||
|
@ -118,6 +118,8 @@ TEST_CASE("LocalPoolVariable" , "[LocPoolVarTest]") {
|
|||||||
lpool::uint8VarId);
|
lpool::uint8VarId);
|
||||||
}
|
}
|
||||||
|
|
||||||
|
CHECK(poolOwner->reset() == retval::CATCH_OK);
|
||||||
|
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|
||||||
|
Loading…
Reference in New Issue
Block a user