odr/ber_int.c

   1 /*
   2  * Copyright (C) 1994, Index Data I/S
   3  * All rights reserved.
   4  * Sebastian Hammer, Adam Dickmeiss
   5  *
   6  * $Log: ber_int.c,v $
   7  * Revision 1.1  1995-02-02 16:21:52  quinn
   8  * First kick.
   9  *
  10  */
  11
  12 #include <odr.h>
  13 #include <netinet/in.h>
  14 #include <string.h>
  15
  16 static int ber_encinteger(unsigned char *buf, int val, int maxlen);
  17 static int ber_decinteger(unsigned char *buf, int *val);
  18
  19 int ber_integer(ODR o, int *val)
  20 {
  21     int res;
  22
  23     switch (o->direction)
  24     {
  25         case ODR_DECODE:
  26             if ((res = ber_decinteger(o->bp, val)) <= 0)
  27                 return 0;
  28             o->bp += res;
  29             o->left -= res;
  30             return 1;
  31         case ODR_ENCODE:
  32             if ((res = ber_encinteger(o->bp, *val, o->left)) <= 0)
  33                 return 0;
  34             o->bp += res;
  35             o->left -= res;
  36             return 1;
  37         case ODR_PRINT: return 1;
  38         default:  return 0;
  39     }
  40 }
  41
  42 /*
  43  * Returns: number of bytes written or -1 for error (out of bounds).
  44  */
  45 int ber_encinteger(unsigned char *buf, int val, int maxlen)
  46 {
  47     unsigned char *b = buf, *lenpos;
  48     int a, len;
  49     union { int i; unsigned char c[sizeof(int)]; } tmp;
  50
  51     lenpos = b;
  52     maxlen--;
  53     b++;
  54
  55     tmp.i = htonl(val);   /* ensure that that we're big-endian */
  56     for (a = 0; a < sizeof(int) - 1; a++)  /* skip superfluous octets */
  57         if (!((tmp.c[a] == 0 && !(tmp.c[a+1] & 0X80)) ||
  58             (tmp.c[a] == 0XFF && (tmp.c[a+1] & 0X80))))
  59             break;
  60     if ((len = sizeof(int) - a) > maxlen)
  61         return -1;
  62     memcpy(b, tmp.c + a, len);
  63     b += len;
  64     if (ber_enclen(lenpos, len, 1, 1) != 1)
  65         return -1;
  66     fprintf(stderr, "[val=%d]\n", val);
  67     return b - buf;
  68 }
  69
  70 /*
  71  * Returns: Number of bytes read or 0 if no match, -1 if error.
  72  */
  73 int ber_decinteger(unsigned char *buf, int *val)
  74 {
  75     unsigned char *b = buf, fill;
  76     int res, len, remains;
  77     union { int i; unsigned char c[sizeof(int)]; } tmp;
  78
  79     if ((res = ber_declen(b, &len)) < 0)
  80         return -1;
  81     if (len > sizeof(int))    /* let's be reasonable, here */
  82         return -1;
  83     b+= res;
  84
  85     remains = sizeof(int) - len;
  86     memcpy(tmp.c + remains, b, len);
  87     if (*b & 0X80)
  88         fill = 0XFF;
  89     else
  90         fill = 0X00;
  91     memset(tmp.c, fill, remains);
  92     *val = ntohl(tmp.i);
  93
  94     b += len;
  95     fprintf(stderr, "[val=%d]\n", *val);
  96     return b - buf;
  97 }