home *** CD-ROM | disk | FTP | other *** search
/ Power Hacker 2003 / Power_Hacker_2003.iso / E-zine / Magazines / crh / freebsd / rootkit / sniffit.0.3.5 / sn_packets.c < prev    next >
Encoding:
C/C++ Source or Header  |  2002-05-27  |  4.3 KB  |  154 lines
  1. /* Sniffit Packet Discription File                                        */
  2. /*   - by: Brecht Claerhout                            */
  3.  
  4. #include "sn_config.h"
  5. #include "sn_defines.h"
  6. #include "sn_structs.h"
  7. #include <netinet/in.h>
  8.  
  9. extern int PROTO_HEAD;
  10. extern char NO_CHKSUM;
  11.  
  12. /* This routine stolen from ping.c */
  13. unsigned short in_cksum(unsigned short *addr,int len)
  14. {
  15. register int nleft = len;   /* leave this alone.. my opinion is that the   */
  16. register unsigned short *w = addr; 
  17.                             /* register is needed to make it work for both */ 
  18. register int sum = 0;       /* BIG and LITTLE endian machines              */ 
  19. unsigned short answer = 0;     
  20.                         /* but then again, who am I to make such statement */
  21.  
  22. while (nleft > 1)
  23.         {
  24.         sum += *w++;
  25.         nleft -= 2;
  26.         }
  27. if (nleft == 1)
  28.         {
  29.         *(unsigned char *)(&answer) = *(unsigned char *)w ;
  30.         sum += answer;
  31.         }
  32. sum = (sum >> 16) + (sum & 0xffff);
  33. sum += (sum >> 16);
  34. answer = ~sum;
  35. return(answer);
  36. }
  37.  
  38. int unwrap_packet (unsigned char *sp, struct unwrap *unwrapped) 
  39. { 
  40.     struct IP_header  IPhead;
  41.     struct TCP_header TCPhead;
  42.     struct ICMP_header ICMPhead;
  43.     struct UDP_header UDPhead;
  44.  
  45.     int i;
  46.      short int dummy; /* 2 bytes, important */
  47.  
  48.     memcpy(&IPhead,(sp+PROTO_HEAD),sizeof(struct IP_header));
  49.                                                   /* IP header Conversion */
  50.      unwrapped->IP_len = (IPhead.verlen & 0xF) << 2;
  51.     
  52.     unwrapped->TCP_len = 0;             /* Reset structure NEEDED!!! */
  53.     unwrapped->UDP_len = 0;
  54.     unwrapped->DATA_len = 0;
  55.     unwrapped->FRAG_nf = 0;
  56.         
  57.     if(NO_CHKSUM == 0)
  58.         {
  59.         sp[PROTO_HEAD+10]=0;       /* reset checksum to zero, Q&D way*/
  60.         sp[PROTO_HEAD+11]=0;             
  61.         if(in_cksum((sp+PROTO_HEAD),unwrapped->IP_len) != IPhead.checksum)
  62.             {
  63. #ifdef DEBUG_ONSCREEN
  64.             printf("Packet dropped... (invalid IP chksum)\n");
  65.             printf("%X   %X (len %d)\n",in_cksum((sp+PROTO_HEAD),unwrapped->IP_len),IPhead.checksum,unwrapped->IP_len);
  66. #endif
  67.             return NO_IP;
  68.             }
  69.         if(0)
  70.             {
  71. #ifdef DEBUG_ONSCREEN
  72.             printf("Packet dropped... (invalid IP version)\n");
  73. #endif
  74.             return NO_IP_4;
  75.             }
  76.         memcpy((sp+PROTO_HEAD),&IPhead,sizeof(struct IP_header));
  77.                     /* restore orig buffer      */
  78.                          /* general programming rule */
  79.         }
  80.  
  81. #ifdef DEBUG_ONSCREEN
  82.     printf("IPheadlen: %d   total length: %d\n", unwrapped->IP_len,
  83.                             ntohs(IPhead.length)); 
  84. #endif
  85.  
  86.         dummy=ntohs(IPhead.flag_offset); dummy<<=3;
  87.         if( dummy!=0 )                            /* we have offset */
  88.         {
  89.         unwrapped->FRAG_nf = 1;
  90.                 }
  91.  
  92.     if(IPhead.protocol == TCP )                     /* TCP */
  93.         {
  94.                 if(unwrapped->FRAG_nf == 0)
  95.                   {  
  96.           if( (ntohs(IPhead.length)-(unwrapped->IP_len))<20 )
  97.             {return CORRUPT_IP;};
  98.  
  99.           memcpy(&TCPhead,(sp+PROTO_HEAD+(unwrapped->IP_len)),
  100.                         sizeof(struct TCP_header));
  101.           unwrapped->TCP_len = ntohs(TCPhead.offset_flag) & 0xF000;
  102.           unwrapped->TCP_len >>= 10; 
  103.           unwrapped->DATA_len = ntohs(IPhead.length) -
  104.                 (unwrapped->IP_len) - (unwrapped->TCP_len); 
  105.                   }
  106.                 else
  107.                   {
  108.           unwrapped->DATA_len = ntohs(IPhead.length) - (unwrapped->IP_len);
  109.                   }
  110.         return TCP;
  111.         }
  112.     if(IPhead.protocol == ICMP )                     /* ICMP */
  113.         {
  114.                 if(unwrapped->FRAG_nf == 0)
  115.                   {  
  116.           if( (ntohs(IPhead.length)-(unwrapped->IP_len))<4 )
  117.             {return CORRUPT_IP;};
  118.  
  119.           memcpy(&ICMPhead,(sp+PROTO_HEAD+(unwrapped->IP_len)),
  120.                         sizeof(struct ICMP_header));
  121.           unwrapped->ICMP_len = ICMP_HEADLENGTH;
  122.           unwrapped->DATA_len = ntohs(IPhead.length) -
  123.                 (unwrapped->IP_len) - (unwrapped->ICMP_len); 
  124.           return ICMP;
  125.           }
  126.                 else
  127.                   {
  128.                   return -1; /* don't handle fragmented ICMP */
  129.                   } 
  130.         }
  131.     if(IPhead.protocol == UDP )                       /* UDP */
  132.         {
  133.                 if(unwrapped->FRAG_nf == 0)
  134.                   {  
  135.           if( (ntohs(IPhead.length)-(unwrapped->IP_len))<8 )
  136.             {return CORRUPT_IP;};
  137.  
  138.             memcpy(&UDPhead,(sp+PROTO_HEAD+(unwrapped->IP_len)),
  139.                         sizeof(struct UDP_header));
  140.           unwrapped->UDP_len = UDP_HEADLENGTH;
  141.           unwrapped->DATA_len = ntohs(IPhead.length) -
  142.                 (unwrapped->IP_len) - (unwrapped->UDP_len); 
  143.           }
  144.                 else
  145.           {
  146.           unwrapped->DATA_len = ntohs(IPhead.length)-(unwrapped->IP_len); 
  147.           }
  148.         return UDP; 
  149.         }
  150.     return -1; 
  151. }
  152.  
  153.  
  154.