78 lines
2.3 KiB
C++
78 lines
2.3 KiB
C++
#include "TcpTmTcBridge.h"
|
|
#include "tcpipHelpers.h"
|
|
|
|
#include <fsfw/serviceinterface/ServiceInterface.h>
|
|
#include <fsfw/ipc/MutexGuard.h>
|
|
#include <fsfw/osal/common/TcpTmTcBridge.h>
|
|
|
|
#ifdef _WIN32
|
|
|
|
#include <ws2tcpip.h>
|
|
|
|
#elif defined(__unix__)
|
|
|
|
#include <netdb.h>
|
|
#include <arpa/inet.h>
|
|
|
|
#endif
|
|
|
|
const std::string TcpTmTcBridge::DEFAULT_UDP_SERVER_PORT = tcpip::DEFAULT_SERVER_PORT;
|
|
|
|
TcpTmTcBridge::TcpTmTcBridge(object_id_t objectId, object_id_t tcDestination,
|
|
object_id_t tmStoreId, object_id_t tcStoreId):
|
|
TmTcBridge(objectId, tcDestination, tmStoreId, tcStoreId) {
|
|
mutex = MutexFactory::instance()->createMutex();
|
|
// Connection is always up, TM is requested by connecting to server and receiving packets
|
|
registerCommConnect();
|
|
}
|
|
|
|
ReturnValue_t TcpTmTcBridge::initialize() {
|
|
ReturnValue_t result = TmTcBridge::initialize();
|
|
if(result != HasReturnvaluesIF::RETURN_OK) {
|
|
#if FSFW_CPP_OSTREAM_ENABLED == 1
|
|
sif::error << "TcpTmTcBridge::initialize: TmTcBridge initialization failed!"
|
|
<< std::endl;
|
|
#else
|
|
sif::printError("TcpTmTcBridge::initialize: TmTcBridge initialization failed!\n");
|
|
#endif
|
|
return result;
|
|
}
|
|
|
|
return HasReturnvaluesIF::RETURN_OK;
|
|
}
|
|
|
|
TcpTmTcBridge::~TcpTmTcBridge() {
|
|
if(mutex != nullptr) {
|
|
MutexFactory::instance()->deleteMutex(mutex);
|
|
}
|
|
}
|
|
|
|
ReturnValue_t TcpTmTcBridge::handleTm() {
|
|
// Simply store the telemetry in the FIFO, the server will use it to access the TM
|
|
MutexGuard guard(mutex, timeoutType, mutexTimeoutMs);
|
|
TmTcMessage message;
|
|
ReturnValue_t status = HasReturnvaluesIF::RETURN_OK;
|
|
for (ReturnValue_t result = tmTcReceptionQueue->receiveMessage(&message);
|
|
result == HasReturnvaluesIF::RETURN_OK;
|
|
result = tmTcReceptionQueue->receiveMessage(&message))
|
|
{
|
|
status = storeDownlinkData(&message);
|
|
if(status != HasReturnvaluesIF::RETURN_OK) {
|
|
break;
|
|
}
|
|
}
|
|
return HasReturnvaluesIF::RETURN_OK;
|
|
}
|
|
|
|
ReturnValue_t TcpTmTcBridge::sendTm(const uint8_t *data, size_t dataLen) {
|
|
// Not used. The Server uses the FIFO to access and send the telemetry.
|
|
return HasReturnvaluesIF::RETURN_OK;
|
|
}
|
|
|
|
|
|
void TcpTmTcBridge::setMutexProperties(MutexIF::TimeoutType timeoutType,
|
|
dur_millis_t timeoutMs) {
|
|
this->timeoutType = timeoutType;
|
|
this->mutexTimeoutMs = timeoutMs;
|
|
}
|