#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;
}