home *** CD-ROM | disk | FTP | other *** search
/ HAM Radio 1 / HamRadio.cdr / misc / src0131 / tcphdr.c < prev    next >
C/C++ Source or Header  |  1991-01-29  |  4KB  |  157 lines
  1. /* TCP header conversion routines
  2.  * Copyright 1991 Phil Karn, KA9Q
  3.  */
  4. #include "global.h"
  5. #include "mbuf.h"
  6. #include "tcp.h"
  7. #include "ip.h"
  8. #include "internet.h"
  9.  
  10. /* Convert TCP header in host format into mbuf ready for transmission,
  11.  * link in data (if any). If ph != NULL, compute checksum, otherwise
  12.  * take checksum from tcph->checksum
  13.  */
  14. struct mbuf *
  15. htontcp(tcph,data,ph)
  16. register struct tcp *tcph;
  17. struct mbuf *data;
  18. struct pseudo_header *ph;
  19. {
  20.     int16 hdrlen;
  21.     struct mbuf *bp;
  22.     register char *cp;
  23.  
  24.     hdrlen =  TCPLEN;
  25.     if(tcph->optlen > 0 && tcph->optlen <= TCP_MAXOPT){
  26.         hdrlen += tcph->optlen;
  27.     } else if(tcph->mss != 0){
  28.         hdrlen += MSS_LENGTH;
  29.     }
  30.     if((bp = pushdown(data,hdrlen)) == NULLBUF){
  31.         free_p(data);
  32.         return NULLBUF;
  33.     }
  34.     cp = bp->data;
  35.     cp = put16(cp,tcph->source);
  36.     cp = put16(cp,tcph->dest);
  37.     cp = put32(cp,tcph->seq);
  38.     cp = put32(cp,tcph->ack);
  39.     *cp++ = hdrlen << 2;    /* Offset field */
  40.     *cp = 0;
  41.     if(tcph->flags.urg)
  42.         *cp |= 32;
  43.     if(tcph->flags.ack)
  44.         *cp |= 16;
  45.     if(tcph->flags.psh)
  46.         *cp |= 8;
  47.     if(tcph->flags.rst)
  48.         *cp |= 4;
  49.     if(tcph->flags.syn)
  50.         *cp |= 2;
  51.     if(tcph->flags.fin)
  52.         *cp |= 1;
  53.     cp++;
  54.     cp = put16(cp,tcph->wnd);
  55.     if(ph == NULLHEADER){
  56.         /* Use user-supplied checksum */
  57.         cp = put16(cp,tcph->checksum);
  58.     } else {
  59.         /* Zero out checksum field for later recalculation */
  60.         *cp++ = 0;
  61.         *cp++ = 0;
  62.     }
  63.     cp = put16(cp,tcph->up);
  64.  
  65.     /* Write options, if any */
  66.     if(hdrlen > TCPLEN){
  67.         if(tcph->mss != 0){
  68.             *cp++ = MSS_KIND;
  69.             *cp++ = MSS_LENGTH;
  70.             cp = put16(cp,tcph->mss);
  71.         } else
  72.             memcpy(cp,tcph->options,tcph->optlen);
  73.     }
  74.     /* Recompute checksum, if requested */
  75.     if(ph != NULLHEADER)
  76.         put16(&bp->data[16],cksum(ph,bp,ph->length));
  77.  
  78.     return bp;
  79. }
  80. /* Pull TCP header off mbuf */
  81. int
  82. ntohtcp(tcph,bpp)
  83. register struct tcp *tcph;
  84. struct mbuf **bpp;
  85. {
  86.     int hdrlen,i,optlen,kind;
  87.     register int flags;
  88.     char hdrbuf[TCPLEN],*cp;
  89.  
  90.     i = pullup(bpp,hdrbuf,TCPLEN);
  91.     /* Note that the results will be garbage if the header is too short.
  92.      * We don't check for this because returned ICMP messages will be
  93.      * truncated, and we at least want to get the port numbers.
  94.      */
  95.     tcph->source = get16(&hdrbuf[0]);
  96.     tcph->dest = get16(&hdrbuf[2]);
  97.     tcph->seq = get32(&hdrbuf[4]);
  98.     tcph->ack = get32(&hdrbuf[8]);
  99.     hdrlen = (hdrbuf[12] & 0xf0) >> 2;
  100.     flags = hdrbuf[13];
  101.     tcph->flags.urg = flags & 32;
  102.     tcph->flags.ack = flags & 16;
  103.     tcph->flags.psh = flags & 8;
  104.     tcph->flags.rst = flags & 4;
  105.     tcph->flags.syn = flags & 2;
  106.     tcph->flags.fin = flags & 1;
  107.     tcph->wnd = get16(&hdrbuf[14]);
  108.     tcph->checksum = get16(&hdrbuf[16]);
  109.     tcph->up = get16(&hdrbuf[18]);
  110.     tcph->mss = 0;
  111.     tcph->optlen = hdrlen - TCPLEN;
  112.  
  113.     /* Check for option field. Only space for one is allowed, but
  114.      * since there's only one TCP option (MSS) this isn't a problem
  115.      */
  116.     if(i < TCPLEN || hdrlen < TCPLEN)
  117.         return -1;    /* Header smaller than legal minimum */
  118.     if(tcph->optlen == 0)
  119.         return (int)hdrlen;    /* No options, all done */
  120.  
  121.     if(tcph->optlen > len_p(*bpp)){
  122.         /* Remainder too short for options length specified */
  123.         return -1;
  124.     }
  125.     pullup(bpp,tcph->options,tcph->optlen);    /* "Can't fail" */
  126.     /* Process options */
  127.     for(cp=tcph->options,i=tcph->optlen; i > 0;){
  128.         kind = *cp++;
  129.         /* Process single-byte options */
  130.         switch(kind){
  131.         case EOL_KIND:
  132.             i--;
  133.             cp++;
  134.             return (int)hdrlen;    /* End of options list */
  135.         case NOOP_KIND:
  136.             i--;
  137.             cp++;
  138.             continue;    /* Go look for next option */
  139.         }
  140.         /* All other options have a length field */
  141.         optlen = uchar(*cp++);
  142.  
  143.         /* Process valid multi-byte options */
  144.         switch(kind){
  145.         case MSS_KIND:
  146.             if(optlen == MSS_LENGTH){
  147.                 tcph->mss = get16(cp);
  148.             }
  149.             break;
  150.         }
  151.         optlen = max(2,optlen);    /* Enforce legal minimum */
  152.         i -= optlen;
  153.         cp += optlen - 2;
  154.     }
  155.     return (int)hdrlen;
  156. }
  157.