2021-07-13 20:22:54 +02:00
|
|
|
#include "fsfw/datalinklayer/Farm1StateOpen.h"
|
2022-02-02 10:29:30 +01:00
|
|
|
|
|
|
|
#include "fsfw/datalinklayer/ClcwIF.h"
|
2021-07-13 20:22:54 +02:00
|
|
|
#include "fsfw/datalinklayer/TcTransferFrame.h"
|
|
|
|
#include "fsfw/datalinklayer/VirtualChannelReception.h"
|
2016-06-15 23:48:41 +02:00
|
|
|
|
2022-02-02 10:29:30 +01:00
|
|
|
Farm1StateOpen::Farm1StateOpen(VirtualChannelReception* setMyVC) : myVC(setMyVC) {}
|
2016-06-15 23:48:41 +02:00
|
|
|
|
2022-02-02 10:29:30 +01:00
|
|
|
ReturnValue_t Farm1StateOpen::handleADFrame(TcTransferFrame* frame, ClcwIF* clcw) {
|
|
|
|
int8_t diff = frame->getSequenceNumber() - myVC->vR;
|
|
|
|
if (diff == 0) {
|
|
|
|
myVC->vR++;
|
|
|
|
clcw->setRetransmitFlag(false);
|
2022-08-16 01:08:26 +02:00
|
|
|
return returnvalue::OK;
|
2022-02-02 10:29:30 +01:00
|
|
|
} else if (diff < myVC->positiveWindow && diff > 0) {
|
|
|
|
clcw->setRetransmitFlag(true);
|
|
|
|
return NS_POSITIVE_W;
|
|
|
|
} else if (diff < 0 && diff >= -myVC->negativeWindow) {
|
|
|
|
return NS_NEGATIVE_W;
|
|
|
|
} else {
|
|
|
|
clcw->setLockoutFlag(true);
|
|
|
|
myVC->currentState = &(myVC->lockoutState);
|
|
|
|
return NS_LOCKOUT;
|
|
|
|
}
|
2016-06-15 23:48:41 +02:00
|
|
|
}
|
|
|
|
|
2022-02-02 10:29:30 +01:00
|
|
|
ReturnValue_t Farm1StateOpen::handleBCUnlockCommand(ClcwIF* clcw) {
|
|
|
|
myVC->farmBCounter++;
|
|
|
|
clcw->setRetransmitFlag(false);
|
|
|
|
return BC_IS_UNLOCK_COMMAND;
|
2016-06-15 23:48:41 +02:00
|
|
|
}
|
|
|
|
|
2022-02-02 10:29:30 +01:00
|
|
|
ReturnValue_t Farm1StateOpen::handleBCSetVrCommand(ClcwIF* clcw, uint8_t vr) {
|
|
|
|
myVC->farmBCounter++;
|
|
|
|
clcw->setRetransmitFlag(false);
|
|
|
|
myVC->vR = vr;
|
|
|
|
return BC_IS_SET_VR_COMMAND;
|
2016-06-15 23:48:41 +02:00
|
|
|
}
|