some fixes and improvements
This commit is contained in:
parent
abcf1b29b2
commit
f0415a97b1
@ -178,16 +178,25 @@ ReturnValue_t cfdp::DestHandler::handleFileDataPdu(const cfdp::PacketInfo& info)
|
|||||||
dp.user.fileSegmentRecvdIndication(segParams);
|
dp.user.fileSegmentRecvdIndication(segParams);
|
||||||
}
|
}
|
||||||
result = dp.user.vfs.writeToFile(fileOpParams, fileData);
|
result = dp.user.vfs.writeToFile(fileOpParams, fileData);
|
||||||
if (offset.value() + fileSegmentLen > tp.progress) {
|
|
||||||
tp.progress = offset.value() + fileSegmentLen;
|
|
||||||
}
|
|
||||||
if (result != returnvalue::OK) {
|
if (result != returnvalue::OK) {
|
||||||
// TODO: Proper Error handling
|
// TODO: Proper Error handling
|
||||||
#if FSFW_CPP_OSTREAM_ENABLED == 1
|
#if FSFW_CPP_OSTREAM_ENABLED == 1
|
||||||
sif::error << "File write error" << std::endl;
|
sif::error << "cfdp::DestHandler: VFS file write error with code 0x" << std::hex << std::setw(2)
|
||||||
|
<< result << std::endl;
|
||||||
#endif
|
#endif
|
||||||
|
tp.vfsErrorCount++;
|
||||||
|
if (tp.vfsErrorCount < 3) {
|
||||||
|
// TODO: Provide execution step as parameter
|
||||||
|
fp.eventReporter->forwardEvent(events::FILESTORE_ERROR, static_cast<uint8_t>(fsmRes.step),
|
||||||
|
result);
|
||||||
|
}
|
||||||
|
return result;
|
||||||
} else {
|
} else {
|
||||||
tp.deliveryStatus = FileDeliveryStatus::RETAINED_IN_FILESTORE;
|
tp.deliveryStatus = FileDeliveryStatus::RETAINED_IN_FILESTORE;
|
||||||
|
tp.vfsErrorCount = 0;
|
||||||
|
}
|
||||||
|
if (offset.value() + fileSegmentLen > tp.progress) {
|
||||||
|
tp.progress = offset.value() + fileSegmentLen;
|
||||||
}
|
}
|
||||||
return result;
|
return result;
|
||||||
}
|
}
|
||||||
@ -271,35 +280,62 @@ ReturnValue_t cfdp::DestHandler::startTransaction(MetadataPduReader& reader, Met
|
|||||||
return OK;
|
return OK;
|
||||||
}
|
}
|
||||||
ReturnValue_t result = OK;
|
ReturnValue_t result = OK;
|
||||||
fsmRes.step = TransactionStep::TRANSACTION_START;
|
|
||||||
if (reader.getTransmissionMode() == TransmissionMode::UNACKNOWLEDGED) {
|
|
||||||
fsmRes.state = CfdpStates::BUSY_CLASS_1_NACKED;
|
|
||||||
} else if (reader.getTransmissionMode() == TransmissionMode::ACKNOWLEDGED) {
|
|
||||||
fsmRes.state = CfdpStates::BUSY_CLASS_2_ACKED;
|
|
||||||
}
|
|
||||||
tp.checksumType = info.getChecksumType();
|
|
||||||
tp.closureRequested = info.isClosureRequested();
|
|
||||||
size_t sourceNameSize = 0;
|
size_t sourceNameSize = 0;
|
||||||
const uint8_t* sourceNamePtr = info.getSourceFileName().getValue(&sourceNameSize);
|
const uint8_t* sourceNamePtr = info.getSourceFileName().getValue(&sourceNameSize);
|
||||||
if (sourceNameSize > tp.sourceName.size()) {
|
if (sourceNameSize + 1 > tp.sourceName.size()) {
|
||||||
// TODO: Warning, event etc.
|
fp.eventReporter->forwardEvent(events::FILENAME_TOO_LARGE_ERROR, 0, 0);
|
||||||
|
#if FSFW_CPP_OSTREAM_ENABLED == 1
|
||||||
|
sif::warning << "cfdp::DestHandler: source filename too large" << std::endl;
|
||||||
|
#endif
|
||||||
return FAILED;
|
return FAILED;
|
||||||
}
|
}
|
||||||
std::memcpy(tp.sourceName.data(), sourceNamePtr, sourceNameSize);
|
std::memcpy(tp.sourceName.data(), sourceNamePtr, sourceNameSize);
|
||||||
tp.sourceName[sourceNameSize] = '\0';
|
tp.sourceName[sourceNameSize] = '\0';
|
||||||
size_t destNameSize = 0;
|
size_t destNameSize = 0;
|
||||||
const uint8_t* destNamePtr = info.getDestFileName().getValue(&destNameSize);
|
const uint8_t* destNamePtr = info.getDestFileName().getValue(&destNameSize);
|
||||||
if (destNameSize > tp.destName.size()) {
|
if (destNameSize + 1 > tp.destName.size()) {
|
||||||
// TODO: Warning, event etc.
|
fp.eventReporter->forwardEvent(events::FILENAME_TOO_LARGE_ERROR, 0, 0);
|
||||||
|
#if FSFW_CPP_OSTREAM_ENABLED == 1
|
||||||
|
sif::warning << "cfdp::DestHandler: dest filename too large" << std::endl;
|
||||||
|
#endif
|
||||||
return FAILED;
|
return FAILED;
|
||||||
}
|
}
|
||||||
std::memcpy(tp.destName.data(), destNamePtr, destNameSize);
|
std::memcpy(tp.destName.data(), destNamePtr, destNameSize);
|
||||||
tp.destName[destNameSize] = '\0';
|
tp.destName[destNameSize] = '\0';
|
||||||
reader.fillConfig(tp.pduConf);
|
|
||||||
tp.pduConf.direction = Direction::TOWARDS_SENDER;
|
// If both dest name size and source name size are 0, we are dealing with a metadata only PDU,
|
||||||
tp.transactionId.entityId = tp.pduConf.sourceId;
|
// so there is no need to create a file or truncate an existing file
|
||||||
tp.transactionId.seqNum = tp.pduConf.seqNum;
|
if (destNameSize > 0 and sourceNameSize > 0) {
|
||||||
if (not dp.remoteCfgTable.getRemoteCfg(tp.pduConf.sourceId, &tp.remoteCfg)) {
|
FilesystemParams fparams(tp.destName.data());
|
||||||
|
if (dp.user.vfs.fileExists(fparams)) {
|
||||||
|
result = dp.user.vfs.truncateFile(fparams);
|
||||||
|
if (result != returnvalue::OK) {
|
||||||
|
// TODO: Provide execution step as parameter
|
||||||
|
fp.eventReporter->forwardEvent(events::FILESTORE_ERROR, static_cast<uint8_t>(fsmRes.step),
|
||||||
|
result);
|
||||||
|
#if FSFW_CPP_OSTREAM_ENABLED == 1
|
||||||
|
sif::warning << "cfdp::DestHandler: file truncation error with code " << result
|
||||||
|
<< std::endl;
|
||||||
|
#endif
|
||||||
|
return FAILED;
|
||||||
|
// TODO: Relevant for filestore rejection error?
|
||||||
|
}
|
||||||
|
} else {
|
||||||
|
result = dp.user.vfs.createFile(fparams);
|
||||||
|
if (result != OK) {
|
||||||
|
fp.eventReporter->forwardEvent(events::FILESTORE_ERROR, static_cast<uint8_t>(fsmRes.step),
|
||||||
|
result);
|
||||||
|
#if FSFW_CPP_OSTREAM_ENABLED == 1
|
||||||
|
sif::warning << "cfdp::DestHandler: file creation error with code " << result << std::endl;
|
||||||
|
#endif
|
||||||
|
return FAILED;
|
||||||
|
// TODO: Relevant for filestore rejection error?
|
||||||
|
}
|
||||||
|
}
|
||||||
|
}
|
||||||
|
EntityId sourceId;
|
||||||
|
reader.getSourceId(sourceId);
|
||||||
|
if (not dp.remoteCfgTable.getRemoteCfg(sourceId, &tp.remoteCfg)) {
|
||||||
// TODO: Warning, event etc.
|
// TODO: Warning, event etc.
|
||||||
#if FSFW_CPP_OSTREAM_ENABLED == 1
|
#if FSFW_CPP_OSTREAM_ENABLED == 1
|
||||||
sif::warning << "cfdp::DestHandler" << __func__
|
sif::warning << "cfdp::DestHandler" << __func__
|
||||||
@ -308,22 +344,18 @@ ReturnValue_t cfdp::DestHandler::startTransaction(MetadataPduReader& reader, Met
|
|||||||
#endif
|
#endif
|
||||||
return FAILED;
|
return FAILED;
|
||||||
}
|
}
|
||||||
// If both dest name size and source name size are 0, we are dealing with a metadata only PDU,
|
fsmRes.step = TransactionStep::TRANSACTION_START;
|
||||||
// so there is no need to create a file or truncate an existing file
|
if (reader.getTransmissionMode() == TransmissionMode::UNACKNOWLEDGED) {
|
||||||
if (destNameSize > 0 and sourceNameSize > 0) {
|
fsmRes.state = CfdpStates::BUSY_CLASS_1_NACKED;
|
||||||
FilesystemParams fparams(tp.destName.data());
|
} else if (reader.getTransmissionMode() == TransmissionMode::ACKNOWLEDGED) {
|
||||||
// TODO: Filesystem errors?
|
fsmRes.state = CfdpStates::BUSY_CLASS_2_ACKED;
|
||||||
if (dp.user.vfs.fileExists(fparams)) {
|
|
||||||
dp.user.vfs.truncateFile(fparams);
|
|
||||||
} else {
|
|
||||||
result = dp.user.vfs.createFile(fparams);
|
|
||||||
if (result != OK) {
|
|
||||||
// TODO: Handle FS error. This is probably a case for the filestore rejection mechanism of
|
|
||||||
// CFDP.
|
|
||||||
// In any case, it does not really make sense to continue here
|
|
||||||
}
|
|
||||||
}
|
|
||||||
}
|
}
|
||||||
|
tp.checksumType = info.getChecksumType();
|
||||||
|
tp.closureRequested = info.isClosureRequested();
|
||||||
|
reader.fillConfig(tp.pduConf);
|
||||||
|
tp.pduConf.direction = Direction::TOWARDS_SENDER;
|
||||||
|
tp.transactionId.entityId = tp.pduConf.sourceId;
|
||||||
|
tp.transactionId.seqNum = tp.pduConf.seqNum;
|
||||||
fsmRes.step = TransactionStep::RECEIVING_FILE_DATA_PDUS;
|
fsmRes.step = TransactionStep::RECEIVING_FILE_DATA_PDUS;
|
||||||
MetadataRecvdParams params(tp.transactionId, tp.pduConf.sourceId);
|
MetadataRecvdParams params(tp.transactionId, tp.pduConf.sourceId);
|
||||||
params.fileSize = tp.fileSize.getSize();
|
params.fileSize = tp.fileSize.getSize();
|
||||||
|
@ -84,7 +84,7 @@ enum class CallStatus { DONE, CALL_AFTER_DELAY, CALL_AGAIN };
|
|||||||
|
|
||||||
class DestHandler {
|
class DestHandler {
|
||||||
public:
|
public:
|
||||||
enum class TransactionStep {
|
enum class TransactionStep : uint8_t {
|
||||||
IDLE = 0,
|
IDLE = 0,
|
||||||
TRANSACTION_START = 1,
|
TRANSACTION_START = 1,
|
||||||
RECEIVING_FILE_DATA_PDUS = 2,
|
RECEIVING_FILE_DATA_PDUS = 2,
|
||||||
@ -157,11 +157,13 @@ class DestHandler {
|
|||||||
progress = 0;
|
progress = 0;
|
||||||
remoteCfg = nullptr;
|
remoteCfg = nullptr;
|
||||||
closureRequested = false;
|
closureRequested = false;
|
||||||
|
vfsErrorCount = 0;
|
||||||
checksumType = ChecksumType::NULL_CHECKSUM;
|
checksumType = ChecksumType::NULL_CHECKSUM;
|
||||||
}
|
}
|
||||||
|
|
||||||
ChecksumType checksumType = ChecksumType::NULL_CHECKSUM;
|
ChecksumType checksumType = ChecksumType::NULL_CHECKSUM;
|
||||||
bool closureRequested = false;
|
bool closureRequested = false;
|
||||||
|
uint16_t vfsErrorCount = 0;
|
||||||
std::vector<char> sourceName;
|
std::vector<char> sourceName;
|
||||||
std::vector<char> destName;
|
std::vector<char> destName;
|
||||||
cfdp::FileSize fileSize;
|
cfdp::FileSize fileSize;
|
||||||
|
@ -12,6 +12,9 @@ namespace events {
|
|||||||
static constexpr Event STORE_ERROR = event::makeEvent(SSID, 0, severity::LOW);
|
static constexpr Event STORE_ERROR = event::makeEvent(SSID, 0, severity::LOW);
|
||||||
static constexpr Event MSG_QUEUE_ERROR = event::makeEvent(SSID, 1, severity::LOW);
|
static constexpr Event MSG_QUEUE_ERROR = event::makeEvent(SSID, 1, severity::LOW);
|
||||||
static constexpr Event SERIALIZATION_ERROR = event::makeEvent(SSID, 2, severity::LOW);
|
static constexpr Event SERIALIZATION_ERROR = event::makeEvent(SSID, 2, severity::LOW);
|
||||||
|
static constexpr Event FILESTORE_ERROR = event::makeEvent(SSID, 3, severity::LOW);
|
||||||
|
//! [EXPORT] : [COMMENT] P1: Transaction step ID, P2: 0 for source file name, 1 for dest file name
|
||||||
|
static constexpr Event FILENAME_TOO_LARGE_ERROR = event::makeEvent(SSID, 4, severity::LOW);
|
||||||
|
|
||||||
} // namespace events
|
} // namespace events
|
||||||
|
|
||||||
|
@ -1,6 +1,7 @@
|
|||||||
#pragma once
|
#pragma once
|
||||||
|
|
||||||
#include <fsfw_hal/linux/spi/SpiCookie.h>
|
#include <fsfw_hal/linux/spi/SpiCookie.h>
|
||||||
|
|
||||||
#include "fsfw/ipc/MutexIF.h"
|
#include "fsfw/ipc/MutexIF.h"
|
||||||
#include "fsfw/returnvalues/returnvalue.h"
|
#include "fsfw/returnvalues/returnvalue.h"
|
||||||
#include "fsfw_hal/common/gpio/GpioIF.h"
|
#include "fsfw_hal/common/gpio/GpioIF.h"
|
||||||
|
Loading…
Reference in New Issue
Block a user