62 lines
1.7 KiB
C++
62 lines
1.7 KiB
C++
|
#include "UdpTcLwIpPollingTask.h"
|
||
|
|
#include "TmTcLwIpUdpBridge.h"
|
||
|
|
#include "app_ethernet.h"
|
||
|
|
#include "ethernetif.h"
|
||
|
|
#include "app_dhcp.h"
|
||
|
|
#include <hardware_init.h>
|
||
|
|
|
||
|
|
#include <fsfw/ipc/MutexGuard.h>
|
||
|
|
#include <fsfw/serviceinterface/ServiceInterface.h>
|
||
|
|
|
||
|
|
#include <lwip/timeouts.h>
|
||
|
|
|
||
|
|
UdpTcLwIpPollingTask::UdpTcLwIpPollingTask(object_id_t objectId, object_id_t bridgeId):
|
||
|
|
SystemObject(objectId), periodicHandleCounter(0), bridgeId(bridgeId) {
|
||
|
|
}
|
||
|
|
|
||
|
|
UdpTcLwIpPollingTask::~UdpTcLwIpPollingTask() {
|
||
|
|
}
|
||
|
|
|
||
|
|
ReturnValue_t UdpTcLwIpPollingTask::initialize() {
|
||
|
|
udpBridge = objectManager->get<TmTcLwIpUdpBridge>(bridgeId);
|
||
|
|
if(udpBridge == nullptr) {
|
||
|
|
return ObjectManagerIF::CHILD_INIT_FAILED;
|
||
|
|
}
|
||
|
|
if (netif_is_link_up(&gnetif)) {
|
||
|
|
set_eth_cable_connected(true);
|
||
|
|
}
|
||
|
|
return RETURN_OK;
|
||
|
|
}
|
||
|
|
|
||
|
|
|
||
|
|
/* Poll the EMAC Interface and pass content to the network interface (lwIP) */
|
||
|
|
ReturnValue_t UdpTcLwIpPollingTask::performOperation(uint8_t operationCode) {
|
||
|
|
/* Read a received packet from the Ethernet buffers and send it
|
||
|
|
to the lwIP for handling */
|
||
|
|
ethernetif_input(&gnetif);
|
||
|
|
|
||
|
|
/* Handle timeouts */
|
||
|
|
sys_check_timeouts();
|
||
|
|
|
||
|
|
#if LWIP_NETIF_LINK_CALLBACK == 1
|
||
|
|
ethernet_link_periodic_handle(&gnetif);
|
||
|
|
#endif
|
||
|
|
|
||
|
|
if(udpBridge != nullptr) {
|
||
|
|
MutexGuard lg(udpBridge->bridgeLock);
|
||
|
|
/* In case ethernet cable is disconnected */
|
||
|
|
if(not get_eth_cable_connected() and udpBridge->comLinkUp()) {
|
||
|
|
udpBridge->physicalConnectStatusChange(false);
|
||
|
|
}
|
||
|
|
else if(get_eth_cable_connected() and not udpBridge->comLinkUp()) {
|
||
|
|
udpBridge->physicalConnectStatusChange(true);
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
#if LWIP_DHCP == 1
|
||
|
|
DHCP_Periodic_Handle(&gnetif);
|
||
|
|
#endif
|
||
|
|
|
||
|
|
return RETURN_OK;
|
||
|
|
}
|