开通博客赚积分
发布资源赚积分
分类

源码开发语言/平台
当前位置：首页 > 源码/资料 > Internet/网络编程 > SNMP编程 > 查看源码
asn1.c
资源名称：snmp.src.rar　[点击查看]
上传用户：cxs890
上传日期：2021-05-22
资源大小：347k
文件大小：56k
源码类别：

SNMP编程

开发平台：

C/C++

asn1.c：源码内容
  1. /*
  2.  * Abstract Syntax Notation One, ASN.1
  3.  * As defined in ISO/IS 8824 and ISO/IS 8825
  4.  * This implements a subset of the above International Standards that
  5.  * is sufficient to implement SNMP.
  6.  *
  7.  * Encodes abstract data types into a machine independent stream of bytes.
  8.  *
  9.  */
  10. /**********************************************************************
  11. Copyright 1988, 1989, 1991, 1992 by Carnegie Mellon University
  13.                       All Rights Reserved
  15. Permission to use, copy, modify, and distribute this software and its 
  16. documentation for any purpose and without fee is hereby granted, 
  17. provided that the above copyright notice appear in all copies and that
  18. both that copyright notice and this permission notice appear in 
  19. supporting documentation, and that the name of CMU not be
  20. used in advertising or publicity pertaining to distribution of the
  21. software without specific, written prior permission.  
  23. CMU DISCLAIMS ALL WARRANTIES WITH REGARD TO THIS SOFTWARE, INCLUDING
  24. ALL IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS, IN NO EVENT SHALL
  25. CMU BE LIABLE FOR ANY SPECIAL, INDIRECT OR CONSEQUENTIAL DAMAGES OR
  26. ANY DAMAGES WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS,
  27. WHETHER IN AN ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION,
  28. ARISING OUT OF OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS
  29. SOFTWARE.
  30. ******************************************************************/
  31. #include <config.h>
  33. #ifdef KINETICS
  34. #include "gw.h"
  35. #endif
  37. #if HAVE_STRING_H
  38. #include <string.h>
  39. #else
  40. #include <strings.h>
  41. #endif
  43. #include <sys/types.h>
  44. #include <stdio.h>
  45. #ifdef HAVE_STDLIB_H
  46. #include <stdlib.h>
  47. #endif
  48. #if HAVE_WINSOCK_H
  49. #include <ip/socket.h>
  50. #endif
  51. #if HAVE_NETINET_IN_H
  52. #include <netinet/in.h>
  53. #endif
  55. #ifdef vms
  56. #include <in.h>
  57. #endif
  59. #if HAVE_DMALLOC_H
  60. #include <dmalloc.h>
  61. #endif
  63. #include "asn1.h"
  64. #include "int64.h"
  65. #include "snmp_debug.h"
  66. #include "mib.h"
  68. #ifndef NULL
  69. #define NULL 0
  70. #endif
  72. #include "snmp_api.h"
  73. #include "snmp_impl.h" /* to define ERROR_MSG */
  75. static
  76. void _asn_size_err(const char *str, size_t wrongsize, size_t rightsize)
  77. {
  78.     char ebuf[128];
  80.     sprintf(ebuf,"%s size %d: s/b %d",str, wrongsize, rightsize);
  81.     ERROR_MSG(ebuf);
  82. }
  84. static
  85. void _asn_length_err(const char *str, size_t wrongsize, size_t rightsize)
  86. {
  87.     char ebuf[128];
  89.     sprintf(ebuf,"%s length %d too large: exceeds %d",str, wrongsize, rightsize);
  90.     ERROR_MSG(ebuf);
  91. }
  93. /*
  94.  * call after asn_parse_length to verify result.
  95.  */
  96. static
  97. int _asn_parse_length_check(const char *str,
  98.                    u_char *bufp, u_char *data,
  99.                    u_long plen, size_t dlen)
  100. {
  101.     char ebuf[128];
  102.     size_t header_len;
  104.     if (bufp == NULL){
  105. /* error message is set */
  106. return 1;
  107.     }
  108.     header_len = bufp - data;
  109.     if (((size_t)plen + header_len) > dlen){
  110. sprintf(ebuf, "%s: message overflow: %d len + %d delta > %d len",
  111. str, (int)plen, (int)header_len, (int)dlen);
  112. ERROR_MSG(ebuf);
  113. return 1;
  114.     }
  115.     return 0;
  116. }
  118. /*
  119.  * call after asn_build_header to verify result.
  120.  */
  121. static
  122. int _asn_build_header_check(const char *str, u_char *data,
  123.                       size_t datalen, size_t typedlen)
  124. {
  125.     char ebuf[128];
  126.     
  127.     if (data == NULL){
  128. /* error message is set */
  129. return 1;
  130.     }
  131.     if (datalen < typedlen){
  132. sprintf(ebuf, "%s: bad header, length too short: %d < %d", str, datalen, typedlen);
  133. ERROR_MSG(ebuf);
  134. return 1;
  135.     }
  136.     return 0;
  137. }
  139. /* checks the incoming packet for validity and returns its size or 0 */
  140. int
  141. asn_check_packet (u_char *pkt, size_t len)
  142. {
  143.   u_long asn_length;
  144.   
  145.   if (len < 2)
  146.     return 0;      /* always too short */
  148.   if (*pkt != (u_char)(ASN_SEQUENCE | ASN_CONSTRUCTOR))
  149.     return -1;     /* wrong type */
  151.   if (*(pkt+1) & 0x80) {
  152.     /* long length */
  153.     if ((int)len < (int)(*(pkt+1) & ~0x80)+2)
  154.       return 0;    /* still to short, incomplete length */
  155.     asn_parse_length(pkt+1, &asn_length);
  156.     return (asn_length + 2 + (*(pkt+1) & ~0x80));
  157.   } else {
  158.     /* short length */
  159.     return (*(pkt+1) + 2);
  160.   }
  161. }
  163. static
  164. int _asn_bitstring_check(const char * str, u_long asn_length, u_char datum)
  165. {
  166.     char ebuf[128];
  168.     if (asn_length < 1){
  169. sprintf(ebuf,"%s: length %d too small", str, (int)asn_length);
  170. ERROR_MSG(ebuf);
  171. return 1;
  172.     }
  173.     if (datum > 7){
  174. sprintf(ebuf,"%s: datum %d >7: too large", str, (int)(datum));
  175. ERROR_MSG(ebuf);
  176. return 1;
  177.     }
  178.     return 0;
  179. }
  181. /*
  182.  * asn_parse_int - pulls a long out of an ASN int type.
  183.  *  On entry, datalength is input as the number of valid bytes following
  184.  *   "data".  On exit, it is returned as the number of valid bytes
  185.  *   following the end of this object.
  186.  *
  187.  *  Returns a pointer to the first byte past the end
  188.  *   of this object (i.e. the start of the next object).
  189.  *  Returns NULL on any error.
  191.   u_char * asn_parse_int(
  192.       u_char     *data         IN - pointer to start of object
  193.       int        *datalength   IN/OUT - number of valid bytes left in buffer
  194.       u_char     *type         OUT - asn type of object
  195.       long       *intp         IN/OUT - pointer to start of output buffer
  196.       int         intsize      IN - size of output buffer
  197. */
  199. u_char *
  200. asn_parse_int(u_char *data,
  201.       size_t *datalength,
  202.       u_char *type,
  203.       long *intp,
  204.       size_t intsize)
  205. {
  206. /*
  207.  * ASN.1 integer ::= 0x02 asnlength byte {byte}*
  208.  */
  209.     static const char *errpre = "parse int";
  210.     register u_char *bufp = data;
  211.     u_long     asn_length;
  212.     register long   value = 0;
  214.     if (intsize != sizeof (long)){
  215. _asn_size_err(errpre, intsize, sizeof(long));
  216. return NULL;
  217.     }
  218.     *type = *bufp++;
  219.     bufp = asn_parse_length(bufp, &asn_length);
  220.     if (_asn_parse_length_check(errpre, bufp, data, asn_length, *datalength))
  221. return NULL;
  223.     if ((size_t)asn_length > intsize){
  224. _asn_length_err(errpre, (size_t)asn_length, intsize);
  225. return NULL;
  226.     }
  228.     *datalength -= (int)asn_length + (bufp - data);
  229.     if (*bufp & 0x80)
  230. value = -1; /* integer is negative */
  232.     DEBUGDUMPSETUP("dump_recv", data, bufp - data + asn_length);
  234.     while(asn_length--)
  235. value = (value << 8) | *bufp++;
  237.     DEBUGMSG(("dump_recv", "  ASN Integer:t%ld (0x%.2X)n", value, value));
  239.     *intp = value;
  240.     return bufp;
  241. }
  244. /*
  245.  * asn_parse_unsigned_int - pulls an unsigned long out of an ASN int type.
  246.  *  On entry, datalength is input as the number of valid bytes following
  247.  *   "data".  On exit, it is returned as the number of valid bytes
  248.  *   following the end of this object.
  249.  *
  250.  *  Returns a pointer to the first byte past the end
  251.  *   of this object (i.e. the start of the next object).
  252.  *  Returns NULL on any error.
  254.   u_char * asn_parse_unsigned_int(
  255.       u_char     *data         IN - pointer to start of object
  256.       int        *datalength   IN/OUT - number of valid bytes left in buffer
  257.       u_char     *type         OUT - asn type of object
  258.       u_long     *intp         IN/OUT - pointer to start of output buffer
  259.       int         intsize      IN - size of output buffer
  260.  */
  261. u_char *
  262. asn_parse_unsigned_int(u_char *data,
  263.        size_t *datalength,
  264.        u_char *type,
  265.        u_long *intp,
  266.        size_t intsize)
  267. {
  268. /*
  269.  * ASN.1 integer ::= 0x02 asnlength byte {byte}*
  270.  */
  271.     static const char *errpre = "parse uint";
  272.     register u_char *bufp = data;
  273.     u_long     asn_length;
  274.     register u_long value = 0;
  276.     if (intsize != sizeof (long)){
  277. _asn_size_err(errpre, intsize, sizeof(long));
  278. return NULL;
  279.     }
  280.     *type = *bufp++;
  281.     bufp = asn_parse_length(bufp, &asn_length);
  282.     if (_asn_parse_length_check(errpre, bufp, data, asn_length, *datalength))
  283. return NULL;
  285.     if (((int)asn_length > (intsize + 1)) ||
  286. (((int)asn_length == intsize + 1) && *bufp != 0x00)){
  287. _asn_length_err(errpre, (size_t)asn_length, intsize);
  288. return NULL;
  289.     }
  290.     *datalength -= (int)asn_length + (bufp - data);
  291.     if (*bufp & 0x80)
  292. value = ~value; /* integer is negative */
  294.     DEBUGDUMPSETUP("dump_recv", data, bufp - data + asn_length);
  296.     while(asn_length--)
  297. value = (value << 8) | *bufp++;
  299.     DEBUGMSG(("dump_recv", "  ASN UInteger:t%ld (0x%.2X)n", value, value));
  301.     *intp = value;
  302.     return bufp;
  303. }
  306. /*
  307.  * asn_build_int - builds an ASN object containing an integer.
  308.  *  On entry, datalength is input as the number of valid bytes following
  309.  *   "data".  On exit, it is returned as the number of valid bytes
  310.  *   following the end of this object.
  311.  *
  312.  *  Returns a pointer to the first byte past the end
  313.  *   of this object (i.e. the start of the next object).
  314.  *  Returns NULL on any error.
  316.   u_char * asn_build_int(
  317.       u_char     *data         IN - pointer to start of output buffer
  318.       int        *datalength   IN/OUT - number of valid bytes left in buffer
  319.       int         type         IN  - asn type of object
  320.       long       *intp         IN - pointer to start of long integer
  321.       int         intsize      IN - size of input buffer
  322.  */
  323. u_char *
  324. asn_build_int(u_char *data,
  325.       size_t *datalength,
  326.       u_char type,
  327.       long *intp,
  328.       size_t intsize)
  329. {
  330. /*
  331.  * ASN.1 integer ::= 0x02 asnlength byte {byte}*
  332.  */
  333. static const char *errpre = "build int";
  334.     register long integer;
  335.     register u_long mask;
  337.     if (intsize != sizeof (long)){
  338. _asn_size_err(errpre, intsize, sizeof(long));
  339. return NULL;
  340.     }
  341.     integer = *intp;
  342.     /*
  343.      * Truncate "unnecessary" bytes off of the most significant end of this
  344.      * 2's complement integer.  There should be no sequence of 9
  345.      * consecutive 1's or 0's at the most significant end of the
  346.      * integer.
  347.      */
  348.     mask = ((u_long) 0x1FF) << ((8 * (sizeof(long) - 1)) - 1);
  349.     /* mask is 0xFF800000 on a big-endian machine */
  350.     while((((integer & mask) == 0) || ((integer & mask) == mask))
  351.   && intsize > 1){
  352. intsize--;
  353. integer <<= 8;
  354.     }
  355.     data = asn_build_header(data, datalength, type, intsize);
  356.     if (_asn_build_header_check(errpre,data,*datalength,intsize))
  357. return NULL;
  359.     *datalength -= intsize;
  360.     mask = ((u_long) 0xFF) << (8 * (sizeof(long) - 1));
  361.     /* mask is 0xFF000000 on a big-endian machine */
  362.     while(intsize--){
  363. *data++ = (u_char)((integer & mask) >> (8 * (sizeof(long) - 1)));
  364. integer <<= 8;
  365.     }
  366.     return data;
  367. }
  370. /*
  371.  * asn_build_unsigned_int - builds an ASN object containing an integer.
  372.  *  On entry, datalength is input as the number of valid bytes following
  373.  *   "data".  On exit, it is returned as the number of valid bytes
  374.  *   following the end of this object.
  375.  *
  376.  *  Returns a pointer to the first byte past the end
  377.  *   of this object (i.e. the start of the next object).
  378.  *  Returns NULL on any error.
  380.   u_char * asn_build_unsigned_int(
  381.       u_char     *data         IN - pointer to start of output buffer
  382.       int        *datalength   IN/OUT - number of valid bytes left in buffer
  383.       u_char      type         IN  - asn type of object
  384.       u_long     *intp         IN - pointer to start of long integer
  385.       int         intsize      IN - size of input buffer
  386.  */
  387. u_char *
  388. asn_build_unsigned_int(u_char *data,
  389.        size_t *datalength,
  390.        u_char type,
  391.        u_long *intp,
  392.        size_t intsize)
  393. {
  394. /*
  395.  * ASN.1 integer ::= 0x02 asnlength byte {byte}*
  396.  */
  397. static const char *errpre = "build uint";
  398.     register u_long integer;
  399.     register u_long mask;
  400.     int add_null_byte = 0;
  402.     if (intsize != sizeof (long)){
  403. _asn_size_err(errpre, intsize, sizeof(long));
  404. return NULL;
  405.     }
  406.     integer = *intp;
  407.     mask = ((u_long) 0xFF) << (8 * (sizeof(long) - 1));
  408.     /* mask is 0xFF000000 on a big-endian machine */
  409.     if ((u_char)((integer & mask) >> (8 * (sizeof(long) - 1))) & 0x80){
  410. /* if MSB is set */
  411. add_null_byte = 1;
  412. intsize++;
  413.     } else {
  414. /*
  415.  * Truncate "unnecessary" bytes off of the most significant end of this 2's complement integer.
  416.  * There should be no sequence of 9 consecutive 1's or 0's at the most significant end of the
  417.  * integer.
  418.  */
  419. mask = ((u_long) 0x1FF) << ((8 * (sizeof(long) - 1)) - 1);
  420. /* mask is 0xFF800000 on a big-endian machine */
  421. while((((integer & mask) == 0) || ((integer & mask) == mask)) && intsize > 1){
  422.     intsize--;
  423.     integer <<= 8;
  424. }
  425.     }
  426.     data = asn_build_header(data, datalength, type, intsize);
  427.     if (_asn_build_header_check(errpre,data,*datalength,intsize))
  428. return NULL;
  430.     *datalength -= intsize;
  431.     if (add_null_byte == 1){
  432. *data++ = '';
  433. intsize--;
  434.     }
  435.     mask = ((u_long) 0xFF) << (8 * (sizeof(long) - 1));
  436.     /* mask is 0xFF000000 on a big-endian machine */
  437.     while(intsize--){
  438. *data++ = (u_char)((integer & mask) >> (8 * (sizeof(long) - 1)));
  439. integer <<= 8;
  440.     }
  441.     return data;
  442. }
  445. /*
  446.  * asn_parse_string - pulls an octet string out of an ASN octet string type.
  447.  *  On entry, datalength is input as the number of valid bytes following
  448.  *   "data".  On exit, it is returned as the number of valid bytes
  449.  *   following the beginning of the next object.
  450.  *
  451.  *  "string" is filled with the octet string.
  452.  *
  453.  *  Returns a pointer to the first byte past the end
  454.  *   of this object (i.e. the start of the next object).
  455.  *  Returns NULL on any error.
  456.  *
  457.  * u_char * asn_parse_string(
  458.  *     u_char     *data         IN - pointer to start of object
  459.  *     int        *datalength   IN/OUT - number of valid bytes left in buffer
  460.  *     u_char     *type         OUT - asn type of object
  461.  *     u_char     *string       IN/OUT - pointer to start of output buffer
  462.  *     int        *strlength    IN/OUT - size of output buffer
  463.  *
  464.  *
  465.  * ASN.1 octet string ::=      primstring | cmpdstring
  466.  * primstring ::= 0x04 asnlength byte {byte}*
  467.  * cmpdstring ::= 0x24 asnlength string {string}*
  468.  */
  469. u_char *
  470. asn_parse_string(u_char *data,
  471.  size_t *datalength,
  472.  u_char *type,
  473.  u_char *string,
  474.  size_t *strlength)
  475. {
  476.     static const char *errpre = "parse string";
  477.     u_char *bufp = data;
  478.     u_long  asn_length;
  480.     *type = *bufp++;
  481.     bufp = asn_parse_length(bufp, &asn_length);
  482.     if (_asn_parse_length_check(errpre, bufp, data, asn_length, *datalength))
  483. return NULL;
  485.     if ((int)asn_length > *strlength){
  486. _asn_length_err(errpre, (size_t)asn_length, *strlength);
  487. return NULL;
  488.     }
  490.     DEBUGDUMPSETUP("dump_recv", data, bufp - data + asn_length);
  492.     memmove(string, bufp, asn_length);
  493.     if (*strlength > (int)asn_length)
  494.       string[asn_length] = 0;
  495.     *strlength = (int)asn_length;
  496.     *datalength -= (int)asn_length + (bufp - data);
  498.     DEBUGIF("dump_recv") {
  499.       char *buf = (char *)malloc(1+asn_length);
  500.       sprint_asciistring(buf, string, asn_length);
  501.       DEBUGMSG(("dump_recv", "  ASN String:t%sn", buf));
  502.       free (buf);
  503.     }
  504.         
  505.     return bufp + asn_length;
  506. }
  509. /*
  510.  * asn_build_string - Builds an ASN octet string object containing the input string.
  511.  *  On entry, datalength is input as the number of valid bytes following
  512.  *   "data".  On exit, it is returned as the number of valid bytes
  513.  *   following the beginning of the next object.
  514.  *
  515.  *  Returns a pointer to the first byte past the end
  516.  *   of this object (i.e. the start of the next object).
  517.  *  Returns NULL on any error.
  519.   u_char * asn_build_string(
  520.       u_char     *data         IN - pointer to start of object
  521.       int        *datalength   IN/OUT - number of valid bytes left in buffer
  522.       u_char      type         IN - asn type of object
  523.       u_char     *string       IN - pointer to start of input buffer
  524.       int         strlength    IN - size of input buffer
  525.  */
  526. u_char *
  527. asn_build_string(u_char *data,
  528.  size_t *datalength,
  529.  u_char type,
  530.  const u_char *string,
  531.  size_t strlength)
  532. {
  533. /*
  534.  * ASN.1 octet string ::= primstring | cmpdstring
  535.  * primstring ::= 0x04 asnlength byte {byte}*
  536.  * cmpdstring ::= 0x24 asnlength string {string}*
  537.  * This code will never send a compound string.
  538.  */
  539.     data = asn_build_header(data, datalength, type, strlength);
  540.     if (_asn_build_header_check("build string", data, *datalength, strlength))
  541. return NULL;
  543.     if (strlength) {
  544.       if (string == NULL) {
  545. memset(data, 0, strlength);
  546.       } else {
  547. memmove(data, string, strlength);
  548.       }
  549.     }
  550.     *datalength -= strlength;
  551.     return data + strlength;
  552. }
  556. /*
  557.  * asn_parse_header - interprets the ID and length of the current object.
  558.  *  On entry, datalength is input as the number of valid bytes following
  559.  *   "data".  On exit, it is returned as the number of valid bytes
  560.  *   in this object following the id and length.
  561.  *
  562.  *  Returns a pointer to the first byte of the contents of this object.
  563.  *  Returns NULL on any error.
  565.   u_char * asn_parse_header(
  566.       u_char     *data         IN - pointer to start of object
  567.       int        *datalength   IN/OUT - number of valid bytes left in buffer
  568.       u_char     *type         OUT - asn type of object
  569.  */
  570. u_char *
  571. asn_parse_header(u_char *data,
  572.  size_t *datalength,
  573.  u_char *type)
  574. {
  575.     register u_char *bufp;
  576.     u_long     asn_length;
  578.     if (!data || !datalength || !type) {
  579. ERROR_MSG("parse header: NULL pointer");
  580. return NULL;
  581.     }
  582.     bufp = data;
  583.     /* this only works on data types < 30, i.e. no extension octets */
  584.     if (IS_EXTENSION_ID(*bufp)){
  585. ERROR_MSG("can't process ID >= 30");
  586. return NULL;
  587.     }
  588.     *type = *bufp;
  589.     bufp = asn_parse_length(bufp + 1, &asn_length);
  590.     if (_asn_parse_length_check("parse header", bufp, data, asn_length, *datalength))
  591. return NULL;
  593.     DEBUGDUMPSETUP("dump_recv", data, (bufp-data));
  594.     DEBUGMSG(("dump_recv", "  ASN Header: 0x%.2X, len = %d (0x%X)n", *data,
  595.               asn_length, asn_length));
  597. #ifdef OPAQUE_SPECIAL_TYPES
  599.     if ((*type == ASN_OPAQUE) &&
  600.         (*bufp == ASN_OPAQUE_TAG1)) {
  601.       DEBUGINDENTMORE();
  602.       DEBUGDUMPSETUP("dump_recv", data, 1);
  603.       DEBUGMSG(("dump_recv", "Opaque:t%.2xn", *bufp));
  604.       DEBUGINDENTLESS();
  606.       /* check if 64-but counter */
  607.       switch(*(bufp+1)) {
  608.         case ASN_OPAQUE_COUNTER64:
  609.         case ASN_OPAQUE_U64:
  610.         case ASN_OPAQUE_FLOAT:
  611.         case ASN_OPAQUE_DOUBLE:
  612.         case ASN_OPAQUE_I64:
  613.           *type = *(bufp+1);
  614.           break;
  615.         
  616.         default:
  617.           /* just an Opaque */
  618.           *datalength = (int)asn_length;
  619.           return bufp;
  620.       }
  621.       /* value is encoded as special format */
  622.       bufp = asn_parse_length(bufp + 2, &asn_length);
  623.       if (_asn_parse_length_check("parse opaque header", bufp, data,
  624.                   asn_length, *datalength))
  625.         return NULL;
  626.     }
  627. #endif /* OPAQUE_SPECIAL_TYPES */
  629.     *datalength = (int)asn_length;
  631.     return bufp;
  632. }
  634. /*
  635.  * same as asn_parse_header with test for expected type.
  636.  */
  637. u_char *
  638. asn_parse_sequence(u_char *data,
  639.  size_t *datalength,
  640.  u_char *type,
  641.  u_char expected_type, /* must be this type */
  642.  const char *estr) /* error message prefix */
  643. {
  644.     data = asn_parse_header(data, datalength, type);
  645.     if (data && (*type != expected_type)) {
  646. char ebuf[128];
  647. sprintf(ebuf, "%s header type %02X: s/b %02X", estr,
  648. (u_char)*type, (u_char)expected_type);
  649. ERROR_MSG(ebuf);
  650. return NULL;
  651.     }
  652.     return data;
  653. }
  657. /*
  658.  * asn_build_header - builds an ASN header for an object with the ID and
  659.  * length specified.
  660.  *  On entry, datalength is input as the number of valid bytes following
  661.  *   "data".  On exit, it is returned as the number of valid bytes
  662.  *   in this object following the id and length.
  663.  *
  664.  *  This only works on data types < 30, i.e. no extension octets.
  665.  *  The maximum length is 0xFFFF;
  666.  *
  667.  *  Returns a pointer to the first byte of the contents of this object.
  668.  *  Returns NULL on any error.
  670.   u_char * asn_build_header(
  671.       u_char     *data         IN - pointer to start of object
  672.       size_t     *datalength   IN/OUT - number of valid bytes left in buffer
  673.       u_char      type         IN - asn type of object
  674.       size_t      length       IN - length of object
  675.  */
  676. u_char *
  677. asn_build_header (u_char *data,
  678.   size_t *datalength,
  679.   u_char type,
  680.   size_t length)
  681. {
  682.     char ebuf[128];
  683.     
  684.     if (*datalength < 1){
  685. sprintf(ebuf, "bad header length < 1 :%d, %d", *datalength, length);
  686. ERROR_MSG(ebuf);
  687. return NULL;
  688.     }     
  689.     *data++ = type;
  690.     (*datalength)--;
  691.     return asn_build_length(data, datalength, length);
  692. }
  694. /*
  695.  * asn_build_sequence - builds an ASN header for a sequence with the ID and
  696.  * length specified.
  697.  *  On entry, datalength is input as the number of valid bytes following
  698.  *   "data".  On exit, it is returned as the number of valid bytes
  699.  *   in this object following the id and length.
  700.  *
  701.  *  This only works on data types < 30, i.e. no extension octets.
  702.  *  The maximum length is 0xFFFF;
  703.  *
  704.  *  Returns a pointer to the first byte of the contents of this object.
  705.  *  Returns NULL on any error.
  707.   u_char * asn_build_sequence(
  708.       u_char     *data         IN - pointer to start of object
  709.       int        *datalength   IN/OUT - number of valid bytes left in buffer
  710.       u_char      type         IN - asn type of object
  711.       int         length       IN - length of object
  712.  */
  713. u_char *
  714. asn_build_sequence(u_char *data,
  715.   size_t *datalength,
  716.   u_char type,
  717.   size_t length)
  718. {
  719.     static const char *errpre = "build seq";
  720.     char ebuf[128];
  721.     
  722.     if (*datalength < 4){
  723. sprintf(ebuf, "%s: length %d < 4: PUNT", errpre, (int)*datalength);
  724. ERROR_MSG(ebuf);
  725. return NULL;
  726.     }
  727.     *datalength -= 4;
  728.     *data++ = type;
  729.     *data++ = (u_char)(0x02 | ASN_LONG_LEN);
  730.     *data++ = (u_char)((length >> 8) & 0xFF);
  731.     *data++ = (u_char)(length & 0xFF);
  732.     return data;
  733. }
  735. /*
  736.  * asn_parse_length - interprets the length of the current object.
  737.  *  On exit, length contains the value of this length field.
  738.  *
  739.  *  Returns a pointer to the first byte after this length
  740.  *  field (aka: the start of the data field).
  741.  *  Returns NULL on any error.
  743.   u_char * asn_parse_length(
  744.       u_char     *data         IN - pointer to start of length field
  745.       u_long     *length       OUT - value of length field
  746.  */
  747. u_char *
  748. asn_parse_length(u_char  *data,
  749.  u_long  *length)
  750. {
  751.     static const char *errpre = "parse length";
  752.     char ebuf[128];
  753.     register u_char lengthbyte;
  754.     
  755.     if (!data || !length) {
  756. ERROR_MSG("parse length: NULL pointer");
  757. return NULL;
  758.     }
  759.     lengthbyte = *data;
  761.     if (lengthbyte & ASN_LONG_LEN){
  762. lengthbyte &= ~ASN_LONG_LEN; /* turn MSb off */
  763. if (lengthbyte == 0){
  764.     sprintf(ebuf, "%s: indefinite length not supported", errpre);
  765.     ERROR_MSG(ebuf);
  766.     return NULL;
  767. }
  768. if (lengthbyte > sizeof(long)){
  769.     sprintf(ebuf, "%s: data length %d > %d not supported", errpre,
  770.                  lengthbyte, sizeof(long));
  771.     ERROR_MSG(ebuf);
  772.     return NULL;
  773. }
  774. data++;
  775. *length = 0;  /* protect against short lengths */
  776. while(lengthbyte--) {
  777. *length <<= 8;
  778. *length |= *data++;
  779. }
  780. return data;
  781.     } else { /* short asnlength */
  782. *length = (long)lengthbyte;
  783. return data + 1;
  784.     }
  785. }
  787. /*
  789.   u_char * asn_build_length(
  790.       u_char     *data         IN - pointer to start of object
  791.       int        *datalength   IN/OUT - number of valid bytes left in buffer
  792.       int         length       IN - length of object
  793.  */
  794. u_char *
  795. asn_build_length(u_char *data,
  796.  size_t *datalength,
  797.  size_t length)
  798. {
  799.     static const char *errpre = "build length";
  800.     char ebuf[128];
  801.     
  802.     u_char    *start_data = data;
  804.     /* no indefinite lengths sent */
  805.     if (length < 0x80){
  806. if (*datalength < 1){
  807.     sprintf(ebuf, "%s: bad length < 1 :%d, %d",errpre,*datalength,length);
  808.     ERROR_MSG(ebuf);
  809.     return NULL;
  810. }     
  811. *data++ = (u_char)length;
  812.     } else if (length <= 0xFF){
  813. if (*datalength < 2){
  814.     sprintf(ebuf, "%s: bad length < 2 :%d, %d",errpre,*datalength,length);
  815.     ERROR_MSG(ebuf);
  816.     return NULL;
  817. }     
  818. *data++ = (u_char)(0x01 | ASN_LONG_LEN);
  819. *data++ = (u_char)length;
  820.     } else { /* 0xFF < length <= 0xFFFF */
  821. if (*datalength < 3){
  822.     sprintf(ebuf, "%s: bad length < 3 :%d, %d",errpre,*datalength,length);
  823.     ERROR_MSG(ebuf);
  824.     return NULL;
  825. }     
  826. *data++ = (u_char)(0x02 | ASN_LONG_LEN);
  827. *data++ = (u_char)((length >> 8) & 0xFF);
  828. *data++ = (u_char)(length & 0xFF);
  829.     }
  830.     *datalength -= (data - start_data);
  831.     return data;
  833. }
  835. /*
  836.  * asn_parse_objid - pulls an object indentifier out of an ASN object identifier type.
  837.  *  On entry, datalength is input as the number of valid bytes following
  838.  *   "data".  On exit, it is returned as the number of valid bytes
  839.  *   following the beginning of the next object.
  840.  *
  841.  *  "objid" is filled with the object identifier.
  842.  *
  843.  *  Returns a pointer to the first byte past the end
  844.  *   of this object (i.e. the start of the next object).
  845.  *  Returns NULL on any error.
  847.   u_char * asn_parse_objid(
  848.       u_char     *data         IN - pointer to start of object
  849.       int        *datalength   IN/OUT - number of valid bytes left in buffer
  850.       u_char     *type         OUT - asn type of object
  851.       oid        *objid        IN/OUT - pointer to start of output buffer
  852.       int        *objidlength  IN/OUT - number of sub-id's in objid
  853.  */
  854. u_char *
  855. asn_parse_objid(u_char *data,
  856. size_t *datalength,
  857. u_char *type,
  858. oid *objid,
  859. size_t *objidlength)
  860. {
  861. /*
  862.  * ASN.1 objid ::= 0x06 asnlength subidentifier {subidentifier}*
  863.  * subidentifier ::= {leadingbyte}* lastbyte
  864.  * leadingbyte ::= 1 7bitvalue
  865.  * lastbyte ::= 0 7bitvalue
  866.  */
  867.     register u_char *bufp = data;
  868.     register oid *oidp = objid + 1;
  869.     register u_long subidentifier;
  870.     register long   length;
  871.     u_long     asn_length;
  873.     *type = *bufp++;
  874.     bufp = asn_parse_length(bufp, &asn_length);
  875.     if (_asn_parse_length_check("parse objid", bufp, data,
  876.                     asn_length, *datalength))
  877. return NULL;
  879.     *datalength -= (int)asn_length + (bufp - data);
  881.     DEBUGDUMPSETUP("dump_recv", data, bufp - data + asn_length);
  883.     /* Handle invalid object identifier encodings of the form 06 00 robustly */
  884.     if (asn_length == 0)
  885. objid[0] = objid[1] = 0;
  887.     length = asn_length;
  888.     (*objidlength)--; /* account for expansion of first byte */
  890.     while (length > 0 && (*objidlength)-- > 0){
  891. subidentifier = 0;
  892. do { /* shift and add in low order 7 bits */
  893.     subidentifier = (subidentifier << 7) + (*(u_char *)bufp & ~ASN_BIT8);
  894.     length--;
  895. } while (*(u_char *)bufp++ & ASN_BIT8); /* last byte has high bit clear */
  896. /*?? note, this test will never be true, since the largest value
  897.      of subidentifier is the value of MAX_SUBID! */
  898. if (subidentifier > (u_long)MAX_SUBID){
  899.     ERROR_MSG("subidentifier too large");
  900.     return NULL;
  901. }
  902. *oidp++ = (oid)subidentifier;
  903.     }
  905.     /*
  906.      * The first two subidentifiers are encoded into the first component
  907.      * with the value (X * 40) + Y, where:
  908.      * X is the value of the first subidentifier.
  909.      *  Y is the value of the second subidentifier.
  910.      */
  911.     subidentifier = (u_long)objid[1];
  912.     if (subidentifier == 0x2B){
  913. objid[0] = 1;
  914. objid[1] = 3;
  915.     } else {
  916.         if (subidentifier < 40) {
  917.             objid[0] = 0;
  918.     objid[1] = subidentifier;
  919.         } else if (subidentifier < 80) {
  920.             objid[0] = 1;
  921.             objid[1] = subidentifier - 40;
  922.         } else if (subidentifier < 120) {
  923.             objid[0] = 2;
  924.             objid[1] = subidentifier - 80;
  925.         } else {
  926.     objid[1] = (subidentifier % 40);
  927.     objid[0] = ((subidentifier - objid[1]) / 40);
  928.         }
  929.     }
  931.     *objidlength = (int)(oidp - objid);
  933.     DEBUGMSG(("dump_recv", "  ASN ObjID: "));
  934.     DEBUGMSGOID(("dump_recv", objid, *objidlength));
  935.     DEBUGMSG(("dump_recv", "n"));
  936.     return bufp;
  937. }
  939. /*
  940.  * asn_build_objid - Builds an ASN object identifier object containing the
  941.  * input string.
  942.  *  On entry, datalength is input as the number of valid bytes following
  943.  *   "data".  On exit, it is returned as the number of valid bytes
  944.  *   following the beginning of the next object.
  945.  *
  946.  *  Returns a pointer to the first byte past the end
  947.  *   of this object (i.e. the start of the next object).
  948.  *  Returns NULL on any error.
  950.   u_char * asn_build_objid(
  951.       u_char     *data         IN - pointer to start of object
  952.       int        *datalength   IN/OUT - number of valid bytes left in buffer
  953.       int        type         IN - asn type of object
  954.       oid        *objid        IN - pointer to start of input buffer
  955.       int         objidlength  IN - number of sub-id's in objid
  956.  */
  957. u_char *
  958. asn_build_objid(u_char *data,
  959. size_t *datalength,
  960. u_char type,
  961. oid *objid,
  962. size_t objidlength)
  963. {
  964. /*
  965.  * ASN.1 objid ::= 0x06 asnlength subidentifier {subidentifier}*
  966.  * subidentifier ::= {leadingbyte}* lastbyte
  967.  * leadingbyte ::= 1 7bitvalue
  968.  * lastbyte ::= 0 7bitvalue
  969.  */
  970.     size_t asnlength;
  971.     register oid *op = objid;
  972.     u_char objid_size[MAX_OID_LEN];
  973.     register u_long objid_val;
  974.     u_long first_objid_val;
  975.     register int i;
  977.     /* check if there are at least 2 sub-identifiers */
  978.     if (objidlength == 0){
  979.         /* there are not, so make OID have two with value of zero */
  980.         objid_val = 0;
  981. objidlength = 2;
  982.     } else if (objidlength == 1){
  983.         /* encode the first value */
  984. objid_val = (op[0] * 40);
  985. objidlength = 2;
  986. op++;
  987.     } else {
  988.         /* combine the first two values */
  989. if ( op[1] > 40 ) {
  990.     ERROR_MSG("build objid: bad second subidentifier");
  991.     return NULL;
  992. }
  993. objid_val = (op[0] * 40) + op[1];
  994. op += 2;
  995.     }
  996.     first_objid_val = objid_val;
  998.     /* calculate the number of bytes needed to store the encoded value */
  999.     for (i = 1, asnlength = 0;;) {
  1000.         if (objid_val < (unsigned)0x80) {
  1001.             objid_size[i] = 1;
  1002.             asnlength += 1;
  1003.         } else if (objid_val < (unsigned)0x4000) {
  1004.             objid_size[i] = 2;
  1005.             asnlength += 2;
  1006.         } else if (objid_val < (unsigned)0x200000) {
  1007.             objid_size[i] = 3;
  1008.             asnlength += 3;
  1009.         } else if (objid_val < (unsigned)0x10000000) {
  1010.             objid_size[i] = 4;
  1011.             asnlength += 4;
  1012.         } else {
  1013.             objid_size[i] = 5;
  1014.             asnlength += 5;
  1015.         }
  1016.         i++;
  1017.         if (i >= (int)objidlength)
  1018.             break;
  1019.         objid_val = *op++;
  1020.     } 
  1022.     /* store the ASN.1 tag and length */
  1023.     data = asn_build_header(data, datalength, type, asnlength);
  1024.     if (_asn_build_header_check("build objid", data, *datalength, asnlength))
  1025. return NULL;
  1027.     /* store the encoded OID value */
  1028.     for (i = 1, objid_val = first_objid_val, op = objid+2;
  1029. i < (int)objidlength;
  1030.                 i++) {
  1031.       if (i != 1) objid_val = *op++;
  1032.         switch (objid_size[i]) {
  1033.         case 1:
  1034.             *data++ = (u_char)objid_val;
  1035.             break;
  1037.         case 2:
  1038.             *data++ = (u_char)((objid_val>>7) | 0x80);
  1039.             *data++ = (u_char)(objid_val & 0x07f);
  1040.             break;
  1042.         case 3:
  1043.             *data++ = (u_char)((objid_val>>14) | 0x80);
  1044.             *data++ = (u_char)((objid_val>>7 & 0x7f) | 0x80);
  1045.             *data++ = (u_char)(objid_val & 0x07f);
  1046.             break;
  1048.         case 4:
  1049.             *data++ = (u_char)((objid_val>>21) | 0x80);
  1050.             *data++ = (u_char)((objid_val>>14 & 0x7f) | 0x80);
  1051.             *data++ = (u_char)((objid_val>>7 & 0x7f) | 0x80);
  1052.             *data++ = (u_char)(objid_val & 0x07f);
  1053.             break;
  1055.         case 5:
  1056.             *data++ = (u_char)((objid_val>>28) | 0x80);
  1057.             *data++ = (u_char)((objid_val>>21 & 0x7f) | 0x80);
  1058.             *data++ = (u_char)((objid_val>>14 & 0x7f) | 0x80);
  1059.             *data++ = (u_char)((objid_val>>7 & 0x7f) | 0x80);
  1060.             *data++ = (u_char)(objid_val & 0x07f);
  1061.             break;
  1062.         }
  1063.     }
  1065.     /* return the length and data ptr */
  1066.     *datalength -= asnlength;
  1067.     return data;
  1068. }
  1070. /*
  1071.  * asn_parse_null - Interprets an ASN null type.
  1072.  *  On entry, datalength is input as the number of valid bytes following
  1073.  *   "data".  On exit, it is returned as the number of valid bytes
  1074.  *   following the beginning of the next object.
  1075.  *
  1076.  *  Returns a pointer to the first byte past the end
  1077.  *   of this object (i.e. the start of the next object).
  1078.  *  Returns NULL on any error.
  1080.   u_char * asn_parse_null(
  1081.       u_char     *data         IN - pointer to start of object
  1082.       int        *datalength   IN/OUT - number of valid bytes left in buffer
  1083.       u_char     *type         OUT - asn type of object
  1084.  */
  1085. u_char *
  1086. asn_parse_null(u_char *data,
  1087.        size_t *datalength,
  1088.        u_char *type)
  1089. {
  1090. /*
  1091.  * ASN.1 null ::= 0x05 0x00
  1092.  */
  1093.     register u_char   *bufp = data;
  1094.     u_long     asn_length;
  1096.     *type = *bufp++;
  1097.     bufp = asn_parse_length(bufp, &asn_length);
  1098.     if (bufp == NULL){
  1099. ERROR_MSG("parse null: bad length");
  1100. return NULL;
  1101.     }
  1102.     if (asn_length != 0){
  1103. ERROR_MSG("parse null: malformed ASN.1 null");
  1104. return NULL;
  1105.     }
  1107.     *datalength -= (bufp - data);
  1109.     DEBUGDUMPSETUP("dump_recv", data, bufp - data);
  1110.     DEBUGMSG(("dump_recv", "  ASN NULLn"));
  1112.     return bufp + asn_length;
  1113. }
  1116. /*
  1117.  * asn_build_null - Builds an ASN null object.
  1118.  *  On entry, datalength is input as the number of valid bytes following
  1119.  *   "data".  On exit, it is returned as the number of valid bytes
  1120.  *   following the beginning of the next object.
  1121.  *
  1122.  *  Returns a pointer to the first byte past the end
  1123.  *   of this object (i.e. the start of the next object).
  1124.  *  Returns NULL on any error.
  1126.   u_char * asn_build_null(
  1127.       u_char     *data         IN - pointer to start of object
  1128.       int        *datalength   IN/OUT - number of valid bytes left in buffer
  1129.       u_char      type         IN - asn type of object
  1130.  */
  1131. u_char *
  1132. asn_build_null(u_char *data,
  1133.        size_t *datalength,
  1134.        u_char type)
  1135. {
  1136. /*
  1137.  * ASN.1 null ::= 0x05 0x00
  1138.  */
  1139.     return asn_build_header(data, datalength, type, 0);
  1140. }
  1142. /*
  1143.  * asn_parse_bitstring - pulls a bitstring out of an ASN bitstring type.
  1144.  *  On entry, datalength is input as the number of valid bytes following
  1145.  *   "data".  On exit, it is returned as the number of valid bytes
  1146.  *   following the beginning of the next object.
  1147.  *
  1148.  *  "string" is filled with the bit string.
  1149.  *
  1150.  *  Returns a pointer to the first byte past the end
  1151.  *   of this object (i.e. the start of the next object).
  1152.  *  Returns NULL on any error.
  1154.   u_char * asn_parse_bitstring(
  1155.       u_char     *data         IN - pointer to start of object
  1156.       size_t     *datalength   IN/OUT - number of valid bytes left in buffer
  1157.       u_char     *type         OUT - asn type of object
  1158.       u_char     *string       IN/OUT - pointer to start of output buffer
  1159.       size_t     *strlength    IN/OUT - size of output buffer
  1160.  */
  1161. u_char *
  1162. asn_parse_bitstring(u_char *data,
  1163.     size_t *datalength,
  1164.     u_char *type,
  1165.     u_char *string,
  1166.     size_t *strlength)
  1167. {
  1168. /*
  1169.  * bitstring ::= 0x03 asnlength unused {byte}*
  1170.  */
  1171.     static const char *errpre = "parse bitstring";
  1172.     register u_char *bufp = data;
  1173.     u_long     asn_length;
  1175.     *type = *bufp++;
  1176.     bufp = asn_parse_length(bufp, &asn_length);
  1177.     if (_asn_parse_length_check(errpre, bufp, data,
  1178.                asn_length, *datalength))
  1179. return NULL;
  1181.     if ((size_t)asn_length > *strlength){
  1182. _asn_length_err(errpre, (size_t)asn_length, *strlength);
  1183. return NULL;
  1184.     }
  1185.     if (_asn_bitstring_check(errpre, asn_length, *bufp))
  1186. return NULL;
  1188.     DEBUGDUMPSETUP("dump_recv", data, bufp - data);
  1189.     DEBUGMSG(("dump_recv", "  ASN Bitstring: "));
  1190.     DEBUGMSGHEX(("dump_recv", data, asn_length));
  1192.     memmove(string, bufp, asn_length);
  1193.     *strlength = (int)asn_length;
  1194.     *datalength -= (int)asn_length + (bufp - data);
  1195.     return bufp + asn_length;
  1196. }
  1199. /*
  1200.  * asn_build_bitstring - Builds an ASN bit string object containing the
  1201.  * input string.
  1202.  *  On entry, datalength is input as the number of valid bytes following
  1203.  *   "data".  On exit, it is returned as the number of valid bytes
  1204.  *   following the beginning of the next object.
  1205.  *
  1206.  *  Returns a pointer to the first byte past the end
  1207.  *   of this object (i.e. the start of the next object).
  1208.  *  Returns NULL on any error.
  1210.   u_char * asn_build_bitstring(
  1211.       u_char     *data         IN - pointer to start of object
  1212.       int        *datalength   IN/OUT - number of valid bytes left in buffer
  1213.       u_char      type         IN - asn type of object
  1214.       u_char     *string       IN - pointer to start of input buffer
  1215.       int         strlength    IN - size of input buffer
  1216.  */
  1217. u_char *
  1218. asn_build_bitstring(u_char *data,
  1219.     size_t *datalength,
  1220.     u_char type,
  1221.     u_char *string,
  1222.     size_t strlength)
  1223. {
  1224. /*
  1225.  * ASN.1 bit string ::= 0x03 asnlength unused {byte}*
  1226.  */
  1227.     static const char *errpre = "build bitstring";
  1228.     if (_asn_bitstring_check(errpre, strlength, *string))
  1229. return NULL;
  1231.     data = asn_build_header(data, datalength, type, strlength);
  1232.     if (_asn_build_header_check(errpre,data,*datalength,strlength))
  1233. return NULL;
  1235.     memmove(data, string, strlength);
  1236.     *datalength -= strlength;
  1237.     return data + strlength;
  1238. }
  1241. /*
  1242.  * asn_parse_unsigned_int64 - pulls a 64 bit unsigned long out of an ASN int
  1243.  * type.
  1244.  *  On entry, datalength is input as the number of valid bytes following
  1245.  *   "data".  On exit, it is returned as the number of valid bytes
  1246.  *   following the end of this object.
  1247.  *
  1248.  *  Returns a pointer to the first byte past the end
  1249.  *   of this object (i.e. the start of the next object).
  1250.  *  Returns NULL on any error.
  1252.   u_char * asn_parse_unsigned_int64(
  1253.       u_char     *data         IN - pointer to start of object
  1254.       int        *datalength   IN/OUT - number of valid bytes left in buffer
  1255.       u_char     *type         OUT - asn type of object
  1256.       struct counter64 *cp     IN/OUT - pointer to counter struct
  1257.       int         countersize  IN - size of output buffer
  1258.  */
  1259. u_char *
  1260. asn_parse_unsigned_int64(u_char *data,
  1261.  size_t *datalength,
  1262.  u_char *type, 
  1263.  struct counter64 *cp,
  1264.  size_t countersize)
  1265. {
  1266. /*
  1267.  * ASN.1 integer ::= 0x02 asnlength byte {byte}*
  1268.  */
  1269.     static const char *errpre = "parse uint64";
  1270.     const int uint64sizelimit = (4 * 2) + 1;
  1271.     register u_char *bufp = data;
  1272.     u_long     asn_length;
  1273.     register u_long low = 0, high = 0;
  1274.     
  1275.     if (countersize != sizeof(struct counter64)){
  1276. _asn_size_err(errpre, countersize, sizeof(struct counter64));
  1277. return NULL;
  1278.     }
  1279.     *type = *bufp++;
  1280.     bufp = asn_parse_length(bufp, &asn_length);
  1281.     if (_asn_parse_length_check(errpre, bufp, data, asn_length, *datalength))
  1282.         return NULL;
  1284.     DEBUGDUMPSETUP("dump_recv", data, bufp - data);
  1285. #ifdef OPAQUE_SPECIAL_TYPES
  1286. /* 64 bit counters as opaque */
  1287.     if ((*type == ASN_OPAQUE) &&
  1288.             (asn_length <= ASN_OPAQUE_COUNTER64_MX_BER_LEN) &&
  1289.     (*bufp == ASN_OPAQUE_TAG1) &&
  1290.     ((*(bufp+1) == ASN_OPAQUE_COUNTER64) ||
  1291.              (*(bufp+1) == ASN_OPAQUE_U64))) {
  1292.         DEBUGMSG(("dump_recv", "Opaque %.2x %.2x: ", *bufp, *(bufp+1)));
  1294. /* change type to Counter64 or U64 */
  1295.         *type = *(bufp+1);
  1296.         /* value is encoded as special format */
  1297. bufp = asn_parse_length(bufp + 2, &asn_length);
  1298. if (_asn_parse_length_check("parse opaque uint64", bufp, data,
  1299.                   asn_length, *datalength))
  1300.         return NULL;
  1301.     }
  1302. #endif /* OPAQUE_SPECIAL_TYPES */
  1303.     if (((int)asn_length > uint64sizelimit) ||
  1304. (((int)asn_length == uint64sizelimit) && *bufp != 0x00)){
  1305. _asn_length_err(errpre, (size_t)asn_length, uint64sizelimit);
  1306. return NULL;
  1307.     }
  1308.     *datalength -= (int)asn_length + (bufp - data);
  1309.     if (*bufp & 0x80){
  1310. low = ~low; /* integer is negative */
  1311. high = ~high;
  1312.     }
  1314.     while(asn_length--){
  1315. high = (high << 8) | ((low & 0xFF000000) >> 24);
  1316. low = (low << 8) | *bufp++;
  1317.     }
  1319.     cp->low = low;
  1320.     cp->high = high;
  1322.     DEBUGIF("dump_recv") {
  1323.       char i64buf[I64CHARSZ+1];
  1324.       printU64(i64buf, cp);
  1325.     }
  1327.     return bufp;
  1328. }
  1331. /*
  1332.  * asn_build_unsigned_int64 - builds an ASN object containing a 64 bit integer.
  1333.  *  On entry, datalength is input as the number of valid bytes following
  1334.  *   "data".  On exit, it is returned as the number of valid bytes
  1335.  *   following the end of this object.
  1336.  *
  1337.  *  Returns a pointer to the first byte past the end
  1338.  *   of this object (i.e. the start of the next object).
  1339.  *  Returns NULL on any error.
  1341.   u_char * asn_build_unsigned_int64(
  1342.       u_char     *data         IN - pointer to start of output buffer
  1343.       size_t     *datalength   IN/OUT - number of valid bytes left in buffer
  1344.       u_char      type         IN  - asn type of object
  1345.       struct counter64 *cp     IN - pointer to counter struct
  1346.       size_t      countersize  IN - size of input buffer
  1347.  */
  1348. u_char *
  1349. asn_build_unsigned_int64(u_char *data,
  1350.  size_t *datalength,
  1351.  u_char type,
  1352.  struct counter64 *cp,
  1353.  size_t countersize)
  1354. {
  1355. /*
  1356.  * ASN.1 integer ::= 0x02 asnlength byte {byte}*
  1357.  */
  1359.     register u_long low, high;
  1360.     register u_long mask, mask2;
  1361.     int add_null_byte = 0;
  1362.     size_t intsize;
  1364.   if (countersize != sizeof(struct counter64)){
  1365.     _asn_size_err("build uint64", countersize, sizeof(struct counter64));
  1366.     return NULL;
  1367.   }
  1368.     intsize = 8;
  1369.     low = cp->low;
  1370.     high = cp->high;
  1371.     mask = ((u_long) 0xFF) << (8 * (sizeof(long) - 1));
  1372.     /* mask is 0xFF000000 on a big-endian machine */
  1373.     if ((u_char)((high & mask) >> (8 * (sizeof(long) - 1))) & 0x80){
  1374. /* if MSB is set */
  1375. add_null_byte = 1;
  1376. intsize++;
  1377.     } else {
  1378. /*
  1379.  * Truncate "unnecessary" bytes off of the most significant end of this 2's
  1380.  * complement integer.
  1381.  * There should be no sequence of 9 consecutive 1's or 0's at the most
  1382.  * significant end of the integer.
  1383.  */
  1384. mask2 = ((u_long) 0x1FF) << ((8 * (sizeof(long) - 1)) - 1);
  1385. /* mask2 is 0xFF800000 on a big-endian machine */
  1386. while((((high & mask2) == 0) || ((high & mask2) == mask2)) && intsize > 1){
  1387.     intsize--;
  1388.     high = (high << 8)
  1389. | ((low & mask) >> (8 * (sizeof(long) - 1)));
  1390.     low <<= 8;
  1391. }
  1392.     }
  1393. #ifdef OPAQUE_SPECIAL_TYPES
  1394. /* encode a Counter64 as an opaque (it also works in SNMPv1) */
  1395.     /* turn into Opaque holding special tagged value */
  1396.     if (type == ASN_OPAQUE_COUNTER64) {
  1397.         /* put the tag and length for the Opaque wrapper */
  1398.         data = asn_build_header(data, datalength, ASN_OPAQUE, intsize+3);
  1399.     if (_asn_build_header_check("build counter u64", data, *datalength, intsize+3))
  1400. return NULL;
  1402. /* put the special tag and length */
  1403. *data++ = ASN_OPAQUE_TAG1;
  1404. *data++ = ASN_OPAQUE_COUNTER64;
  1405. *data++ = (u_char)intsize;
  1406. *datalength = *datalength - 3;
  1407.     }
  1408.     else
  1409. /* Encode the Unsigned int64 in an opaque */
  1410.     /* turn into Opaque holding special tagged value */
  1411.     if (type == ASN_OPAQUE_U64) {
  1412.         /* put the tag and length for the Opaque wrapper */
  1413.         data = asn_build_header(data, datalength, ASN_OPAQUE, intsize+3);
  1414.     if (_asn_build_header_check("build opaque u64", data, *datalength, intsize+3))
  1415. return NULL;
  1417. /* put the special tag and length */
  1418. *data++ = ASN_OPAQUE_TAG1;
  1419. *data++ = ASN_OPAQUE_U64;
  1420. *data++ = (u_char)intsize;
  1421. *datalength = *datalength - 3;
  1422.     }
  1423.     else
  1424.     {
  1425. #endif /* OPAQUE_SPECIAL_TYPES */
  1426.     data = asn_build_header(data, datalength, type, intsize);
  1427.     if (_asn_build_header_check("build uint64", data, *datalength, intsize))
  1428. return NULL;
  1430. #ifdef OPAQUE_SPECIAL_TYPES
  1431.     }
  1432. #endif /* OPAQUE_SPECIAL_TYPES */
  1433.     *datalength -= intsize;
  1434.     if (add_null_byte == 1){
  1435. *data++ = '';
  1436. intsize--;
  1437.     }
  1438.     while(intsize--){
  1439. *data++ = (u_char)((high & mask) >> (8 * (sizeof(long) - 1)));
  1440. high = (high << 8)
  1441.     | ((low & mask) >> (8 * (sizeof(long) - 1)));
  1442. low <<= 8;
  1444.     }
  1445.     return data;
  1446. }
  1448. #ifdef OPAQUE_SPECIAL_TYPES
  1450. /*
  1452.   u_char * asn_parse_signed_int64(
  1453.       u_char     *data         IN - pointer to start of object
  1454.       int        *datalength   IN/OUT - number of valid bytes left in buffer
  1455.       u_char     *type         OUT - asn type of object
  1456.       struct counter64 *cp     IN/OUT - pointer to counter struct
  1457.       int         countersize  IN - size of output buffer
  1458.  */
  1460. u_char *
  1461. asn_parse_signed_int64(u_char *data,
  1462.        size_t *datalength,
  1463.        u_char *type,
  1464.        struct counter64 *cp,
  1465.        size_t countersize)
  1466. {
  1467.   static const char *errpre = "parse int64";
  1468.   const int int64sizelimit = (4 * 2) + 1;
  1469.   char ebuf[128];
  1470.   register u_char *bufp = data;
  1471.   u_long     asn_length;
  1472.   register u_int low = 0, high = 0;
  1473.     
  1474.   if (countersize != sizeof(struct counter64)){
  1475.     _asn_size_err(errpre, countersize, sizeof(struct counter64));
  1476.     return NULL;
  1477.   }
  1478.   *type = *bufp++;
  1479.   bufp = asn_parse_length(bufp, &asn_length);
  1480.   if (_asn_parse_length_check(errpre, bufp, data, asn_length, *datalength))
  1481.         return NULL;
  1483.   DEBUGDUMPSETUP("dump_recv", data, bufp - data);
  1484.   if ((*type == ASN_OPAQUE) &&
  1485.       (asn_length <= ASN_OPAQUE_COUNTER64_MX_BER_LEN) &&
  1486.       (*bufp == ASN_OPAQUE_TAG1) &&
  1487.        (*(bufp+1) == ASN_OPAQUE_I64)) {
  1488.       DEBUGMSG(("dump_recv", "Opaque %.2x %.2x: ", *bufp, *(bufp+1)));
  1489.     /* change type to Int64 */
  1490.     *type = *(bufp+1);
  1491.     /* value is encoded as special format */
  1492.     bufp = asn_parse_length(bufp + 2, &asn_length);
  1493.     if (_asn_parse_length_check("parse opaque int64", bufp, data,
  1494.                   asn_length, *datalength))
  1495.         return NULL;
  1496.   }
  1497.   /* this should always have been true until snmp gets int64 PDU types */
  1498.   else {
  1499.     sprintf(ebuf, "%s: wrong type: %d, len %d, buf bytes (%02X,%02X)",
  1500.              errpre, *type, (int)asn_length, *bufp, *(bufp+1));
  1501.     ERROR_MSG(ebuf);
  1502.     return NULL;
  1503.   }
  1504.   if (((int)asn_length > int64sizelimit) ||
  1505.       (((int)asn_length == int64sizelimit) && *bufp != 0x00)){
  1506.     _asn_length_err(errpre, (size_t)asn_length, int64sizelimit);
  1507.     return NULL;
  1508.   }
  1509.   *datalength -= (int)asn_length + (bufp - data);
  1510.   if (*bufp & 0x80){
  1511.     low = ~low; /* integer is negative */
  1512.     high = ~high;
  1513.   }
  1515.   while(asn_length--){
  1516.     high = (high << 8) | ((low & 0xFF000000) >> 24);
  1517.     low = (low << 8) | *bufp++;
  1518.   }
  1520.   cp->low = low;
  1521.   cp->high = high;
  1523.   DEBUGIF("dump_recv") {
  1524.     char i64buf[I64CHARSZ+1];
  1525.     printI64(i64buf, cp);
  1526.   }
  1528.   return bufp;
  1529. }
  1532. /*
  1534.   u_char * asn_build_signed_int64(
  1535.       u_char     *data         IN - pointer to start of object
  1536.       int        *datalength   IN/OUT - number of valid bytes left in buffer
  1537.       u_char      type         IN - asn type of object
  1538.       struct counter64 *cp     IN - pointer to counter struct
  1539.       int         countersize  IN - size of input buffer
  1540.  */
  1541. u_char *
  1542. asn_build_signed_int64(u_char *data,
  1543.        size_t *datalength,
  1544.        u_char type,
  1545.        struct counter64 *cp,
  1546.        size_t countersize)
  1547. {
  1548. /*
  1549.  * ASN.1 integer ::= 0x02 asnlength byte {byte}*
  1550.  */
  1552.     struct counter64 c64;
  1553.     register u_int mask, mask2;
  1554.     u_long low, high;
  1555.     size_t intsize;
  1557.   if (countersize != sizeof(struct counter64)){
  1558.     _asn_size_err("build int64", countersize, sizeof(struct counter64));
  1559.     return NULL;
  1560.   }
  1561.     intsize = 8;
  1562.     memcpy(&c64, cp, sizeof(struct counter64));  /* we're may modify it */
  1563.     low = c64.low;
  1564.     high = c64.high;
  1565.     
  1566.     /*
  1567.      * Truncate "unnecessary" bytes off of the most significant end of this
  1568.      * 2's complement integer.  There should be no sequence of 9
  1569.      * consecutive 1's or 0's at the most significant end of the
  1570.      * integer.
  1571.      */
  1572.     mask = ((u_int) 0xFF) << (8 * (sizeof(u_int) - 1));
  1573.     mask2 = ((u_int) 0x1FF) << ((8 * (sizeof(u_int) - 1)) - 1);
  1574.     /* mask is 0xFF800000 on a big-endian machine */
  1575.     while((((high & mask2) == 0) || ((high & mask2) == mask2)) && intsize > 1){
  1576.       intsize--;
  1577.       high = (high << 8)
  1578.         | ((low & mask) >> (8 * (sizeof(u_int) - 1)));
  1579.       low <<= 8;
  1580.     }
  1581.     /* until a real int64 gets incorperated into SNMP, we are going to
  1582.        encode it as an opaque instead.  First, we build the opaque
  1583.        header and then the int64 tag type we use to mark it as an
  1584.        int64 in the opaque string. */
  1585.     data = asn_build_header(data, datalength, ASN_OPAQUE, intsize+3);
  1586.     if (_asn_build_header_check("build int64", data, *datalength, intsize+3))
  1587. return NULL;
  1589.     *data++ = ASN_OPAQUE_TAG1;
  1590.     *data++ = ASN_OPAQUE_I64;
  1591.     *data++ = (u_char)intsize;
  1592.     *datalength -= (3 + intsize);
  1593.     
  1594.     while(intsize--){
  1595. *data++ = (u_char)((high & mask) >> (8 * (sizeof(u_int) - 1)));
  1596. high = (high << 8)
  1597.     | ((low & mask) >> (8 * (sizeof(u_int) - 1)));
  1598. low <<= 8;
  1599.     }
  1600.     return data;
  1601. }
  1603. /*
  1604.  * asn_parse_float - pulls a single precision floating-point out of an opaque type.
  1605.  *
  1606.  *  On entry, datalength is input as the number of valid bytes following
  1607.  *   "data".  On exit, it is returned as the number of valid bytes
  1608.  *   following the end of this object.
  1609.  *
  1610.  *  Returns a pointer to the first byte past the end
  1611.  *   of this object (i.e. the start of the next object).
  1612.  *  Returns NULL on any error.
  1614.   u_char * asn_parse_float(
  1615.       u_char     *data         IN - pointer to start of object
  1616.       int        *datalength   IN/OUT - number of valid bytes left in buffer
  1617.       u_char     *type         OUT - asn type of object
  1618.       float      *floatp       IN/OUT - pointer to float
  1619.       int         floatsize    IN - size of output buffer
  1620.  */
  1621. u_char *
  1622. asn_parse_float(u_char *data,
  1623. size_t *datalength,
  1624. u_char *type,
  1625. float *floatp,
  1626. size_t floatsize)
  1627. {
  1628.     register u_char *bufp = data;
  1629.     u_long     asn_length;
  1630.     union {
  1631.         float  floatVal;
  1632. long   longVal;
  1633. u_char c[sizeof(float)];
  1634.     } fu;
  1636.     if (floatsize != sizeof(float)){
  1637. _asn_size_err("parse float", floatsize, sizeof(float));
  1638. return NULL;
  1639.     }
  1640.     *type = *bufp++;
  1641.     bufp = asn_parse_length(bufp, &asn_length);
  1642.     if (_asn_parse_length_check("parse float", bufp, data,
  1643.                   asn_length, *datalength))
  1644.         return NULL;
  1646.     DEBUGDUMPSETUP("dump_recv", data, bufp - data + asn_length);
  1647. /* the float is encoded as an opaque */
  1648.     if ((*type == ASN_OPAQUE) &&
  1649.             (asn_length == ASN_OPAQUE_FLOAT_BER_LEN) &&
  1650.     (*bufp == ASN_OPAQUE_TAG1) &&
  1651.     (*(bufp+1) == ASN_OPAQUE_FLOAT)) {
  1652.       DEBUGMSG(("dump_recv", "Opaque %.2x %.2x: ", *bufp, *(bufp+1)));
  1654.         /* value is encoded as special format */
  1655. bufp = asn_parse_length(bufp + 2, &asn_length);
  1656. if (_asn_parse_length_check("parse opaque float", bufp, data,
  1657.                   asn_length, *datalength))
  1658.         return NULL;
  1660. /* change type to Float */
  1661. *type = ASN_OPAQUE_FLOAT;
  1662.     }
  1664.     if (asn_length != sizeof(float)) {
  1665. _asn_size_err("parse seq float", asn_length, sizeof(float));
  1666. return NULL;
  1667.     }
  1669.     *datalength -= (int)asn_length + (bufp - data);
  1670.     memcpy(&fu.c[0], bufp, asn_length);
  1672.    /* correct for endian differences */
  1673.     fu.longVal = ntohl(fu.longVal);
  1675.     *floatp =  fu.floatVal;
  1677.     DEBUGMSG(("dump_recv", "%f",*floatp));
  1678.     return bufp;
  1679. }
  1681. /*
  1682.  * asn_build_float - builds an ASN object containing a single precision floating-point
  1683.  *                    number in an Opaque value.
  1684.  *
  1685.  *  On entry, datalength is input as the number of valid bytes following
  1686.  *   "data".  On exit, it is returned as the number of valid bytes
  1687.  *   following the end of this object.
  1688.  *
  1689.  *  Returns a pointer to the first byte past the end
  1690.  *   of this object (i.e. the start of the next object).
  1691.  *  Returns NULL on any error.
  1693.   u_char * asn_build_float(
  1694.       u_char     *data         IN - pointer to start of object
  1695.       int        *datalength   IN/OUT - number of valid bytes left in buffer
  1696.       u_char      type         IN - asn type of object
  1697.       float      *floatp       IN - pointer to float
  1698.       int         floatsize    IN - size of input buffer
  1699.  */
  1700. u_char *
  1701. asn_build_float(u_char *data,
  1702. size_t *datalength,
  1703. u_char type,
  1704. float *floatp,
  1705. size_t floatsize)
  1706. {
  1707.     union {
  1708.         float  floatVal;
  1709.         int    intVal;
  1710. u_char c[sizeof(float)];
  1711.     } fu;
  1713.     if (floatsize != sizeof (float)) {
  1714. _asn_size_err("build float", floatsize, sizeof(float));
  1715. return NULL;
  1716.     }
  1717. /* encode the float as an opaque */
  1718.     /* turn into Opaque holding special tagged value */
  1720.     /* put the tag and length for the Opaque wrapper */
  1721.     data = asn_build_header(data, datalength, ASN_OPAQUE, floatsize+3);
  1722.     if (_asn_build_header_check("build float", data, *datalength, (floatsize+3)))
  1723. return NULL;
  1725.     /* put the special tag and length */
  1726.     *data++ = ASN_OPAQUE_TAG1;
  1727.     *data++ = ASN_OPAQUE_FLOAT;
  1728.     *data++ = (u_char)floatsize;
  1729.     *datalength = *datalength - 3;
  1731.     fu.floatVal = *floatp;
  1732.     /* correct for endian differences */
  1733.     fu.intVal = htonl(fu.intVal);
  1735.     *datalength -= floatsize;
  1736.     memcpy(data, &fu.c[0], floatsize);
  1738.     data += floatsize;
  1739.     return data;
  1740. }
  1742. /*
  1744.   u_char * asn_parse_double(
  1745.       u_char     *data         IN - pointer to start of object
  1746.       int        *datalength   IN/OUT - number of valid bytes left in buffer
  1747.       u_char     *type         OUT - asn type of object
  1748.       double     *doublep      IN/OUT - pointer to double
  1749.       int         doublesize   IN - size of output buffer
  1750.  */
  1751. u_char *
  1752. asn_parse_double(u_char *data,
  1753.  size_t *datalength,
  1754.  u_char *type,
  1755.  double *doublep,
  1756.  size_t doublesize)
  1757. {
  1758.     register u_char *bufp = data;
  1759.     u_long     asn_length;
  1760.     long            tmp;
  1761.     union {
  1762.         double doubleVal;
  1763.         int    intVal[2];
  1764. u_char c[sizeof(double)];
  1765.     } fu;
  1766.   
  1768.     if (doublesize != sizeof(double)){
  1769. _asn_size_err("parse double", doublesize, sizeof(double));
  1770. return NULL;
  1771.     }
  1772.     *type = *bufp++;
  1773.     bufp = asn_parse_length(bufp, &asn_length);
  1774.     if (_asn_parse_length_check("parse double", bufp, data,
  1775.                   asn_length, *datalength))
  1776.         return NULL;
  1778.     DEBUGDUMPSETUP("dump_recv", data, bufp - data + asn_length);
  1779. /* the double is encoded as an opaque */
  1780.     if ((*type == ASN_OPAQUE) &&
  1781.             (asn_length == ASN_OPAQUE_DOUBLE_BER_LEN) &&
  1782.     (*bufp == ASN_OPAQUE_TAG1) &&
  1783.     (*(bufp+1) == ASN_OPAQUE_DOUBLE)) {
  1784.       DEBUGMSG(("dump_recv", "Opaque %.2x %.2x: ", *bufp, *(bufp+1)));
  1786.         /* value is encoded as special format */
  1787. bufp = asn_parse_length(bufp + 2, &asn_length);
  1788. if (_asn_parse_length_check("parse opaque double", bufp, data,
  1789.                   asn_length, *datalength))
  1790.         return NULL;
  1792. /* change type to Double */
  1793. *type = ASN_OPAQUE_DOUBLE;
  1794.     }
  1796.     if (asn_length != sizeof(double)) {
  1797. _asn_size_err("parse seq double", asn_length, sizeof(double));
  1798. return NULL;
  1799.     }
  1800.     *datalength -= (int)asn_length + (bufp - data);
  1801.     memcpy(&fu.c[0], bufp, asn_length);
  1803.    /* correct for endian differences */
  1805.     tmp = ntohl(fu.intVal[0]);
  1806.     fu.intVal[0] = ntohl(fu.intVal[1]);
  1807.     fu.intVal[1] = tmp;
  1808.     
  1809.     *doublep =  fu.doubleVal;
  1810.     DEBUGMSG(("dump_recv", "%d",*doublep));
  1812.     return bufp;
  1813. }
  1815. /*
  1817.   u_char * asn_build_double(
  1818.       u_char     *data         IN - pointer to start of object
  1819.       int        *datalength   IN/OUT - number of valid bytes left in buffer
  1820.       u_char      type         IN - asn type of object
  1821.       double     *doublep      IN - pointer to double
  1822.       int         doublesize   IN - size of input buffer
  1823.  */
  1824. u_char *
  1825. asn_build_double(u_char *data,
  1826.  size_t *datalength,
  1827.  u_char type,
  1828.  double* doublep,
  1829.  size_t doublesize)
  1830. {
  1831.     long  tmp;
  1832.     union {
  1833.         double doubleVal;
  1834. int    intVal[2];
  1835. u_char c[sizeof(double)];
  1836.     } fu;
  1838.     if (doublesize != sizeof(double)){
  1839. _asn_size_err("build double", doublesize, sizeof(double));
  1840. return NULL;
  1841.     }
  1843. /* encode the double as an opaque */
  1844.     /* turn into Opaque holding special tagged value */
  1846.     /* put the tag and length for the Opaque wrapper */
  1847.     data = asn_build_header(data, datalength, ASN_OPAQUE, doublesize+3);
  1848.     if (_asn_build_header_check("build double", data, *datalength, doublesize+3))
  1849. return NULL;
  1851.     /* put the special tag and length */
  1852.     *data++ = ASN_OPAQUE_TAG1;
  1853.     *data++ = ASN_OPAQUE_DOUBLE;
  1854.     *data++ = (u_char)doublesize;
  1855.     *datalength = *datalength - 3;
  1857.     fu.doubleVal = *doublep;
  1858.     /* correct for endian differences */
  1859.     tmp = htonl(fu.intVal[0]);
  1860.     fu.intVal[0] = htonl(fu.intVal[1]);
  1861.     fu.intVal[1] = tmp;
  1862.     *datalength -= doublesize;
  1863.     memcpy(data, &fu.c[0], doublesize);
  1865.     data += doublesize;
  1866.     return data;
  1867. }
  1869. #endif /* OPAQUE_SPECIAL_TYPES */