Subversion Repositories 1g_ethernet_dpi

#include <stdio.h>

#include "xil_types.h"

#include "xil_io.h"

#include "xil_lib.h" // xil_malloc, xil_free

#include "eth.h"

#include "arp.h"

// net-if 

net_if_t *ifp;

// ??

void eth_arp_init(net_if_t *ip_net_if)

{

    ifp = ip_net_if;

    // Final

}

// simple arp req-resp logic:

void eth_arp(char *iv_data)

{

    // extract Eth-Type

    char *ethin = iv_data;

    u16 etype = ETH_TYPE_GET(ethin);

    // chk ARP-proto

    if (etype != ntohs(ETH_ARP)) {

        return;

    }

    // chk ipkt

    arp_hdr_t *in = (arp_hdr_t *)(iv_data + ETH_HDR_SZ);

    if (in->ar_pro != ARP_IPv4) {

        return;

    }

    if (in->ar_op != ARP_REQ) {

        return;

    }

    if (in->ar_tpa != ifp->ip_addr) {

        return;

    }

    // alloc/init opkt

    char *ethout = xil_malloc(ARP_SZ); // <-

    arp_hdr_t *out = (arp_hdr_t *)(ethout + ETH_HDR_SZ);

    if (!ethout) { // xil_malloc-ERR

        return;

    }

    xil_memset(ethout, 0, ARP_SZ);

    // fill opkt

    xil_memmove(ethout + ETH_DST_OFST, ethin + ETH_SRC_OFST, 6);

    xil_memmove(ethout + ETH_SRC_OFST, ifp->mac_addr, 6);

    ETH_TYPE_SET(ethout, ntohs(ETH_ARP));

    out->ar_hd = ARP_HW_ETH;

    out->ar_pro = ARP_IPv4;

    out->ar_hln = 6;

    out->ar_pln = 4;

    out->ar_op = ARP_RESP;

    xil_memmove((char *)out->ar_sha, (char *)ifp->mac_addr, 6);

    out->ar_spa = in->ar_tpa;

    xil_memmove((char *)out->ar_tha, (char *)in->ar_sha, 6);

    out->ar_tpa = in->ar_spa;

    // tx

    ifp->net_raw_send(ethout, ETH_HDR_SZ+sizeof(arp_hdr_t));

    // Final

    xil_free(ethout); // ->

}