NetRemoteConfiguration.cpp

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

#include "NetRemoteConfiguration.hpp"
#include "Net.hpp"
#include "NetUdp.hpp"
#include "NetCfg.hpp"

void NetRemoteConfiguration::processFrame(NetDefs::FRAME& frame, int len) {
    PKT* pkt = (PKT*) frame.types.udp.data;

    if ((len < (int) sizeof(HEADER)) || ((pkt->generic.hdr.macAddr != NetDefs::MAC_BROADCAST) && (pkt->generic.hdr.macAddr != Net::sMacAddr))
            || (pkt->generic.hdr.key != KEY)) {
        Net::freeFrame(frame);
        return;
    }

    switch (pkt->generic.hdr.cmd) {
    case READ_CONFIG: {
        int8_t id = pkt->generic.hdr.id;
        NetDefs::MAC_ADDR remoteMacAddr = frame.types.mac.macHeader.srcAddr;
        NetDefs::IP_ADDR remoteIpAddr = frame.types.ip.ipHeader.srcAddr;
        uint16_t remotePort = frame.types.udp.udpHeader.srcPort;
        Net::freeFrame(frame);

        NetDefs::FRAME * sendFrame = Net::allocFrame(
                sizeof(NetDefs::MAC_HEADER) + sizeof(NetDefs::IP_HEADER) + sizeof(NetDefs::UDP_HEADER) + sizeof(HEADER) + sizeof(NetDefs::NET_CONFIG));
        if (!sendFrame) {
            return;
        }
        PKT* sendPkt = (PKT*) sendFrame->types.udp.data;
        sendPkt->writeConfig.hdr.cmd = READ_CONFIG_REPLY;
        sendPkt->writeConfig.hdr.id = id;
        sendPkt->generic.hdr.macAddr = Net::sMacAddr;
        sendPkt->writeConfig.hdr.key = KEY;
        sendPkt->writeConfig.hdr.len = sizeof(NetDefs::NET_CONFIG);
        sendPkt->writeConfig.config = Net::sConfig;
        NetUdp::putHeader(*sendFrame, remoteMacAddr, remoteIpAddr, NET_CFG_REMOTE_CONFIGURATION_PORT, remotePort,
                sizeof(HEADER) + sizeof(NetDefs::NET_CONFIG));
        NetUdp::flush(*sendFrame, sizeof(HEADER) + sizeof(NetDefs::NET_CONFIG), true);
        break;
    }
    case WRITE_CONFIG: {
        pkt->generic.hdr.cmd = WRITE_CONFIG_REPLY;
        Net::storeConfig(pkt->writeConfig.config);
        Net::sConfig = pkt->writeConfig.config;
        sendReply(frame, pkt);
        break;
    }
    case WRITE_MAC: {
        pkt->generic.hdr.cmd = WRITE_MAC_REPLY;
        Net::storeMac(pkt->writeMac.macAddr);
        Net::sMacAddr = pkt->writeMac.macAddr;
        sendReply(frame, pkt);
        break;
    }
    default:
        Net::freeFrame(frame);
    }
}

void NetRemoteConfiguration::sendReply(NetDefs::FRAME& frame, PKT* pkt) {
    pkt->generic.hdr.macAddr = Net::sMacAddr;
    pkt->generic.hdr.len = 0;
    NetUdp::putHeader(frame, frame.types.mac.macHeader.srcAddr, frame.types.ip.ipHeader.srcAddr, NET_CFG_REMOTE_CONFIGURATION_PORT,
            frame.types.udp.udpHeader.srcPort, sizeof(HEADER));
    NetUdp::flush(frame, sizeof(HEADER), true);
}