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.orig < prev    next >
Encoding:
Text File  |  2002-05-27  |  3.1 KB  |  110 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.  
  47.     memcpy(&IPhead,(sp+PROTO_HEAD),sizeof(struct IP_header));
  48.                                                   /* IP header Conversion */
  49.      unwrapped->IP_len = (IPhead.verlen & 0xF) << 2;
  50.     
  51.     unwrapped->TCP_len = 0;             /* Reset structure NEEDED!!! */
  52.     unwrapped->UDP_len = 0;
  53.     unwrapped->DATA_len = 0;
  54.         
  55.     if(NO_CHKSUM == 0)
  56.         {
  57.         sp[PROTO_HEAD+10]=0;       /* reset checksum to zero, Q&D way*/
  58.         sp[PROTO_HEAD+11]=0;             
  59.         if(in_cksum((sp+PROTO_HEAD),unwrapped->IP_len) != IPhead.checksum)
  60.             {
  61. #ifdef DEBUG_ONSCREEN
  62.             printf("Packet dropped... (invalid IP chksum)\n");
  63.             printf("%X   %X (len %d)\n",in_cksum((sp+PROTO_HEAD),unwrapped->IP_len),IPhead.checksum,unwrapped->IP_len);
  64. #endif
  65.             return NO_IP;
  66.             }
  67.         if(0)
  68.             {
  69. #ifdef DEBUG_ONSCREEN
  70.             printf("Packet dropped... (invalid IP version)\n");
  71. #endif
  72.             return NO_IP_4;
  73.             }
  74.         memcpy((sp+PROTO_HEAD),&IPhead,sizeof(struct IP_header));
  75.                     /* restore orig buffer      */
  76.                          /* general programming rule */
  77.         }
  78.     if(IPhead.protocol == TCP )                     /* TCP */
  79.         {
  80.         memcpy(&TCPhead,(sp+PROTO_HEAD+(unwrapped->IP_len)),
  81.                         sizeof(struct TCP_header));
  82.         unwrapped->TCP_len = ntohs(TCPhead.offset_flag) & 0xF000;
  83.         unwrapped->TCP_len >>= 10; 
  84.         unwrapped->DATA_len = ntohs(IPhead.length) -
  85.                 (unwrapped->IP_len) - (unwrapped->TCP_len); 
  86.         return TCP;
  87.         }
  88.     if(IPhead.protocol == ICMP )                     /* ICMP */
  89.         {
  90.         memcpy(&ICMPhead,(sp+PROTO_HEAD+(unwrapped->IP_len)),
  91.                         sizeof(struct ICMP_header));
  92.         unwrapped->ICMP_len = ICMP_HEADLENGTH;
  93.         unwrapped->DATA_len = ntohs(IPhead.length) -
  94.                 (unwrapped->IP_len) - (unwrapped->ICMP_len); 
  95.         return ICMP; 
  96.         }
  97.     if(IPhead.protocol == UDP )                       /* UDP */
  98.         {
  99.         memcpy(&UDPhead,(sp+PROTO_HEAD+(unwrapped->IP_len)),
  100.                         sizeof(struct UDP_header));
  101.         unwrapped->UDP_len = UDP_HEADLENGTH;
  102.         unwrapped->DATA_len = ntohs(IPhead.length) -
  103.                 (unwrapped->IP_len) - (unwrapped->UDP_len); 
  104.         return UDP; 
  105.         }
  106.     return -1; 
  107. }
  108.  
  109.  
  110.