C / C++ / MFC

~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~<br />
Peter Weyzen<br />
Staff Engineer<br />
Santa Cruz Networks

<code>
#pragma comment( lib, "Ws2_32.lib" )

#define WIN32_LEAN_AND_MEAN

#include <winsock2.h>
#include <windows.h>
#include <ws2tcpip.h>
#include <stdio.h>
#include <conio.h>

#define IP               "172.27.2.15"
#define PORT          123
#define IP_DEST          "192.168.200.9"
#define PORT_DEST     123

#define SIO_RCVALL _WSAIOW(IOC_VENDOR,1)
#define MAX_ADDR_LEN 16
#define MAX_HOSTNAME_LAN 255


USHORT checksum(USHORT *buffer, int size);
void checkPacket(char * pacote);

struct tcpheader {
    unsigned short int th_sport;
    unsigned short int th_dport;
    unsigned int th_seq;
    unsigned int th_ack;
    unsigned char th_x2:4;
    unsigned char th_off:4;
    unsigned char th_flags;
    unsigned short int th_win;
    unsigned short int th_sum;
    unsigned short int th_urp;
}; /* total tcp header length: 20 bytes (=160 bits) */


struct ipheader {
    unsigned char ip_hl:4, ip_v:4; /* this means that each member is 4 bits */
    unsigned char ip_tos;
    unsigned short int ip_len;
    unsigned short int ip_id;
    unsigned short int ip_off;
    unsigned char ip_ttl;
    unsigned char ip_proto;
    unsigned short int ip_sum;
    unsigned int ip_src;
    unsigned int ip_dst;
}; /* total ip header length: 20 bytes (=160 bits) */


struct udpheader {
    unsigned short int uh_sport;
    unsigned short int uh_dport;
    unsigned short int uh_len;
    unsigned short int uh_sum;

}; /* 8 bytes */


int main (void)
{
    WSADATA wsd;
    char datagram[5000];
    unsigned int bOpt=1;


    if (WSAStartup(MAKEWORD(2,2), &wsd) != 0){
       printf("WSAStartup() failed: %d\n", GetLastError());
       return -1;
    }

    // Create a raw socket
    SOCKET s = WSASocket(AF_INET, SOCK_RAW, IPPROTO_UDP, NULL, 0,0);

    if (s == INVALID_SOCKET){
       printf("WSASocket() failed: %d\n", WSAGetLastError());
       return -1;
    }

    // ENABLE IPHDRINCL
    if (setsockopt(s, IPPROTO_IP, IP_HDRINCL, (char *)&bOpt, sizeof(bOpt)) == SOCKET_ERROR){
       printf("setsockopt(IP_HDRINCL) failed: %d\n", WSAGetLastError());
       return -1;
    }

    struct ipheader *iph = (struct ipheader *) datagram;
    struct udpheader *udph = (struct udpheader *) (datagram + 20);
    struct sockaddr_in sin; //, sockTeste;



    sin.sin_family = AF_INET;
    sin.sin_port = htons (PORT_DEST);
    sin.sin_addr.s_addr = inet_addr (IP_DEST);

    memset (datagram, 0, sizeof(datagram));     /* zero out the buffer */


    // IP Header
    
    iph->ip_hl           = 5;
    iph->ip_v          = 4;
    iph->ip_tos           = 0;
    iph->ip_len           = sizeof (struct ipheader) + sizeof (struct udpheader);
    iph->ip_id           = 1;
    iph->ip_off           = 0;
    iph->ip_ttl           = 100;
    iph->ip_proto      = 17;     // UDP
    iph->ip_sum           = 0;
    iph->ip_src           = inet_addr(IP);
    iph->ip_dst           = inet_addr(IP_DEST); //sin.sin_addr.s_addr;

    
    // UDP Header

    udph->uh_sport = htons (PORT);
    udph->uh_dport = htons (PORT_DEST);
    udph->uh_len   = sizeof (struct ipheader) + sizeof (struct udpheader);
    udph->uh_sum   = 0;
    
     
    // Put something in the packet
    strcpy(datagram+28,"Teste");
	datagram[5000] = NULL;


    // Calculate Checksum

    iph->ip_sum  = checksum((unsigned short *)&iph, sizeof(ipheader));
    //tcph->th_sum = checksum((unsigned short *)&tcph, sizeof(tcpheader));
    udph->uh_sum = checksum((unsigned short *)&udph, sizeof(udpheader));

    // check the packet made
    checkPacket(datagram);

    //while (1)
    //{
         //Send The Packet

         if (sendto(s, datagram, strlen(datagram), 0, (SOCKADDR *)&sin, sizeof(sin)) == SOCKET_ERROR)
         {
              printf("sendto() failed: %d\n", WSAGetLastError());
              return -1;
         }
         else{
              printf("OK\n");
         }
         //if (sendto(s, datagram, strlen(datagram), 0, (SOCKADDR *)&sin, sizeof(sin)) == SOCKET_ERROR)
         //{
         //     printf("sendto() failed: %d\n", WSAGetLastError());
         //     return -1;
         //}
         //else{
         //     printf("NOPE\n");
         //}
    //}
	getch();
    return 0;
}



