some fixes for pl pcdu
This commit is contained in:
parent
42d3ebe1b0
commit
b44442b282
@ -6,8 +6,8 @@
|
|||||||
#include "OBSWConfig.h"
|
#include "OBSWConfig.h"
|
||||||
#include "fsfw/timemanager/Countdown.h"
|
#include "fsfw/timemanager/Countdown.h"
|
||||||
#include "linux/devices/devicedefinitions/StarTrackerDefinitions.h"
|
#include "linux/devices/devicedefinitions/StarTrackerDefinitions.h"
|
||||||
#include "mission/utility/Timestamp.h"
|
|
||||||
#include "mission/utility/ProgressPrinter.h"
|
#include "mission/utility/ProgressPrinter.h"
|
||||||
|
#include "mission/utility/Timestamp.h"
|
||||||
|
|
||||||
StrHelper::StrHelper(object_id_t objectId) : SystemObject(objectId) {}
|
StrHelper::StrHelper(object_id_t objectId) : SystemObject(objectId) {}
|
||||||
|
|
||||||
|
@ -204,7 +204,7 @@ void PayloadPcduHandler::doTransition(Mode_t modeFrom, Submode_t subModeFrom) {
|
|||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
void PayloadPcduHandler::doShutDown() { transitionBackToOff(); }
|
void PayloadPcduHandler::doShutDown() { transitionBackToOff(false); }
|
||||||
|
|
||||||
ReturnValue_t PayloadPcduHandler::buildNormalDeviceCommand(DeviceCommandId_t* id) {
|
ReturnValue_t PayloadPcduHandler::buildNormalDeviceCommand(DeviceCommandId_t* id) {
|
||||||
switch (adcState) {
|
switch (adcState) {
|
||||||
@ -388,7 +388,7 @@ void PayloadPcduHandler::enablePeriodicPrintout(bool enable, uint8_t divider) {
|
|||||||
opDivider.setDivider(divider);
|
opDivider.setDivider(divider);
|
||||||
}
|
}
|
||||||
|
|
||||||
void PayloadPcduHandler::transitionBackToOff() {
|
void PayloadPcduHandler::transitionBackToOff(bool notifyFdir) {
|
||||||
States currentState = state;
|
States currentState = state;
|
||||||
gpioIF->pullLow(gpioIds::PLPCDU_ENB_HPA);
|
gpioIF->pullLow(gpioIds::PLPCDU_ENB_HPA);
|
||||||
gpioIF->pullLow(gpioIds::PLPCDU_ENB_MPA);
|
gpioIF->pullLow(gpioIds::PLPCDU_ENB_MPA);
|
||||||
@ -401,9 +401,10 @@ void PayloadPcduHandler::transitionBackToOff() {
|
|||||||
state = States::PCDU_OFF;
|
state = States::PCDU_OFF;
|
||||||
adcState = AdcStates::OFF;
|
adcState = AdcStates::OFF;
|
||||||
setMode(MODE_OFF);
|
setMode(MODE_OFF);
|
||||||
// Notify FDIR
|
if (notifyFdir) {
|
||||||
triggerEvent(TRANSITION_BACK_TO_OFF, static_cast<uint32_t>(currentState));
|
triggerEvent(TRANSITION_BACK_TO_OFF, static_cast<uint32_t>(currentState));
|
||||||
}
|
}
|
||||||
|
}
|
||||||
|
|
||||||
void PayloadPcduHandler::checkAdcValues() {
|
void PayloadPcduHandler::checkAdcValues() {
|
||||||
using namespace plpcdu;
|
using namespace plpcdu;
|
||||||
@ -443,6 +444,10 @@ void PayloadPcduHandler::checkAdcValues() {
|
|||||||
}
|
}
|
||||||
params.getValue(PlPcduParameter::DRO_I_UPPER_BOUND_K, upperBound);
|
params.getValue(PlPcduParameter::DRO_I_UPPER_BOUND_K, upperBound);
|
||||||
if (not checkCurrent(adcSet.processed[I_DRO], upperBound, I_DRO_OUT_OF_BOUNDS)) {
|
if (not checkCurrent(adcSet.processed[I_DRO], upperBound, I_DRO_OUT_OF_BOUNDS)) {
|
||||||
|
#if OBSW_VERBOSE_LEVEL >= 1
|
||||||
|
sif::warning << "Detected out of bounds current for DRO: " << adcSet.processed[I_DRO]
|
||||||
|
<< ", Raw: " << adcSet.channels[I_DRO] << std::endl;
|
||||||
|
#endif
|
||||||
return;
|
return;
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
@ -524,7 +529,7 @@ bool PayloadPcduHandler::checkVoltage(float val, float lowerBound, float upperBo
|
|||||||
serializeFloat(p2, val);
|
serializeFloat(p2, val);
|
||||||
triggerEvent(event, tooLarge, p2);
|
triggerEvent(event, tooLarge, p2);
|
||||||
transitionOk = false;
|
transitionOk = false;
|
||||||
transitionBackToOff();
|
transitionBackToOff(true);
|
||||||
return false;
|
return false;
|
||||||
}
|
}
|
||||||
return true;
|
return true;
|
||||||
@ -536,7 +541,7 @@ bool PayloadPcduHandler::checkCurrent(float val, float upperBound, Event event)
|
|||||||
serializeFloat(p2, val);
|
serializeFloat(p2, val);
|
||||||
triggerEvent(event, true, p2);
|
triggerEvent(event, true, p2);
|
||||||
transitionOk = false;
|
transitionOk = false;
|
||||||
transitionBackToOff();
|
transitionBackToOff(true);
|
||||||
return false;
|
return false;
|
||||||
}
|
}
|
||||||
return true;
|
return true;
|
||||||
|
@ -128,7 +128,7 @@ class PayloadPcduHandler : public DeviceHandlerBase {
|
|||||||
void doStartUp() override;
|
void doStartUp() override;
|
||||||
void doShutDown() override;
|
void doShutDown() override;
|
||||||
// Main FDIR function which goes from any PL PCDU state back to all off
|
// Main FDIR function which goes from any PL PCDU state back to all off
|
||||||
void transitionBackToOff();
|
void transitionBackToOff(bool notifyFdir);
|
||||||
ReturnValue_t buildNormalDeviceCommand(DeviceCommandId_t* id) override;
|
ReturnValue_t buildNormalDeviceCommand(DeviceCommandId_t* id) override;
|
||||||
ReturnValue_t buildTransitionDeviceCommand(DeviceCommandId_t* id) override;
|
ReturnValue_t buildTransitionDeviceCommand(DeviceCommandId_t* id) override;
|
||||||
void fillCommandAndReplyMap() override;
|
void fillCommandAndReplyMap() override;
|
||||||
@ -145,6 +145,7 @@ class PayloadPcduHandler : public DeviceHandlerBase {
|
|||||||
void handleExtConvRead(const uint8_t* bufStart);
|
void handleExtConvRead(const uint8_t* bufStart);
|
||||||
void handlePrintout();
|
void handlePrintout();
|
||||||
void checkAdcValues();
|
void checkAdcValues();
|
||||||
|
void handleOutOfBoundsPrintout();
|
||||||
void checkJsonFileInit();
|
void checkJsonFileInit();
|
||||||
void stateMachineToNormal();
|
void stateMachineToNormal();
|
||||||
bool checkVoltage(float val, float lowerBound, float upperBound, Event event);
|
bool checkVoltage(float val, float lowerBound, float upperBound, Event event);
|
||||||
|
@ -70,7 +70,7 @@ static constexpr float R_SHUNT_HPA = 0.008;
|
|||||||
static constexpr float R_SHUNT_MPA = 0.015;
|
static constexpr float R_SHUNT_MPA = 0.015;
|
||||||
static constexpr float R_SHUNT_TX = 0.05;
|
static constexpr float R_SHUNT_TX = 0.05;
|
||||||
static constexpr float R_SHUNT_X8 = 0.015;
|
static constexpr float R_SHUNT_X8 = 0.015;
|
||||||
static constexpr float R_SHUNT_DRO = 0.022;
|
static constexpr float R_SHUNT_DRO = 0.22;
|
||||||
static constexpr float V_POS = 3.3;
|
static constexpr float V_POS = 3.3;
|
||||||
static constexpr float VOLTAGE_DIV_U_NEG = (49.9 + 27.4) / 27.4;
|
static constexpr float VOLTAGE_DIV_U_NEG = (49.9 + 27.4) / 27.4;
|
||||||
static constexpr float MAX122X_SCALE = MAX122X_VREF / MAX122X_BIT;
|
static constexpr float MAX122X_SCALE = MAX122X_VREF / MAX122X_BIT;
|
||||||
@ -88,7 +88,8 @@ static constexpr double NEG_V_UPPER_BOUND = -2.7;
|
|||||||
|
|
||||||
static constexpr double DRO_U_LOWER_BOUND = 5.0;
|
static constexpr double DRO_U_LOWER_BOUND = 5.0;
|
||||||
static constexpr double DRO_U_UPPER_BOUND = 7.0;
|
static constexpr double DRO_U_UPPER_BOUND = 7.0;
|
||||||
static constexpr double DRO_I_UPPER_BOUND = 40.0;
|
// Max Current DRO + Max Current Neg V | 40 + 15
|
||||||
|
static constexpr double DRO_I_UPPER_BOUND = 55.0;
|
||||||
|
|
||||||
static constexpr double X8_U_LOWER_BOUND = 2.6;
|
static constexpr double X8_U_LOWER_BOUND = 2.6;
|
||||||
static constexpr double X8_U_UPPER_BOUND = 4.0;
|
static constexpr double X8_U_UPPER_BOUND = 4.0;
|
||||||
|
@ -1,11 +1,11 @@
|
|||||||
#include "ProgressPrinter.h"
|
#include "ProgressPrinter.h"
|
||||||
|
|
||||||
#include "fsfw/serviceinterface/ServiceInterfaceStream.h"
|
#include "fsfw/serviceinterface/ServiceInterfaceStream.h"
|
||||||
|
|
||||||
ProgressPrinter::ProgressPrinter(std::string name, uint32_t numSteps)
|
ProgressPrinter::ProgressPrinter(std::string name, uint32_t numSteps)
|
||||||
: name(name), numSteps(numSteps) {}
|
: name(name), numSteps(numSteps) {}
|
||||||
|
|
||||||
ProgressPrinter::~ProgressPrinter() {
|
ProgressPrinter::~ProgressPrinter() {}
|
||||||
}
|
|
||||||
|
|
||||||
void ProgressPrinter::print(uint32_t currentStep) {
|
void ProgressPrinter::print(uint32_t currentStep) {
|
||||||
float progressInPercent = static_cast<float>(currentStep) / static_cast<float>(numSteps) * 100;
|
float progressInPercent = static_cast<float>(currentStep) / static_cast<float>(numSteps) * 100;
|
||||||
|
2
tmtc
2
tmtc
@ -1 +1 @@
|
|||||||
Subproject commit 37c1a68da1b465514e84403b06ce40d035e4ad88
|
Subproject commit 9a487c7407eb450e3d07e1ddf3649a267ced99c2
|
Loading…
Reference in New Issue
Block a user