Subversion Repositories 1g_ethernet_dpi

//////////////////////////////////////////////////////////////////////////////////
#include <stdlib.h>
#include <stdio.h>
 
#include "ether.h" // ETH_PKT_MAC_ADDR_LEN, ..
#include "eth_host_bfm.h" // eth_frm_read_wait, ..
 
//////////////////////////////////////////////////////////////////////////////////
// PKT-LEN
int pkt_len;
//////////////////////////////////////////////////////////////////////////////////
// 
// Ethernet RX routine
//
 
int ether_rx_ok(void)
{
    eth_frm_read_len(&pkt_len);
    return(pkt_len != -1);
}
 
void ether_rx(char *obuff, int *olen) // !!!only after 'ether_rx_ok' + 'obuff' must be pre-allocated
{
    // dec vars
    int i, pkt_data;
    // proc
    *olen = pkt_len;
    for (i = 0; i < pkt_len; i++) {
            eth_frm_read(&pkt_data, i);
            *(obuff+i) = pkt_data;
    }
    // msg2usr
    unsigned short pkt_type = *((unsigned short *)((obuff)+ETH_PKT_MAC_ADDR_LEN*2));
    switch(pkt_type) {
        case ETH_PKT_ARP : {
            printf("ether_rx: ETH_PKT_ARP, len=%04x\n", pkt_len);
            break;
        }
        case ETH_PKT_IPv4 : {
            ip_hdr_t *ptr_ipv4_hdr = (ip_hdr_t *)(obuff+ETH_HDR_LEN);
            switch(ptr_ipv4_hdr->ip_prot) {
                case IPv4_ICMP : {
                    printf("ether_rx: ETH_PKT_IPv4-ICMP, len=%04x\n", pkt_len);
                    break;
                }
                case IPv4_UDP : {
                    printf("ether_rx: ETH_PKT_IPv4-UDP, len=%04x\n", pkt_len);
                    break;
                }
                default : {
                    printf("ether_rx: ETH_PKT_IPv4: IP protocol number = %x, len=%04x\n", ptr_ipv4_hdr->ip_prot, pkt_len);
                    break;
                }
            }
            break;
        }
        default : {
            printf("ether_rx: pkt-type=%04x, len=%04x\n", ntohs(pkt_type), pkt_len);
            break;
        }
    }
}
//////////////////////////////////////////////////////////////////////////////////