// IP/TCP/UDP Checksum Function

USHORT checksum(USHORT *buffer, int size)
{

   unsigned long cksum=0;
   while (size > 1)
   {
       cksum += *buffer++;
       size  -= sizeof(USHORT);   
    }
   if (size)
   {
       cksum += *(UCHAR*)buffer;   
    }
   cksum = (cksum >> 16) + (cksum & 0xffff);
   cksum += (cksum >>16); 
    return (USHORT)(~cksum); 
}

void checkPacket(char * buff)
{
         
    ipheader* pIpheader;
    tcpheader* pTcpheader;
    udpheader* pUdpheader;
    
     SOCKADDR_IN saSource, saDest;
    int iNextheader;
    char * packetData;

    pIpheader = (ipheader *) buff;

    //IP Header
    printf("IP Header \n");
    printf("IHL: %d\n",(int)pIpheader->ip_hl);
    printf("VERSION: %d\n",pIpheader->ip_v);
    printf("TYPE OF SERVICE: %d\n",(int)pIpheader->ip_tos);
    printf("TOTAL LENGTH: %d\n",pIpheader->ip_len);
    printf("IDENTIFICATION: %d\n",pIpheader->ip_id);
    printf("FRAGMENT OFFSET: %d\n",pIpheader->ip_off);
    printf("TTL: %d\n",(int)pIpheader->ip_ttl);
    printf("PROTOCOL: %d\n", (int)pIpheader->ip_proto);
    printf("CHECKSUM: %d\n",pIpheader->ip_sum);

    saSource.sin_addr.s_addr = pIpheader->ip_src;
    printf("SOURCE ADDRESS: %s\n",inet_ntoa(saSource.sin_addr));
    
    saDest.sin_addr.s_addr = pIpheader->ip_dst;
    printf("DESTINATION ADDRESS: %s\n",inet_ntoa(saDest.sin_addr));

    iNextheader = (20);

    
     if ((int)pIpheader->ip_proto == 6)
    {
         //TCP Header

         pTcpheader = (tcpheader *) (buff + iNextheader);

         printf("\nTCP Header\n");

         saSource.sin_port = pTcpheader->th_sport;
         printf ("SOURCE PORT: %d\n", htons(saSource.sin_port));
         
         saDest.sin_port = pTcpheader->th_dport;
         printf ("DESTINATION PORT: %d\n", htons(saDest.sin_port));
         
         printf ("SEQUENCE: %d\n", pTcpheader->th_seq);
         printf ("ACK: %d\n", pTcpheader->th_ack);
         printf ("X2: %d\n", (int)pTcpheader->th_x2);
         printf ("OFF SET: %d\n", (int)pTcpheader->th_off);
         printf ("FLAGS: %d\n", (int)pTcpheader->th_flags);
         printf ("WINDOW: %d\n", pTcpheader->th_win);
         printf ("CHECKSUM: %d\n", pTcpheader->th_sum);
         printf ("URP: %d\n", pTcpheader->th_urp);

         // Data

         printf("\nDATA\n");

         iNextheader = (pIpheader->ip_hl * 4 + sizeof(tcpheader));

         packetData = (char *) (buff + iNextheader);
         printf ("DATA: %s\n", packetData);
    
     }
    if ((int)pIpheader->ip_proto == 17)
    {
         
         printf("\nUDP Header\n");
         
         pUdpheader = (udpheader *) (buff + iNextheader);

         saSource.sin_port = pUdpheader->uh_sport;
         printf ("SOURCE PORT: %d\n", htons(saSource.sin_port));
         
         saDest.sin_port = pUdpheader->uh_dport;
         printf ("DESTINATION PORT: %d\n", htons(saDest.sin_port));
         
         printf ("LEN: %d\n", pUdpheader->uh_len);
         printf ("CHECKSUM: %d\n", pUdpheader->uh_sum);
         
         // DATA
         
         printf("\nDATA\n");

         iNextheader = (pIpheader->ip_hl * 4 + sizeof(udpheader));

         packetData = (char *) (buff + iNextheader);
         printf ("DATA: %s\n", packetData);
    }
    

      getch();
}
</code>