//#include "TmTcUnixUdpBridge.h" //#include "tcpipHelpers.h" //#include "../../serviceinterface/ServiceInterface.h" //#include "../../ipc/MutexGuard.h" // //#include //#include //#include // //#include // ////! Debugging preprocessor define. //#define FSFW_UDP_SEND_WIRETAPPING_ENABLED 0 // //const std::string TmTcUnixUdpBridge::DEFAULT_UDP_SERVER_PORT = tcpip::DEFAULT_UDP_SERVER_PORT; // //TmTcUnixUdpBridge::TmTcUnixUdpBridge(object_id_t objectId, object_id_t tcDestination, // object_id_t tmStoreId, object_id_t tcStoreId, std::string udpServerPort): // TmTcBridge(objectId, tcDestination, tmStoreId, tcStoreId) { // if(udpServerPort == "") { // this->udpServerPort = DEFAULT_UDP_SERVER_PORT; // } // else { // this->udpServerPort = udpServerPort; // } // // mutex = MutexFactory::instance()->createMutex(); // communicationLinkUp = false; //} // //ReturnValue_t TmTcUnixUdpBridge::initialize() { // using namespace tcpip; // // ReturnValue_t result = TmTcBridge::initialize(); // if(result != HasReturnvaluesIF::RETURN_OK) { //#if FSFW_CPP_OSTREAM_ENABLED == 1 // sif::error << "TmTcUnixUdpBridge::initialize: TmTcBridge initialization failed!" // << std::endl; //#endif // return result; // } // // struct addrinfo *addrResult = nullptr; // struct addrinfo hints; // // std::memset(&hints, 0, sizeof(hints)); // hints.ai_family = AF_INET; // hints.ai_socktype = SOCK_DGRAM; // hints.ai_protocol = IPPROTO_UDP; // hints.ai_flags = AI_PASSIVE; // // /* Set up UDP socket: // https://man7.org/linux/man-pages/man3/getaddrinfo.3.html // Passing nullptr as the first parameter and specifying AI_PASSIVE in hints will cause // getaddrinfo to assign the address 0.0.0.0 (any address) */ // int retval = getaddrinfo(nullptr, udpServerPort.c_str(), &hints, &addrResult); // if (retval != 0) { //#if FSFW_CPP_OSTREAM_ENABLED == 1 // sif::warning << "TmTcWinUdpBridge::TmTcWinUdpBridge: Retrieving address info failed!" << // std::endl; //#endif // return HasReturnvaluesIF::RETURN_FAILED; // } // // /* Set up UDP socket: https://man7.org/linux/man-pages/man7/ip.7.html */ // serverSocket = socket(addrResult->ai_family, addrResult->ai_socktype, addrResult->ai_protocol); // if(serverSocket < 0) { //#if FSFW_CPP_OSTREAM_ENABLED == 1 // sif::error << "TmTcUnixUdpBridge::TmTcUnixUdpBridge: Could not open UDP socket!" << // std::endl; //#else // sif::printError("TmTcUnixUdpBridge::TmTcUnixUdpBridge: Could not open UDP socket!\n"); //#endif /* FSFW_CPP_OSTREAM_ENABLED == 1 */ // freeaddrinfo(addrResult); // handleError(Protocol::UDP, ErrorSources::SOCKET_CALL); // return HasReturnvaluesIF::RETURN_FAILED; // } // // retval = bind(serverSocket, addrResult->ai_addr, static_cast(addrResult->ai_addrlen)); // if(retval != 0) { //#if FSFW_CPP_OSTREAM_ENABLED == 1 // sif::warning << "TmTcWinUdpBridge::TmTcWinUdpBridge: Could not bind " // "local port (" << udpServerPort << ") to server socket!" << std::endl; //#endif // freeaddrinfo(addrResult); // handleError(Protocol::UDP, ErrorSources::BIND_CALL); // return HasReturnvaluesIF::RETURN_FAILED; // } // // return HasReturnvaluesIF::RETURN_OK; //} // //TmTcUnixUdpBridge::~TmTcUnixUdpBridge() { // if(mutex != nullptr) { // MutexFactory::instance()->deleteMutex(mutex); // } // close(serverSocket); //} // //ReturnValue_t TmTcUnixUdpBridge::sendTm(const uint8_t *data, size_t dataLen) { // int flags = 0; // // /* The target address can be set by different threads so this lock ensures thread-safety */ // MutexGuard lock(mutex, timeoutType, mutexTimeoutMs); // // if(ipAddrAnySet){ // clientAddress.sin_addr.s_addr = htons(INADDR_ANY); // clientAddressLen = sizeof(clientAddress); // } // //#if FSFW_CPP_OSTREAM_ENABLED == 1 && FSFW_UDP_SEND_WIRETAPPING_ENABLED == 1 // char ipAddress [15]; // sif::debug << "IP Address Sender: "<< // inet_ntop(AF_INET,&clientAddress.sin_addr.s_addr, ipAddress, 15) << std::endl; //#endif // // ssize_t bytesSent = sendto( // serverSocket, // data, // dataLen, // flags, // reinterpret_cast(&clientAddress), // clientAddressLen // ); // if(bytesSent < 0) { //#if FSFW_CPP_OSTREAM_ENABLED == 1 // sif::warning << "TmTcUnixUdpBridge::sendTm: Send operation failed." << std::endl; //#endif // tcpip::handleError(tcpip::Protocol::UDP, tcpip::ErrorSources::SENDTO_CALL); // } // //#if FSFW_CPP_OSTREAM_ENABLED == 1 && FSFW_UDP_SEND_WIRETAPPING_ENABLED == 1 // sif::debug << "TmTcUnixUdpBridge::sendTm: " << bytesSent << " bytes were" // " sent." << std::endl; //#endif // // return HasReturnvaluesIF::RETURN_OK; //} // //void TmTcUnixUdpBridge::checkAndSetClientAddress(sockaddr_in& newAddress) { // /* The target address can be set by different threads so this lock ensures thread-safety */ // MutexGuard lock(mutex, timeoutType, mutexTimeoutMs); // //#if FSFW_CPP_OSTREAM_ENABLED == 1 && FSFW_UDP_RCV_WIRETAPPING_ENABLED == 1 // char ipAddress [15]; // sif::debug << "IP Address Sender: "<< inet_ntop(AF_INET, // &newAddress.sin_addr.s_addr, ipAddress, 15) << std::endl; // sif::debug << "IP Address Old: " << inet_ntop(AF_INET, // &clientAddress.sin_addr.s_addr, ipAddress, 15) << std::endl; //#endif // registerCommConnect(); // // /* Set new IP address to reply to. */ // clientAddress = newAddress; // clientAddressLen = sizeof(clientAddress); //} // //void TmTcUnixUdpBridge::setMutexProperties(MutexIF::TimeoutType timeoutType, // dur_millis_t timeoutMs) { // this->timeoutType = timeoutType; // this->mutexTimeoutMs = timeoutMs; //} // //void TmTcUnixUdpBridge::setClientAddressToAny(bool ipAddrAnySet){ // this->ipAddrAnySet = ipAddrAnySet; //} //