Subversion Repositories 1g_ethernet_dpi

#include <stdio.h>
 
#include <arpa/inet.h> // sockaddr, ..  / ?? net/if.h
#include <linux/if.h>
#include <linux/if_tun.h>
#include <string.h> // memset, ..
 
#include <sys/types.h>
#include <sys/stat.h>
#include <fcntl.h> // open, ..
 
#include <sys/ioctl.h> // ioctl
#include <errno.h> // 
 
#include <stdlib.h> // system
 
 
/* */
#include "eth_host_bfm.h" // DPI-C
#include "ether.h" // ether_tx, ether_rx_ok, ether_rx
/* */
 
 
// ??
#define BUFSIZE     2048 // 2KB
// ??
char buffer[BUFSIZE];
 
 
// tap-if READ
int cread(int fd, char *buf, int n){
 
  int nread;
 
  if((nread=read(fd, buf, n))<0){
    perror("Reading data");
    exit(1);
  }
  return nread;
}
// tap-if WRITE
int cwrite(int fd, char *buf, int n){
 
  int nwrite;
 
  if((nwrite=write(fd, buf, n))<0){
    perror("Writing data");
    exit(1);
  }
  return nwrite;
}
 
// MAIN
int test_bfm(void)
{   // dec vars
    struct ifreq ifr;
    int tap_fd, err;
    char tap_nm[IFNAMSIZ] = "tap0";
 
    // prep
    memset(&ifr, 0, sizeof(ifr));
    tap_fd = -1;
 
    // open
    tap_fd = open("/dev/net/tun", O_RDWR);
    if( tap_fd < 0 ) {
        printf("ERR0: fd=%x\n", tap_fd);
        return -1;
    }
    // cfg: {tap-if} + {no-packet-info}
    ifr.ifr_flags = IFF_TAP | IFF_NO_PI;
    strncpy(ifr.ifr_name, tap_nm, IFNAMSIZ);    
    err = ioctl(tap_fd, TUNSETIFF, (void *)&ifr); // tun_set_iff: name + flags
    if( err < 0 ) { 
        int errsv = errno;
        printf("ERR1: fd=%x, errsv=%x :  %s\n", tap_fd, errsv, strerror(errsv));
        close(tap_fd);
        return -2;
    }
    // msg2usr
    printf("ifr_name=%s\n", ifr.ifr_name);
    //printf("ifr_flags=%x\n", ifr.ifr_flags);
 
    // tap_fd == 'O_NONBLOCK'
    int flags = fcntl(tap_fd, F_GETFL, 0);
    fcntl(tap_fd, F_SETFL, flags | O_NONBLOCK);
 
    // main-loop
    int idx=0;
    while (1) {
 
        int ret;
        fd_set rd_set;
        struct timeval timeout;
 
        timeout.tv_sec=0; // no-wait, just check
        timeout.tv_usec=0;
        FD_ZERO(&rd_set);
        FD_SET(tap_fd, &rd_set);
 
        // HDL-time-consumption!!!
        host_delay(10);
 
        // sw-wait
        ret = select(tap_fd + 1, &rd_set, NULL, NULL, &timeout); // man7.org: if timeout is NULL, select() can block indefinitely...
        if ( ret < 0 ) {
            int errsv = errno;
            if (errsv == EINTR) { // EINTR -> not an ERR in curr situation
                //printf("EINTR\n");
                continue;
            } 
            if (errsv == EAGAIN) { // EAGAIN -> nothing to read
                // printf("EAGAIN\n");
                continue;
            } else { // all others -> ERR-case
                printf("ERR4: fd=%x, errsv=%x :  %s\n", tap_fd, errsv, strerror(errsv));
                close(tap_fd);
                return -5;
            }
        }
 
        // check TAP-RX
        if(FD_ISSET(tap_fd, &rd_set)) {
            int nread = cread(tap_fd, &buffer[0], BUFSIZE);
            //printf("TAP-RD: nread=%03x\n", nread);
            if (nread) {
                ether_tx(&buffer[0], nread);
            } else {
                printf("FD_ISSET: nread=%x\n", nread);
            }
            //if (idx == 32) break;
        }
 
        // check TAP-TX
        if (ether_rx_ok()) {
            int nwrite_0;
            ether_rx(&buffer[0], &nwrite_0);
            int nwrite_1 = cwrite(tap_fd, &buffer[0], nwrite_0);
        }
 
    }
    // end / ;)
    printf("close TAP\n");
    close(tap_fd);
 
    // Final
    return 0;
}