Category

Development Platform
Home > SourceCode/Document > Internet-Socket-Network > TCP/IP Stack > View Code
ax25hdr.c
Package: export.zip　[view]
Upload User: hepax88
Upload Date: 2007-01-03
Package Size: 1101k
Code Size: 2k
Category:

TCP/IP Stack

Development Platform:

Visual C++

ax25hdr.c：Code Content
  1. /* AX25 header conversion routines
  2.  * Copyright 1991 Phil Karn, KA9Q
  3.  */
  4. #include "global.h"
  5. #include "mbuf.h"
  6. #include "ax25.h"
  8. /* Convert a host-format AX.25 header into a mbuf ready for transmission */
  9. void
  10. htonax25(
  11. struct ax25 *hdr,
  12. struct mbuf **bpp
  13. ){
  14. register uint8 *cp;
  15. register uint16 i;
  17. if(hdr == (struct ax25 *)NULL || hdr->ndigis > MAXDIGIS || bpp == NULL)
  18. return;
  20. /* Allocate space for return buffer */
  21. i = AXALEN * (2 + hdr->ndigis);
  22. pushdown(bpp,NULL,i);
  24. /* Now convert */
  25. cp = (*bpp)->data; /* cp -> dest field */
  27. /* Generate destination field */
  28. memcpy(cp,hdr->dest,AXALEN);
  29. if(hdr->cmdrsp == LAPB_COMMAND)
  30. cp[ALEN] |= C; /* Command frame sets C bit in dest */
  31. else
  32. cp[ALEN] &= ~C;
  33. cp[ALEN] &= ~E; /* Dest E-bit is always off */
  35. cp += AXALEN; /* cp -> source field */
  37. /* Generate source field */
  38. memcpy(cp,hdr->source,AXALEN);
  39. if(hdr->cmdrsp == LAPB_RESPONSE)
  40. cp[ALEN] |= C;
  41. else
  42. cp[ALEN] &= ~C;
  43. /* Set E bit on source address if no digis */
  44. if(hdr->ndigis == 0){
  45. cp[ALEN] |= E;
  46. return;
  47. }
  49. cp += AXALEN; /* cp -> first digi field */
  51. /* All but last digi get copied with E bit off */
  52. for(i=0; i < hdr->ndigis; i++){
  53. memcpy(cp,hdr->digis[i],AXALEN);
  54. if(i < hdr->ndigis - 1)
  55. cp[ALEN] &= ~E;
  56. else
  57. cp[ALEN] |= E; /* Last digipeater has E bit set */
  58. if(i < hdr->nextdigi)
  59. cp[ALEN] |= REPEATED;
  60. else
  61. cp[ALEN] &= ~REPEATED;
  62. cp += AXALEN; /* cp -> next digi field */
  63. }
  64. }
  65. /* Convert a network-format AX.25 header into a host format structure
  66.  * Return -1 if error, number of addresses if OK
  67.  */
  68. int
  69. ntohax25(
  70. register struct ax25 *hdr, /* Output structure */
  71. struct mbuf **bpp
  72. ){
  73. register uint8 *axp;
  75. if(pullup(bpp,hdr->dest,AXALEN) < AXALEN)
  76. return -1;
  78. if(pullup(bpp,hdr->source,AXALEN) < AXALEN)
  79. return -1;
  81. /* Process C bits to get command/response indication */
  82. if((hdr->source[ALEN] & C) == (hdr->dest[ALEN] & C))
  83. hdr->cmdrsp = LAPB_UNKNOWN;
  84. else if(hdr->source[ALEN] & C)
  85. hdr->cmdrsp = LAPB_RESPONSE;
  86. else
  87. hdr->cmdrsp = LAPB_COMMAND;
  89. hdr->ndigis = 0;
  90. hdr->nextdigi = 0;
  91. if(hdr->source[ALEN] & E)
  92. return 2; /* No digis */
  94. /* Count and process the digipeaters */
  95. axp = hdr->digis[0];
  96. while(hdr->ndigis < MAXDIGIS && pullup(bpp,axp,AXALEN) == AXALEN){
  97. hdr->ndigis++;
  98. if(axp[ALEN] & REPEATED)
  99. hdr->nextdigi++;
  100. if(axp[ALEN] & E) /* Last one */
  101. return hdr->ndigis + 2;
  102. axp += AXALEN;
  103. }
  104. return -1; /* Too many digis */
  105. }