1*0957b409SSimon J. Gerraty /*
2*0957b409SSimon J. Gerraty * Copyright (c) 2018 Thomas Pornin <pornin@bolet.org>
3*0957b409SSimon J. Gerraty *
4*0957b409SSimon J. Gerraty * Permission is hereby granted, free of charge, to any person obtaining
5*0957b409SSimon J. Gerraty * a copy of this software and associated documentation files (the
6*0957b409SSimon J. Gerraty * "Software"), to deal in the Software without restriction, including
7*0957b409SSimon J. Gerraty * without limitation the rights to use, copy, modify, merge, publish,
8*0957b409SSimon J. Gerraty * distribute, sublicense, and/or sell copies of the Software, and to
9*0957b409SSimon J. Gerraty * permit persons to whom the Software is furnished to do so, subject to
10*0957b409SSimon J. Gerraty * the following conditions:
11*0957b409SSimon J. Gerraty *
12*0957b409SSimon J. Gerraty * The above copyright notice and this permission notice shall be
13*0957b409SSimon J. Gerraty * included in all copies or substantial portions of the Software.
14*0957b409SSimon J. Gerraty *
15*0957b409SSimon J. Gerraty * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,
16*0957b409SSimon J. Gerraty * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF
17*0957b409SSimon J. Gerraty * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND
18*0957b409SSimon J. Gerraty * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS
19*0957b409SSimon J. Gerraty * BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN
20*0957b409SSimon J. Gerraty * ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN
21*0957b409SSimon J. Gerraty * CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE
22*0957b409SSimon J. Gerraty * SOFTWARE.
23*0957b409SSimon J. Gerraty */
24*0957b409SSimon J. Gerraty
25*0957b409SSimon J. Gerraty #include "inner.h"
26*0957b409SSimon J. Gerraty
27*0957b409SSimon J. Gerraty /* see inner.h */
28*0957b409SSimon J. Gerraty br_asn1_uint
br_asn1_uint_prepare(const void * xdata,size_t xlen)29*0957b409SSimon J. Gerraty br_asn1_uint_prepare(const void *xdata, size_t xlen)
30*0957b409SSimon J. Gerraty {
31*0957b409SSimon J. Gerraty const unsigned char *x;
32*0957b409SSimon J. Gerraty br_asn1_uint t;
33*0957b409SSimon J. Gerraty
34*0957b409SSimon J. Gerraty x = xdata;
35*0957b409SSimon J. Gerraty while (xlen > 0 && *x == 0) {
36*0957b409SSimon J. Gerraty x ++;
37*0957b409SSimon J. Gerraty xlen --;
38*0957b409SSimon J. Gerraty }
39*0957b409SSimon J. Gerraty t.data = x;
40*0957b409SSimon J. Gerraty t.len = xlen;
41*0957b409SSimon J. Gerraty t.asn1len = xlen;
42*0957b409SSimon J. Gerraty if (xlen == 0 || x[0] >= 0x80) {
43*0957b409SSimon J. Gerraty t.asn1len ++;
44*0957b409SSimon J. Gerraty }
45*0957b409SSimon J. Gerraty return t;
46*0957b409SSimon J. Gerraty }
47*0957b409SSimon J. Gerraty
48*0957b409SSimon J. Gerraty /* see inner.h */
49*0957b409SSimon J. Gerraty size_t
br_asn1_encode_length(void * dest,size_t len)50*0957b409SSimon J. Gerraty br_asn1_encode_length(void *dest, size_t len)
51*0957b409SSimon J. Gerraty {
52*0957b409SSimon J. Gerraty unsigned char *buf;
53*0957b409SSimon J. Gerraty size_t z;
54*0957b409SSimon J. Gerraty int i, j;
55*0957b409SSimon J. Gerraty
56*0957b409SSimon J. Gerraty buf = dest;
57*0957b409SSimon J. Gerraty if (len < 0x80) {
58*0957b409SSimon J. Gerraty if (buf != NULL) {
59*0957b409SSimon J. Gerraty *buf = len;
60*0957b409SSimon J. Gerraty }
61*0957b409SSimon J. Gerraty return 1;
62*0957b409SSimon J. Gerraty }
63*0957b409SSimon J. Gerraty i = 0;
64*0957b409SSimon J. Gerraty for (z = len; z != 0; z >>= 8) {
65*0957b409SSimon J. Gerraty i ++;
66*0957b409SSimon J. Gerraty }
67*0957b409SSimon J. Gerraty if (buf != NULL) {
68*0957b409SSimon J. Gerraty *buf ++ = 0x80 + i;
69*0957b409SSimon J. Gerraty for (j = i - 1; j >= 0; j --) {
70*0957b409SSimon J. Gerraty *buf ++ = len >> (j << 3);
71*0957b409SSimon J. Gerraty }
72*0957b409SSimon J. Gerraty }
73*0957b409SSimon J. Gerraty return i + 1;
74*0957b409SSimon J. Gerraty }
75*0957b409SSimon J. Gerraty
76*0957b409SSimon J. Gerraty /* see inner.h */
77*0957b409SSimon J. Gerraty size_t
br_asn1_encode_uint(void * dest,br_asn1_uint pp)78*0957b409SSimon J. Gerraty br_asn1_encode_uint(void *dest, br_asn1_uint pp)
79*0957b409SSimon J. Gerraty {
80*0957b409SSimon J. Gerraty unsigned char *buf;
81*0957b409SSimon J. Gerraty size_t lenlen;
82*0957b409SSimon J. Gerraty
83*0957b409SSimon J. Gerraty if (dest == NULL) {
84*0957b409SSimon J. Gerraty return 1 + br_asn1_encode_length(NULL, pp.asn1len) + pp.asn1len;
85*0957b409SSimon J. Gerraty }
86*0957b409SSimon J. Gerraty buf = dest;
87*0957b409SSimon J. Gerraty *buf ++ = 0x02;
88*0957b409SSimon J. Gerraty lenlen = br_asn1_encode_length(buf, pp.asn1len);
89*0957b409SSimon J. Gerraty buf += lenlen;
90*0957b409SSimon J. Gerraty *buf = 0x00;
91*0957b409SSimon J. Gerraty memcpy(buf + pp.asn1len - pp.len, pp.data, pp.len);
92*0957b409SSimon J. Gerraty return 1 + lenlen + pp.asn1len;
93*0957b409SSimon J. Gerraty }
94