source3/libsmb/asn1.c

   1 /*
   2    Unix SMB/CIFS implementation.
   3    simple SPNEGO routines
   4    Copyright (C) Andrew Tridgell 2001
   5
   6    This program is free software; you can redistribute it and/or modify
   7    it under the terms of the GNU General Public License as published by
   8    the Free Software Foundation; either version 2 of the License, or
   9    (at your option) any later version.
  10
  11    This program is distributed in the hope that it will be useful,
  12    but WITHOUT ANY WARRANTY; without even the implied warranty of
  13    MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  14    GNU General Public License for more details.
  15
  16    You should have received a copy of the GNU General Public License
  17    along with this program; if not, write to the Free Software
  18    Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
  19 */
  20
  21 #include "includes.h"
  22
  23 /* free an asn1 structure */
  24 void asn1_free(ASN1_DATA *data)
  25 {
  26         SAFE_FREE(data->data);
  27 }
  28
  29 /* write to the ASN1 buffer, advancing the buffer pointer */
  30 BOOL asn1_write(ASN1_DATA *data, const void *p, int len)
  31 {
  32         if (data->has_error) return False;
  33         if (data->length < data->ofs+len) {
  34                 uint8 *newp;
  35                 newp = Realloc(data->data, data->ofs+len);
  36                 if (!newp) {
  37                         SAFE_FREE(data->data);
  38                         data->has_error = True;
  39                         return False;
  40                 }
  41                 data->data = newp;
  42                 data->length = data->ofs+len;
  43         }
  44         memcpy(data->data + data->ofs, p, len);
  45         data->ofs += len;
  46         return True;
  47 }
  48
  49 /* useful fn for writing a uint8 */
  50 BOOL asn1_write_uint8(ASN1_DATA *data, uint8 v)
  51 {
  52         return asn1_write(data, &v, 1);
  53 }
  54
  55 /* push a tag onto the asn1 data buffer. Used for nested structures */
  56 BOOL asn1_push_tag(ASN1_DATA *data, uint8 tag)
  57 {
  58         struct nesting *nesting;
  59
  60         asn1_write_uint8(data, tag);
  61         nesting = (struct nesting *)malloc(sizeof(struct nesting));
  62         if (!nesting) {
  63                 data->has_error = True;
  64                 return False;
  65         }
  66
  67         nesting->start = data->ofs;
  68         nesting->next = data->nesting;
  69         data->nesting = nesting;
  70         return asn1_write_uint8(data, 0xff);
  71 }
  72
  73 /* pop a tag */
  74 BOOL asn1_pop_tag(ASN1_DATA *data)
  75 {
  76         struct nesting *nesting;
  77         size_t len;
  78
  79         nesting = data->nesting;
  80
  81         if (!nesting) {
  82                 data->has_error = True;
  83                 return False;
  84         }
  85         len = data->ofs - (nesting->start+1);
  86         /* yes, this is ugly. We don't know in advance how many bytes the length
  87            of a tag will take, so we assumed 1 byte. If we were wrong then we
  88            need to correct our mistake */
  89         if (len > 255) {
  90                 data->data[nesting->start] = 0x82;
  91                 if (!asn1_write_uint8(data, 0)) return False;
  92                 if (!asn1_write_uint8(data, 0)) return False;
  93                 memmove(data->data+nesting->start+3, data->data+nesting->start+1, len);
  94                 data->data[nesting->start+1] = len>>8;
  95                 data->data[nesting->start+2] = len&0xff;
  96         } else if (len > 127) {
  97                 data->data[nesting->start] = 0x81;
  98                 if (!asn1_write_uint8(data, 0)) return False;
  99                 memmove(data->data+nesting->start+2, data->data+nesting->start+1, len);
 100                 data->data[nesting->start+1] = len;
 101         } else {
 102                 data->data[nesting->start] = len;
 103         }
 104
 105         data->nesting = nesting->next;
 106         free(nesting);
 107         return True;
 108 }
 109
 110
 111 /* write an integer */
 112 BOOL asn1_write_Integer(ASN1_DATA *data, int i)
 113 {
 114         if (!asn1_push_tag(data, ASN1_INTEGER)) return False;
 115         do {
 116                 asn1_write_uint8(data, i);
 117                 i = i >> 8;
 118         } while (i);
 119         return asn1_pop_tag(data);
 120 }
 121
 122 /* write an object ID to a ASN1 buffer */
 123 BOOL asn1_write_OID(ASN1_DATA *data, const char *OID)
 124 {
 125         unsigned v, v2;
 126         const char *p = (const char *)OID;
 127         char *newp;
 128
 129         if (!asn1_push_tag(data, ASN1_OID))
 130                 return False;
 131         v = strtol(p, &newp, 10);
 132         p = newp;
 133         v2 = strtol(p, &newp, 10);
 134         p = newp;
 135         if (!asn1_write_uint8(data, 40*v + v2))
 136                 return False;
 137
 138         while (*p) {
 139                 v = strtol(p, &newp, 10);
 140                 p = newp;
 141                 if (v >= (1<<28)) asn1_write_uint8(data, 0x80 | ((v>>28)&0xff));
 142                 if (v >= (1<<21)) asn1_write_uint8(data, 0x80 | ((v>>21)&0xff));
 143                 if (v >= (1<<14)) asn1_write_uint8(data, 0x80 | ((v>>14)&0xff));
 144                 if (v >= (1<<7)) asn1_write_uint8(data, 0x80 | ((v>>7)&0xff));
 145                 if (!asn1_write_uint8(data, v&0x7f))
 146                         return False;
 147         }
 148         return asn1_pop_tag(data);
 149 }
 150
 151 /* write an octet string */
 152 BOOL asn1_write_OctetString(ASN1_DATA *data, const void *p, size_t length)
 153 {
 154         asn1_push_tag(data, ASN1_OCTET_STRING);
 155         asn1_write(data, p, length);
 156         asn1_pop_tag(data);
 157         return !data->has_error;
 158 }
 159
 160 /* write a general string */
 161 BOOL asn1_write_GeneralString(ASN1_DATA *data, const char *s)
 162 {
 163         asn1_push_tag(data, ASN1_GENERAL_STRING);
 164         asn1_write(data, s, strlen(s));
 165         asn1_pop_tag(data);
 166         return !data->has_error;
 167 }
 168
 169 /* write a BOOLEAN */
 170 BOOL asn1_write_BOOLEAN(ASN1_DATA *data, BOOL v)
 171 {
 172         asn1_write_uint8(data, ASN1_BOOLEAN);
 173         asn1_write_uint8(data, v);
 174         return !data->has_error;
 175 }
 176
 177 /* write a BOOLEAN - hmm, I suspect this one is the correct one, and the
 178    above boolean is bogus. Need to check */
 179 BOOL asn1_write_BOOLEAN2(ASN1_DATA *data, BOOL v)
 180 {
 181         asn1_push_tag(data, ASN1_BOOLEAN);
 182         asn1_write_uint8(data, v);
 183         asn1_pop_tag(data);
 184         return !data->has_error;
 185 }
 186
 187 /* check a BOOLEAN */
 188 BOOL asn1_check_BOOLEAN(ASN1_DATA *data, BOOL v)
 189 {
 190         uint8 b = 0;
 191
 192         asn1_read_uint8(data, &b);
 193         if (b != ASN1_BOOLEAN) {
 194                 data->has_error = True;
 195                 return False;
 196         }
 197         asn1_read_uint8(data, &b);
 198         if (b != v) {
 199                 data->has_error = True;
 200                 return False;
 201         }
 202         return !data->has_error;
 203 }
 204
 205
 206 /* load a ASN1_DATA structure with a lump of data, ready to be parsed */
 207 BOOL asn1_load(ASN1_DATA *data, DATA_BLOB blob)
 208 {
 209         ZERO_STRUCTP(data);
 210         data->data = memdup(blob.data, blob.length);
 211         if (!data->data) {
 212                 data->has_error = True;
 213                 return False;
 214         }
 215         data->length = blob.length;
 216         return True;
 217 }
 218
 219 /* read from a ASN1 buffer, advancing the buffer pointer */
 220 BOOL asn1_read(ASN1_DATA *data, void *p, int len)
 221 {
 222         if (len < 0 || data->ofs + len < data->ofs || data->ofs + len < len) {
 223                 data->has_error = True;
 224                 return False;
 225         }
 226
 227         if (data->ofs + len > data->length) {
 228                 data->has_error = True;
 229                 return False;
 230         }
 231         memcpy(p, data->data + data->ofs, len);
 232         data->ofs += len;
 233         return True;
 234 }
 235
 236 /* read a uint8 from a ASN1 buffer */
 237 BOOL asn1_read_uint8(ASN1_DATA *data, uint8 *v)
 238 {
 239         return asn1_read(data, v, 1);
 240 }
 241
 242 /* start reading a nested asn1 structure */
 243 BOOL asn1_start_tag(ASN1_DATA *data, uint8 tag)
 244 {
 245         uint8 b;
 246         struct nesting *nesting;
 247
 248         if (!asn1_read_uint8(data, &b))
 249                 return False;
 250
 251         if (b != tag) {
 252                 data->has_error = True;
 253                 return False;
 254         }
 255         nesting = (struct nesting *)malloc(sizeof(struct nesting));
 256         if (!nesting) {
 257                 data->has_error = True;
 258                 return False;
 259         }
 260
 261         if (!asn1_read_uint8(data, &b)) {
 262                 return False;
 263         }
 264
 265         if (b & 0x80) {
 266                 int n = b & 0x7f;
 267                 if (!asn1_read_uint8(data, &b))
 268                         return False;
 269                 nesting->taglen = b;
 270                 while (n > 1) {
 271                         if (!asn1_read_uint8(data, &b))
 272                                 return False;
 273                         nesting->taglen = (nesting->taglen << 8) | b;
 274                         n--;
 275                 }
 276         } else {
 277                 nesting->taglen = b;
 278         }
 279         nesting->start = data->ofs;
 280         nesting->next = data->nesting;
 281         data->nesting = nesting;
 282         return !data->has_error;
 283 }
 284
 285
 286 /* stop reading a tag */
 287 BOOL asn1_end_tag(ASN1_DATA *data)
 288 {
 289         struct nesting *nesting;
 290
 291         /* make sure we read it all */
 292         if (asn1_tag_remaining(data) != 0) {
 293                 data->has_error = True;
 294                 return False;
 295         }
 296
 297         nesting = data->nesting;
 298
 299         if (!nesting) {
 300                 data->has_error = True;
 301                 return False;
 302         }
 303
 304         data->nesting = nesting->next;
 305         free(nesting);
 306         return True;
 307 }
 308
 309 /* work out how many bytes are left in this nested tag */
 310 int asn1_tag_remaining(ASN1_DATA *data)
 311 {
 312         if (!data->nesting) {
 313                 data->has_error = True;
 314                 return -1;
 315         }
 316         return data->nesting->taglen - (data->ofs - data->nesting->start);
 317 }
 318
 319 /* read an object ID from a ASN1 buffer */
 320 BOOL asn1_read_OID(ASN1_DATA *data, char **OID)
 321 {
 322         uint8 b;
 323         pstring oid_str;
 324         fstring el;
 325
 326         if (!asn1_start_tag(data, ASN1_OID)) return False;
 327         asn1_read_uint8(data, &b);
 328
 329         oid_str[0] = 0;
 330         fstr_sprintf(el, "%u",  b/40);
 331         pstrcat(oid_str, el);
 332         fstr_sprintf(el, " %u",  b%40);
 333         pstrcat(oid_str, el);
 334
 335         while (asn1_tag_remaining(data) > 0) {
 336                 unsigned v = 0;
 337                 do {
 338                         asn1_read_uint8(data, &b);
 339                         v = (v<<7) | (b&0x7f);
 340                 } while (!data->has_error && b & 0x80);
 341                 fstr_sprintf(el, " %u",  v);
 342                 pstrcat(oid_str, el);
 343         }
 344
 345         asn1_end_tag(data);
 346
 347         *OID = strdup(oid_str);
 348
 349         return !data->has_error;
 350 }
 351
 352 /* check that the next object ID is correct */
 353 BOOL asn1_check_OID(ASN1_DATA *data, const char *OID)
 354 {
 355         char *id;
 356
 357         if (!asn1_read_OID(data, &id)) return False;
 358
 359         if (strcmp(id, OID) != 0) {
 360                 data->has_error = True;
 361                 return False;
 362         }
 363         free(id);
 364         return True;
 365 }
 366
 367 /* read a GeneralString from a ASN1 buffer */
 368 BOOL asn1_read_GeneralString(ASN1_DATA *data, char **s)
 369 {
 370         int len;
 371         if (!asn1_start_tag(data, ASN1_GENERAL_STRING)) return False;
 372         len = asn1_tag_remaining(data);
 373         if (len < 0) {
 374                 data->has_error = True;
 375                 return False;
 376         }
 377         *s = malloc(len+1);
 378         if (! *s) {
 379                 data->has_error = True;
 380                 return False;
 381         }
 382         asn1_read(data, *s, len);
 383         (*s)[len] = 0;
 384         asn1_end_tag(data);
 385         return !data->has_error;
 386 }
 387
 388 /* read a octet string blob */
 389 BOOL asn1_read_OctetString(ASN1_DATA *data, DATA_BLOB *blob)
 390 {
 391         int len;
 392         ZERO_STRUCTP(blob);
 393         if (!asn1_start_tag(data, ASN1_OCTET_STRING)) return False;
 394         len = asn1_tag_remaining(data);
 395         if (len < 0) {
 396                 data->has_error = True;
 397                 return False;
 398         }
 399         *blob = data_blob(NULL, len);
 400         asn1_read(data, blob->data, len);
 401         asn1_end_tag(data);
 402         return !data->has_error;
 403 }
 404
 405 /* read an interger */
 406 BOOL asn1_read_Integer(ASN1_DATA *data, int *i)
 407 {
 408         uint8 b;
 409         *i = 0;
 410
 411         if (!asn1_start_tag(data, ASN1_INTEGER)) return False;
 412         while (asn1_tag_remaining(data)>0) {
 413                 asn1_read_uint8(data, &b);
 414                 *i = (*i << 8) + b;
 415         }
 416         return asn1_end_tag(data);
 417
 418 }
 419
 420 /* check a enumarted value is correct */
 421 BOOL asn1_check_enumerated(ASN1_DATA *data, int v)
 422 {
 423         uint8 b;
 424         if (!asn1_start_tag(data, ASN1_ENUMERATED)) return False;
 425         asn1_read_uint8(data, &b);
 426         asn1_end_tag(data);
 427
 428         if (v != b)
 429                 data->has_error = False;
 430
 431         return !data->has_error;
 432 }
 433
 434 /* write an enumarted value to the stream */
 435 BOOL asn1_write_enumerated(ASN1_DATA *data, uint8 v)
 436 {
 437         if (!asn1_push_tag(data, ASN1_ENUMERATED)) return False;
 438         asn1_write_uint8(data, v);
 439         asn1_pop_tag(data);
 440         return !data->has_error;
 441 }