NetIcmp.cpp

//------------------------------------------------------------------------------
//This file is part of embKernel. 
//See license.txt for the full license governing this code.
//------------------------------------------------------------------------------

#include "NetIcmp.hpp"
#include "NetChecksum.hpp"
#include "NetIp.hpp"
#include "Net.hpp"

void NetIcmp::processFrame(NetDefs::FRAME& frame, NetDefs::ICMP_HEADER& header, int len) {
    //Reply to Echo Request
    if (header.type == NetDefs::ICMP_TYPE_ECHO_REQUEST) {
        frame.types.icmp.icmpHeader.type = NetDefs::ICMP_TYPE_ECHO_REPLY;
        frame.types.icmp.icmpHeader.checkSum = 0;
        frame.types.icmp.icmpHeader.checkSum = NetChecksum::finalizeCheckSum(NetChecksum::calcPartialChecksum((uint8_t*) &frame.types.icmp.icmpHeader, len));
        NetIp::putHeader(frame, frame.types.mac.macHeader.srcAddr, frame.types.ip.ipHeader.srcAddr, len, NetDefs::IP_PROTOCOL_ICMP);
        NetIp::flush(frame, len, true);
    }
    else {
        Net::freeFrame(frame);
    }
}