Init commit

common/stm32_nucleo/networking/UdpTcLwIpPollingTask.cpp

@@ -0,0 +1,61 @@
+#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;
+}