Subversion Repositories 1g_ethernet_dpi

 
#include "xil_lib.h" 
#include "ip.h"
#include "icmp.h"
 
// net-if
net_if_t *ifp;
 
// ??
void eth_icmp_init(net_if_t *ip_net_if)
{
    ifp = ip_net_if;
    // Final
}
// {ICMP_ECHO_REQ+ICMP_ECHO_RESP} only!!!
void eth_icmp(char *iv_data)
{
 
    // 
    ip_hdr_t *pip = ip_head(iv_data);
 
    // chk ipkt
    icmp_hdr_t *in = (icmp_hdr_t *)(ip_data(pip));
    int len = htons(pip->ip_len) - ip_hlen(pip);
 
    // !check ICMP Header checksum
 
    // pass pkt to proper ICMP routine
    switch(in->ptype) {
        case ICMP_ECHO_REQ : {
            // mac
            xil_memmove(iv_data + ETH_DST_OFST, iv_data + ETH_SRC_OFST, 6);
            xil_memmove(iv_data + ETH_SRC_OFST, ifp->mac_addr, 6);
            // ptype
            in->ptype = ICMP_ECHO_RESP;
            // checksum
            in->pchksum = 0;
            in->pchksum = cksum(in, len);
            // ip-addr
            pip->ip_dest = pip->ip_src;
            pip->ip_src = ifp->ip_addr;
            // 
            ifp->net_raw_send(iv_data, ETH_HDR_SZ+htons(pip->ip_len));
            break;
        }
        default : {
            //printf("eth_icmp: ptype=%x\n", in->ptype);
            break;
        }
    }
    // Final
}