Subversion Repositories minsoc

#include <stdio.h>
 
#include <string.h>
 
//packet socket
#include <sys/socket.h>
#include <netpacket/packet.h>
#include <net/ethernet.h>
 
//protocol
#include <linux/if_ether.h>
 
//netdevice stuff
#include <sys/ioctl.h>
#include <net/if.h>
 
//file open stuff
#include <sys/types.h>
#include <sys/stat.h>
#include <fcntl.h>
 
//arp stuff
//#include <linux/if_arp.h>
 
#define MAC_ADDR_LEN 6
typedef unsigned char MacAddress[MAC_ADDR_LEN];
 
int main()
{
    int socket_id, new_sock, iRet = -1;
    int addrlen, bytesread, nfound =0;
 
    int i = 0;
 
    MacAddress localMac = {0x00, 0x00, 0xC0, 0x41, 0x36, 0xD3};
//    MacAddress localMac = {0xD3, 0x36, 0x41, 0xC0, 0x00, 0x00};
 
    char buf[256];
 
    struct sockaddr_ll my_addr;
 
    struct ifreq ethreq;
 
    int if_index;
 
    //create packet socket from type sock_dgram where headers are automatically thrown out
    if ( ( socket_id = socket(PF_PACKET, SOCK_DGRAM, htons(ETH_P_ALL) ) ) < 0  )
    {
        perror("socket");
        exit(1);
    }
    else
    {
        printf("Socket has been created: socket_number %d\n", socket_id);
    }
 
 
    //GET ethreq for if "eth1"
    strncpy(ethreq.ifr_name,"eth1",IFNAMSIZ);
    ioctl(socket_id, SIOCGIFFLAGS, &ethreq);
    //SET promisc mode for if ethreq
//    ethreq.ifr_flags |= IFF_PROMISC;
//    ioctl(socket_id, SIOCSIFFLAGS, &ethreq);
    //request index
    ioctl(socket_id, SIOCGIFINDEX, &ethreq);
 
    if_index = ethreq.ifr_ifindex;
 
    printf("This is the index of the interface: %d\n", if_index );
 
    memset(&my_addr, '0', sizeof(my_addr) );
 
    my_addr.sll_family = AF_PACKET;
    my_addr.sll_protocol = htons(ETH_P_ALL);  //defaults to socket protocol
    my_addr.sll_ifindex = if_index;
//    my_addr.sll_hatype = htons(ARPHRD_ETHER);
//    my_addr.sll_pkttype = PACKET_OTHERHOST;
    my_addr.sll_halen = 6;
    memcpy( &(my_addr.sll_addr), localMac, MAC_ADDR_LEN );
 
     //request hw_addres
    ioctl(socket_id, SIOCGIFHWADDR, &ethreq);
 
    printf("This is the address of my card: %d\n", my_addr.sll_addr[5] );
 
    //bind to interface goten from ioctl SIOCGIFHWADDR directive (otherwise all packets are recved)
    if ( bind( socket_id, (struct sockaddr *) &my_addr, sizeof(my_addr) ) )
    {
        perror("bind");
        exit(1);
    }
 
    struct sockaddr_ll from;
    int fromlen;
 
    fromlen = sizeof(from);
 
    for (;;)
    {
        iRet = recvfrom(socket_id, buf, 256, 0, &from, &fromlen);
        if ( iRet == -1 )
        {
            perror("recvfrom");
            exit(1);
        }
        else
        {
            printf("Received %d bytes of data.\n", iRet);
            printf("This is the received data:\n");
            for ( i = 0; i < iRet; i++)
                printf("Byte %d: %X\n", i, (int)buf[i]);
            printf("End of transmission!\n");
        }
    }
 
    return 0;
}