eive-obsw/mission/devices/PCDUHandler.cpp

453 lines
18 KiB
C++
Raw Normal View History

2021-01-23 17:22:40 +01:00
#include "PCDUHandler.h"
2022-01-17 15:58:27 +01:00
#include <OBSWConfig.h>
#include <devices/powerSwitcherList.h>
#include <fsfw/datapool/PoolReadGuard.h>
#include <fsfw/housekeeping/HousekeepingSnapshot.h>
#include <fsfw/ipc/MutexFactory.h>
2022-01-17 15:58:27 +01:00
#include <fsfw/ipc/QueueFactory.h>
#include <mission/devices/devicedefinitions/GomSpacePackets.h>
2022-01-17 15:58:27 +01:00
PCDUHandler::PCDUHandler(object_id_t setObjectId, size_t cmdQueueSize)
: SystemObject(setObjectId),
poolManager(this, nullptr),
2022-04-07 19:48:09 +02:00
pdu1CoreHk(this),
pdu2CoreHk(this),
switcherSet(this),
2022-01-17 15:58:27 +01:00
cmdQueueSize(cmdQueueSize) {
auto mqArgs = MqArgs(setObjectId, static_cast<void*>(this));
2022-01-17 15:58:27 +01:00
commandQueue = QueueFactory::instance()->createMessageQueue(
cmdQueueSize, MessageQueueMessage::MAX_MESSAGE_SIZE, &mqArgs);
pwrMutex = MutexFactory::instance()->createMutex();
2021-01-23 17:22:40 +01:00
}
2022-01-17 15:58:27 +01:00
PCDUHandler::~PCDUHandler() {}
2021-01-23 17:22:40 +01:00
2021-01-28 14:55:21 +01:00
ReturnValue_t PCDUHandler::performOperation(uint8_t counter) {
2022-01-17 15:58:27 +01:00
if (counter == DeviceHandlerIF::PERFORM_OPERATION) {
readCommandQueue();
2022-08-24 17:27:47 +02:00
return returnvalue::OK;
2022-01-17 15:58:27 +01:00
}
2022-08-24 17:27:47 +02:00
return returnvalue::OK;
2021-01-28 14:55:21 +01:00
}
ReturnValue_t PCDUHandler::initialize() {
2022-01-17 15:58:27 +01:00
ReturnValue_t result;
IPCStore = ObjectManager::instance()->get<StorageManagerIF>(objects::IPC_STORE);
if (IPCStore == nullptr) {
return ObjectManagerIF::CHILD_INIT_FAILED;
}
result = poolManager.initialize(commandQueue);
2022-08-24 17:27:47 +02:00
if (result != returnvalue::OK) {
2022-01-17 15:58:27 +01:00
return result;
}
/* Subscribing for housekeeping table update messages of the PDU2 */
HasLocalDataPoolIF* pdu2Handler =
ObjectManager::instance()->get<HasLocalDataPoolIF>(objects::PDU2_HANDLER);
if (pdu2Handler == nullptr) {
sif::error << "PCDUHandler::initialize: Invalid pdu2Handler" << std::endl;
2022-08-24 17:27:47 +02:00
return returnvalue::FAILED;
2022-01-17 15:58:27 +01:00
}
result = pdu2Handler->getSubscriptionInterface()->subscribeForSetUpdateMessage(
2022-10-19 10:46:57 +02:00
static_cast<uint32_t>(P60System::SetIds::CORE), this->getObjectId(), commandQueue->getId(),
true);
2022-08-24 17:27:47 +02:00
if (result != returnvalue::OK) {
2022-01-17 15:58:27 +01:00
sif::error << "PCDUHandler::initialize: Failed to subscribe for set update messages from "
<< "PDU2Handler" << std::endl;
return result;
}
/* Subscribing for housekeeping table update messages of the PDU1 */
HasLocalDataPoolIF* pdu1Handler =
ObjectManager::instance()->get<HasLocalDataPoolIF>(objects::PDU1_HANDLER);
if (pdu1Handler == nullptr) {
sif::error << "PCDUHandler::initialize: Invalid pdu1Handler" << std::endl;
2022-08-24 17:27:47 +02:00
return returnvalue::FAILED;
2022-01-17 15:58:27 +01:00
}
result = pdu1Handler->getSubscriptionInterface()->subscribeForSetUpdateMessage(
2022-10-19 10:46:57 +02:00
static_cast<uint32_t>(P60System::SetIds::CORE), this->getObjectId(), commandQueue->getId(),
true);
2022-08-24 17:27:47 +02:00
if (result != returnvalue::OK) {
2022-01-17 15:58:27 +01:00
sif::error << "PCDUHandler::initialize: Failed to subscribe for set update messages from "
<< "PDU1Handler" << std::endl;
return result;
}
2022-08-24 17:27:47 +02:00
return returnvalue::OK;
2021-01-28 14:55:21 +01:00
}
void PCDUHandler::initializeSwitchStates() {
2022-04-07 19:48:09 +02:00
using namespace pcdu;
try {
for (uint8_t idx = 0; idx < NUMBER_OF_SWITCHES; idx++) {
if (idx < PDU::CHANNELS_LEN) {
switchStates[idx] = INIT_SWITCHES_PDU1.at(idx);
} else {
switchStates[idx] = INIT_SWITCHES_PDU2.at(idx - PDU::CHANNELS_LEN);
}
2022-04-07 19:48:09 +02:00
}
} catch (const std::out_of_range& err) {
sif::error << "PCDUHandler::initializeSwitchStates: " << err.what() << std::endl;
}
}
2021-01-28 14:55:21 +01:00
void PCDUHandler::readCommandQueue() {
2022-08-24 17:27:47 +02:00
ReturnValue_t result = returnvalue::OK;
2022-01-17 15:58:27 +01:00
CommandMessage command;
2022-08-24 17:27:47 +02:00
for (result = commandQueue->receiveMessage(&command); result == returnvalue::OK;
result = commandQueue->receiveMessage(&command)) {
result = poolManager.handleHousekeepingMessage(&command);
2022-08-24 17:27:47 +02:00
if (result == returnvalue::OK) {
continue;
}
2022-01-17 15:58:27 +01:00
}
2021-01-28 14:55:21 +01:00
}
2022-01-17 15:58:27 +01:00
MessageQueueId_t PCDUHandler::getCommandQueue() const { return commandQueue->getId(); }
2021-01-28 14:55:21 +01:00
void PCDUHandler::handleChangedDataset(sid_t sid, store_address_t storeId, bool* clearMessage) {
2022-10-18 11:01:33 +02:00
if (sid == sid_t(objects::PDU2_HANDLER, static_cast<uint32_t>(P60System::SetIds::CORE))) {
2022-04-07 19:48:09 +02:00
updateHkTableDataset(storeId, &pdu2CoreHk, &timeStampPdu2HkDataset);
2022-01-17 15:58:27 +01:00
updatePdu2SwitchStates();
2022-10-19 10:46:57 +02:00
} else if (sid == sid_t(objects::PDU1_HANDLER, static_cast<uint32_t>(P60System::SetIds::CORE))) {
2022-04-07 19:48:09 +02:00
updateHkTableDataset(storeId, &pdu1CoreHk, &timeStampPdu1HkDataset);
2022-01-17 15:58:27 +01:00
updatePdu1SwitchStates();
} else {
sif::error << "PCDUHandler::handleChangedDataset: Invalid sid" << std::endl;
}
2021-01-28 14:55:21 +01:00
}
2022-01-17 15:58:27 +01:00
void PCDUHandler::updateHkTableDataset(store_address_t storeId, LocalPoolDataSetBase* dataset,
CCSDSTime::CDS_short* datasetTimeStamp) {
ReturnValue_t result;
HousekeepingSnapshot packetUpdate(reinterpret_cast<uint8_t*>(datasetTimeStamp),
sizeof(CCSDSTime::CDS_short), dataset);
2022-04-12 16:11:04 +02:00
const uint8_t* packet_ptr = nullptr;
size_t size = 0;
2022-01-17 15:58:27 +01:00
result = IPCStore->getData(storeId, &packet_ptr, &size);
2022-08-24 17:27:47 +02:00
if (result != returnvalue::OK) {
2022-01-17 15:58:27 +01:00
sif::error << "PCDUHandler::updateHkTableDataset: Failed to get data from IPCStore."
<< std::endl;
}
result = packetUpdate.deSerialize(&packet_ptr, &size, SerializeIF::Endianness::MACHINE);
2022-08-24 17:27:47 +02:00
if (result != returnvalue::OK) {
2022-01-17 15:58:27 +01:00
sif::error << "PCDUHandler::updateHkTableDataset: Failed to deserialize received packet "
"in hk table dataset"
<< std::endl;
}
result = IPCStore->deleteData(storeId);
2022-08-24 17:27:47 +02:00
if (result != returnvalue::OK) {
2022-01-17 15:58:27 +01:00
sif::error << "PCDUHandler::updateHkTableDataset: Failed to delete data in IPCStore"
<< std::endl;
}
2021-02-06 11:57:45 +01:00
}
void PCDUHandler::updatePdu2SwitchStates() {
2022-04-07 19:48:09 +02:00
using namespace pcdu;
using namespace PDU2;
GOMSPACE::Pdu pdu = GOMSPACE::Pdu::PDU2;
2022-04-07 19:48:09 +02:00
PoolReadGuard rg0(&switcherSet);
2022-08-24 17:27:47 +02:00
if (rg0.getReadResult() == returnvalue::OK) {
2022-04-07 19:48:09 +02:00
for (uint8_t idx = 0; idx < PDU::CHANNELS_LEN; idx++) {
switcherSet.pdu2Switches[idx] = pdu2CoreHk.outputEnables[idx];
}
MutexGuard mg(pwrMutex);
2022-04-07 19:48:09 +02:00
checkAndUpdateSwitch(pdu, Switches::PDU2_CH0_Q7S, pdu2CoreHk.outputEnables[Channels::Q7S]);
checkAndUpdateSwitch(pdu, Switches::PDU2_CH1_PL_PCDU_BATT_0_14V8,
2022-04-07 19:48:09 +02:00
pdu2CoreHk.outputEnables[Channels::PAYLOAD_PCDU_CH1]);
checkAndUpdateSwitch(pdu, Switches::PDU2_CH2_RW_5V, pdu2CoreHk.outputEnables[Channels::RW]);
checkAndUpdateSwitch(pdu, Switches::PDU2_CH3_TCS_BOARD_HEATER_IN_8V,
2022-04-07 19:48:09 +02:00
pdu2CoreHk.outputEnables[Channels::TCS_HEATER_IN]);
checkAndUpdateSwitch(pdu, Switches::PDU2_CH4_SUS_REDUNDANT_3V3,
2022-04-07 19:48:09 +02:00
pdu2CoreHk.outputEnables[Channels::SUS_REDUNDANT]);
checkAndUpdateSwitch(pdu, Switches::PDU2_CH5_DEPLOYMENT_MECHANISM_8V,
2022-04-07 19:48:09 +02:00
pdu2CoreHk.outputEnables[Channels::DEPY_MECHANISM]);
checkAndUpdateSwitch(pdu, Switches::PDU2_CH6_PL_PCDU_BATT_1_14V8,
2022-04-07 19:48:09 +02:00
pdu2CoreHk.outputEnables[Channels::PAYLOAD_PCDU_CH6]);
checkAndUpdateSwitch(pdu, Switches::PDU2_CH7_ACS_BOARD_SIDE_B_3V3,
2022-04-07 19:48:09 +02:00
pdu2CoreHk.outputEnables[Channels::ACS_B_SIDE]);
checkAndUpdateSwitch(pdu, Switches::PDU2_CH8_PAYLOAD_CAMERA,
2022-04-07 19:48:09 +02:00
pdu2CoreHk.outputEnables[Channels::PAYLOAD_CAMERA]);
if (firstSwitchInfoPdu2) {
firstSwitchInfoPdu2 = false;
}
2022-01-17 15:58:27 +01:00
} else {
sif::debug << "PCDUHandler::updatePdu2SwitchStates: Failed to read PDU2 Hk Dataset"
<< std::endl;
}
}
void PCDUHandler::updatePdu1SwitchStates() {
2022-04-07 19:48:09 +02:00
using namespace pcdu;
using namespace PDU1;
PoolReadGuard rg0(&switcherSet);
GOMSPACE::Pdu pdu = GOMSPACE::Pdu::PDU1;
2022-08-24 17:27:47 +02:00
if (rg0.getReadResult() == returnvalue::OK) {
2022-04-07 19:48:09 +02:00
for (uint8_t idx = 0; idx < PDU::CHANNELS_LEN; idx++) {
switcherSet.pdu1Switches[idx] = pdu1CoreHk.outputEnables[idx];
}
MutexGuard mg(pwrMutex);
checkAndUpdateSwitch(pdu, Switches::PDU1_CH0_TCS_BOARD_3V3,
2022-04-07 19:48:09 +02:00
pdu1CoreHk.outputEnables[Channels::TCS_BOARD_3V3]);
checkAndUpdateSwitch(pdu, Switches::PDU1_CH1_SYRLINKS_12V,
2022-04-07 19:48:09 +02:00
pdu1CoreHk.outputEnables[Channels::SYRLINKS]);
checkAndUpdateSwitch(pdu, Switches::PDU1_CH2_STAR_TRACKER_5V,
2022-04-07 19:48:09 +02:00
pdu1CoreHk.outputEnables[Channels::STR]);
checkAndUpdateSwitch(pdu, Switches::PDU1_CH3_MGT_5V, pdu1CoreHk.outputEnables[Channels::MGT]);
checkAndUpdateSwitch(pdu, Switches::PDU1_CH4_SUS_NOMINAL_3V3,
2022-04-07 19:48:09 +02:00
pdu1CoreHk.outputEnables[Channels::SUS_NOMINAL]);
checkAndUpdateSwitch(pdu, Switches::PDU1_CH5_SOLAR_CELL_EXP_5V,
2022-04-07 19:48:09 +02:00
pdu1CoreHk.outputEnables[Channels::SOL_CELL_EXPERIMENT]);
checkAndUpdateSwitch(pdu, Switches::PDU1_CH6_PLOC_12V,
pdu1CoreHk.outputEnables[Channels::PLOC]);
checkAndUpdateSwitch(pdu, Switches::PDU1_CH7_ACS_A_SIDE_3V3,
2022-04-07 19:48:09 +02:00
pdu1CoreHk.outputEnables[Channels::ACS_A_SIDE]);
checkAndUpdateSwitch(pdu, Switches::PDU1_CH8_UNOCCUPIED,
2022-04-07 19:48:09 +02:00
pdu1CoreHk.outputEnables[Channels::UNUSED]);
if (firstSwitchInfoPdu1) {
firstSwitchInfoPdu1 = false;
}
2022-01-17 15:58:27 +01:00
} else {
sif::debug << "PCDUHandler::updatePdu1SwitchStates: Failed to read dataset" << std::endl;
}
}
2022-01-17 15:58:27 +01:00
LocalDataPoolManager* PCDUHandler::getHkManagerHandle() { return &poolManager; }
2021-01-28 14:55:21 +01:00
2022-03-30 12:22:49 +02:00
ReturnValue_t PCDUHandler::sendSwitchCommand(uint8_t switchNr, ReturnValue_t onOff) {
2022-04-07 19:48:09 +02:00
using namespace pcdu;
2022-01-17 15:58:27 +01:00
ReturnValue_t result;
uint16_t memoryAddress = 0;
2022-01-17 15:58:27 +01:00
size_t parameterValueSize = sizeof(uint8_t);
uint8_t parameterValue = 0;
GomspaceDeviceHandler* pdu = nullptr;
2021-01-28 14:55:21 +01:00
2022-01-17 15:58:27 +01:00
switch (switchNr) {
2022-04-07 19:48:09 +02:00
case pcdu::PDU1_CH0_TCS_BOARD_3V3: {
memoryAddress = PDU1::CONFIG_ADDRESS_OUT_EN_TCS_BOARD_3V3;
pdu = ObjectManager::instance()->get<GomspaceDeviceHandler>(objects::PDU1_HANDLER);
break;
}
2022-04-07 19:48:09 +02:00
case pcdu::PDU1_CH1_SYRLINKS_12V: {
memoryAddress = PDU1::CONFIG_ADDRESS_OUT_EN_SYRLINKS;
pdu = ObjectManager::instance()->get<GomspaceDeviceHandler>(objects::PDU1_HANDLER);
break;
}
2022-04-07 19:48:09 +02:00
case pcdu::PDU1_CH2_STAR_TRACKER_5V: {
memoryAddress = PDU1::CONFIG_ADDRESS_OUT_EN_STAR_TRACKER;
pdu = ObjectManager::instance()->get<GomspaceDeviceHandler>(objects::PDU1_HANDLER);
break;
}
2022-04-07 19:48:09 +02:00
case pcdu::PDU1_CH3_MGT_5V: {
memoryAddress = PDU1::CONFIG_ADDRESS_OUT_EN_MGT;
pdu = ObjectManager::instance()->get<GomspaceDeviceHandler>(objects::PDU1_HANDLER);
break;
}
2022-04-07 19:48:09 +02:00
case pcdu::PDU1_CH4_SUS_NOMINAL_3V3: {
memoryAddress = PDU1::CONFIG_ADDRESS_OUT_EN_SUS_NOMINAL;
pdu = ObjectManager::instance()->get<GomspaceDeviceHandler>(objects::PDU1_HANDLER);
break;
}
2022-04-07 19:48:09 +02:00
case pcdu::PDU1_CH5_SOLAR_CELL_EXP_5V: {
memoryAddress = PDU1::CONFIG_ADDRESS_OUT_EN_SOLAR_CELL_EXP;
pdu = ObjectManager::instance()->get<GomspaceDeviceHandler>(objects::PDU1_HANDLER);
break;
}
2022-04-07 19:48:09 +02:00
case pcdu::PDU1_CH6_PLOC_12V: {
memoryAddress = PDU1::CONFIG_ADDRESS_OUT_EN_PLOC;
pdu = ObjectManager::instance()->get<GomspaceDeviceHandler>(objects::PDU1_HANDLER);
break;
}
2022-04-07 19:48:09 +02:00
case pcdu::PDU1_CH7_ACS_A_SIDE_3V3: {
memoryAddress = PDU1::CONFIG_ADDRESS_OUT_EN_ACS_BOARD_SIDE_A;
pdu = ObjectManager::instance()->get<GomspaceDeviceHandler>(objects::PDU1_HANDLER);
break;
}
2022-04-07 19:48:09 +02:00
case pcdu::PDU1_CH8_UNOCCUPIED: {
memoryAddress = PDU1::CONFIG_ADDRESS_OUT_EN_CHANNEL8;
pdu = ObjectManager::instance()->get<GomspaceDeviceHandler>(objects::PDU1_HANDLER);
break;
}
// This is a dangerous command. Reject/Igore it for now
2022-04-07 19:48:09 +02:00
case pcdu::PDU2_CH0_Q7S: {
2022-08-24 17:27:47 +02:00
return returnvalue::FAILED;
// memoryAddress = PDU2::CONFIG_ADDRESS_OUT_EN_Q7S;
// pdu = ObjectManager::instance()->get<GomspaceDeviceHandler>(objects::PDU2_HANDLER);
// break;
}
2022-04-07 19:48:09 +02:00
case pcdu::PDU2_CH1_PL_PCDU_BATT_0_14V8: {
memoryAddress = PDU2::CONFIG_ADDRESS_OUT_EN_PAYLOAD_PCDU_CH1;
pdu = ObjectManager::instance()->get<GomspaceDeviceHandler>(objects::PDU2_HANDLER);
break;
}
2022-04-07 19:48:09 +02:00
case pcdu::PDU2_CH2_RW_5V: {
memoryAddress = PDU2::CONFIG_ADDRESS_OUT_EN_RW;
pdu = ObjectManager::instance()->get<GomspaceDeviceHandler>(objects::PDU2_HANDLER);
break;
}
2022-04-07 19:48:09 +02:00
case pcdu::PDU2_CH3_TCS_BOARD_HEATER_IN_8V: {
2022-01-17 15:58:27 +01:00
memoryAddress = PDU2::CONFIG_ADDRESS_OUT_EN_TCS_BOARD_HEATER_IN;
pdu = ObjectManager::instance()->get<GomspaceDeviceHandler>(objects::PDU2_HANDLER);
break;
}
2022-04-07 19:48:09 +02:00
case pcdu::PDU2_CH4_SUS_REDUNDANT_3V3: {
memoryAddress = PDU2::CONFIG_ADDRESS_OUT_EN_SUS_REDUNDANT;
pdu = ObjectManager::instance()->get<GomspaceDeviceHandler>(objects::PDU2_HANDLER);
break;
}
2022-04-07 19:48:09 +02:00
case pcdu::PDU2_CH5_DEPLOYMENT_MECHANISM_8V: {
2022-01-17 15:58:27 +01:00
memoryAddress = PDU2::CONFIG_ADDRESS_OUT_EN_DEPLOYMENT_MECHANISM;
pdu = ObjectManager::instance()->get<GomspaceDeviceHandler>(objects::PDU2_HANDLER);
break;
}
2022-04-07 19:48:09 +02:00
case pcdu::PDU2_CH6_PL_PCDU_BATT_1_14V8: {
memoryAddress = PDU2::CONFIG_ADDRESS_OUT_EN_PAYLOAD_PCDU_CH6;
pdu = ObjectManager::instance()->get<GomspaceDeviceHandler>(objects::PDU2_HANDLER);
break;
}
2022-04-07 19:48:09 +02:00
case pcdu::PDU2_CH7_ACS_BOARD_SIDE_B_3V3: {
memoryAddress = PDU2::CONFIG_ADDRESS_OUT_EN_ACS_BOARD_SIDE_B;
pdu = ObjectManager::instance()->get<GomspaceDeviceHandler>(objects::PDU2_HANDLER);
break;
}
2022-04-07 19:48:09 +02:00
case pcdu::PDU2_CH8_PAYLOAD_CAMERA: {
memoryAddress = PDU2::CONFIG_ADDRESS_OUT_EN_PAYLOAD_CAMERA;
pdu = ObjectManager::instance()->get<GomspaceDeviceHandler>(objects::PDU2_HANDLER);
break;
}
2022-12-21 13:40:31 +01:00
case pcdu::P60_DOCK_5V_STACK: {
memoryAddress = P60Dock::CONFIG_ADDRESS_OUT_EN_5V_STACK;
pdu = ObjectManager::instance()->get<GomspaceDeviceHandler>(objects::P60DOCK_HANDLER);
break;
}
default: {
2022-01-17 15:58:27 +01:00
sif::error << "PCDUHandler::sendSwitchCommand: Invalid switch number " << std::endl;
2022-08-24 17:27:47 +02:00
return returnvalue::FAILED;
}
2022-01-17 15:58:27 +01:00
}
2021-01-28 14:55:21 +01:00
2022-01-17 15:58:27 +01:00
switch (onOff) {
2021-01-28 14:55:21 +01:00
case PowerSwitchIF::SWITCH_ON:
2022-01-17 15:58:27 +01:00
parameterValue = 1;
break;
2021-01-28 14:55:21 +01:00
case PowerSwitchIF::SWITCH_OFF:
2022-01-17 15:58:27 +01:00
parameterValue = 0;
break;
2021-01-28 14:55:21 +01:00
default:
2022-01-17 15:58:27 +01:00
sif::error << "PCDUHandler::sendSwitchCommand: Invalid state commanded" << std::endl;
2022-08-24 17:27:47 +02:00
return returnvalue::FAILED;
2022-01-17 15:58:27 +01:00
}
2021-01-28 14:55:21 +01:00
2022-01-17 15:58:27 +01:00
GomspaceSetParamMessage setParamMessage(memoryAddress, &parameterValue, parameterValueSize);
2021-01-28 14:55:21 +01:00
2022-01-17 15:58:27 +01:00
size_t serializedLength = 0;
uint8_t command[4];
uint8_t* commandPtr = command;
size_t maxSize = sizeof(command);
setParamMessage.serialize(&commandPtr, &serializedLength, maxSize, SerializeIF::Endianness::BIG);
2021-01-28 14:55:21 +01:00
2022-01-17 15:58:27 +01:00
store_address_t storeAddress;
result = IPCStore->addData(&storeAddress, command, sizeof(command));
2021-01-28 14:55:21 +01:00
2022-01-17 15:58:27 +01:00
CommandMessage message;
ActionMessage::setCommand(&message, GOMSPACE::PARAM_SET, storeAddress);
2021-01-28 14:55:21 +01:00
2022-01-17 15:58:27 +01:00
result = commandQueue->sendMessage(pdu->getCommandQueue(), &message, 0);
2022-08-24 17:27:47 +02:00
if (result != returnvalue::OK) {
2022-01-17 15:58:27 +01:00
sif::debug << "PCDUHandler::sendSwitchCommand: Failed to send message to PDU Handler"
<< std::endl;
} else {
// Can't use trigger event because of const function constraint, but this hack seems to work
this->forwardEvent(power::SWITCH_CMD_SENT, parameterValue, switchNr);
2022-01-17 15:58:27 +01:00
}
2022-03-30 12:22:49 +02:00
return result;
2021-01-28 14:55:21 +01:00
}
2022-08-24 17:27:47 +02:00
ReturnValue_t PCDUHandler::sendFuseOnCommand(uint8_t fuseNr) { return returnvalue::OK; }
2022-01-17 15:58:27 +01:00
ReturnValue_t PCDUHandler::getSwitchState(uint8_t switchNr) const {
2022-04-07 19:48:09 +02:00
if (switchNr >= pcdu::NUMBER_OF_SWITCHES) {
2022-01-17 15:58:27 +01:00
sif::debug << "PCDUHandler::getSwitchState: Invalid switch number" << std::endl;
2022-08-24 17:27:47 +02:00
return returnvalue::FAILED;
2022-01-17 15:58:27 +01:00
}
pwrMutex->lockMutex();
uint8_t currentState = switchStates[switchNr];
pwrMutex->unlockMutex();
if (currentState == 1) {
2022-01-17 15:58:27 +01:00
return PowerSwitchIF::SWITCH_ON;
} else {
return PowerSwitchIF::SWITCH_OFF;
}
2021-01-28 14:55:21 +01:00
}
2022-08-24 17:27:47 +02:00
ReturnValue_t PCDUHandler::getFuseState(uint8_t fuseNr) const { return returnvalue::OK; }
2022-01-17 15:58:27 +01:00
uint32_t PCDUHandler::getSwitchDelayMs(void) const { return 20000; }
object_id_t PCDUHandler::getObjectId() const { return SystemObject::getObjectId(); }
ReturnValue_t PCDUHandler::initializeLocalDataPool(localpool::DataPool& localDataPoolMap,
LocalDataPoolManager& poolManager) {
2022-04-07 19:48:09 +02:00
using namespace pcdu;
localDataPoolMap.emplace(PoolIds::PDU1_SWITCHES, &pdu1Switches);
2022-04-12 16:11:04 +02:00
localDataPoolMap.emplace(PoolIds::PDU2_SWITCHES, &pdu2Switches);
2022-08-15 11:57:57 +02:00
poolManager.subscribeForRegularPeriodicPacket(
subdp::RegularHkPeriodicParams(switcherSet.getSid(), false, 5.0));
2022-08-24 17:27:47 +02:00
return returnvalue::OK;
2021-01-28 14:55:21 +01:00
}
ReturnValue_t PCDUHandler::initializeAfterTaskCreation() {
2022-01-17 15:58:27 +01:00
if (executingTask != nullptr) {
pstIntervalMs = executingTask->getPeriodMs();
}
this->poolManager.initializeAfterTaskCreation();
2021-01-28 14:55:21 +01:00
2022-01-17 15:58:27 +01:00
initializeSwitchStates();
2021-01-28 14:55:21 +01:00
2022-08-24 17:27:47 +02:00
return returnvalue::OK;
2021-01-28 14:55:21 +01:00
}
2022-01-17 15:58:27 +01:00
uint32_t PCDUHandler::getPeriodicOperationFrequency() const { return pstIntervalMs; }
2021-01-28 14:55:21 +01:00
2022-01-17 15:58:27 +01:00
void PCDUHandler::setTaskIF(PeriodicTaskIF* task) { executingTask = task; }
2021-01-28 14:55:21 +01:00
LocalPoolDataSetBase* PCDUHandler::getDataSetHandle(sid_t sid) {
2022-04-07 19:48:09 +02:00
if (sid == switcherSet.getSid()) {
return &switcherSet;
2022-01-17 15:58:27 +01:00
} else {
sif::error << "PCDUHandler::getDataSetHandle: Invalid sid" << std::endl;
return nullptr;
}
2021-01-28 14:55:21 +01:00
}
2022-04-07 19:48:09 +02:00
void PCDUHandler::checkAndUpdateSwitch(GOMSPACE::Pdu pdu, pcdu::Switches switchIdx,
uint8_t setValue) {
2022-04-07 19:48:09 +02:00
using namespace pcdu;
if (switchStates[switchIdx] != setValue) {
#if OBSW_INITIALIZE_SWITCHES == 1
// This code initializes the switches to the default init switch states on every reboot.
// This is not done by the PCDU unless it is power-cycled.
if (((pdu == GOMSPACE::Pdu::PDU1) and firstSwitchInfoPdu1) or
((pdu == GOMSPACE::Pdu::PDU2) and firstSwitchInfoPdu2)) {
ReturnValue_t state = PowerSwitchIF::SWITCH_OFF;
if (INIT_SWITCH_STATES[switchIdx] == ON) {
state = PowerSwitchIF::SWITCH_ON;
}
sendSwitchCommand(switchIdx, state);
} else {
triggerEvent(power::SWITCH_HAS_CHANGED, setValue, switchIdx);
}
#else
triggerEvent(power::SWITCH_HAS_CHANGED, setValue, switchIdx);
#endif
}
switchStates[switchIdx] = setValue;
}