33be907f9d5edd33c2d086404d815fcb4b7b9f3b
[openssl.git] / crypto / asn1 / a_bitstr.c
1 /*
2  * Copyright 1995-2016 The OpenSSL Project Authors. All Rights Reserved.
3  *
4  * Licensed under the OpenSSL license (the "License").  You may not use
5  * this file except in compliance with the License.  You can obtain a copy
6  * in the file LICENSE in the source distribution or at
7  * https://www.openssl.org/source/license.html
8  */
9
10 #include <stdio.h>
11 #include "internal/cryptlib.h"
12 #include <openssl/asn1.h>
13 #include "asn1_locl.h"
14
15 int ASN1_BIT_STRING_set(ASN1_BIT_STRING *x, unsigned char *d, int len)
16 {
17     return ASN1_STRING_set(x, d, len);
18 }
19
20 int i2c_ASN1_BIT_STRING(ASN1_BIT_STRING *a, unsigned char **pp)
21 {
22     int ret, j, bits, len;
23     unsigned char *p, *d;
24
25     if (a == NULL)
26         return (0);
27
28     len = a->length;
29
30     if (len > 0) {
31         if (a->flags & ASN1_STRING_FLAG_BITS_LEFT) {
32             bits = (int)a->flags & 0x07;
33         } else {
34             for (; len > 0; len--) {
35                 if (a->data[len - 1])
36                     break;
37             }
38             j = a->data[len - 1];
39             if (j & 0x01)
40                 bits = 0;
41             else if (j & 0x02)
42                 bits = 1;
43             else if (j & 0x04)
44                 bits = 2;
45             else if (j & 0x08)
46                 bits = 3;
47             else if (j & 0x10)
48                 bits = 4;
49             else if (j & 0x20)
50                 bits = 5;
51             else if (j & 0x40)
52                 bits = 6;
53             else if (j & 0x80)
54                 bits = 7;
55             else
56                 bits = 0;       /* should not happen */
57         }
58     } else
59         bits = 0;
60
61     ret = 1 + len;
62     if (pp == NULL)
63         return (ret);
64
65     p = *pp;
66
67     *(p++) = (unsigned char)bits;
68     d = a->data;
69     if (len > 0) {
70         memcpy(p, d, len);
71         p += len;
72         p[-1] &= (0xff << bits);
73     }
74     *pp = p;
75     return (ret);
76 }
77
78 ASN1_BIT_STRING *c2i_ASN1_BIT_STRING(ASN1_BIT_STRING **a,
79                                      const unsigned char **pp, long len)
80 {
81     ASN1_BIT_STRING *ret = NULL;
82     const unsigned char *p;
83     unsigned char *s;
84     int i;
85
86     if (len < 1) {
87         i = ASN1_R_STRING_TOO_SHORT;
88         goto err;
89     }
90
91     if ((a == NULL) || ((*a) == NULL)) {
92         if ((ret = ASN1_BIT_STRING_new()) == NULL)
93             return (NULL);
94     } else
95         ret = (*a);
96
97     p = *pp;
98     i = *(p++);
99     if (i > 7) {
100         i = ASN1_R_INVALID_BIT_STRING_BITS_LEFT;
101         goto err;
102     }
103     /*
104      * We do this to preserve the settings.  If we modify the settings, via
105      * the _set_bit function, we will recalculate on output
106      */
107     ret->flags &= ~(ASN1_STRING_FLAG_BITS_LEFT | 0x07); /* clear */
108     ret->flags |= (ASN1_STRING_FLAG_BITS_LEFT | i); /* set */
109
110     if (len-- > 1) {            /* using one because of the bits left byte */
111         s = OPENSSL_malloc((int)len);
112         if (s == NULL) {
113             i = ERR_R_MALLOC_FAILURE;
114             goto err;
115         }
116         memcpy(s, p, (int)len);
117         s[len - 1] &= (0xff << i);
118         p += len;
119     } else
120         s = NULL;
121
122     ret->length = (int)len;
123     OPENSSL_free(ret->data);
124     ret->data = s;
125     ret->type = V_ASN1_BIT_STRING;
126     if (a != NULL)
127         (*a) = ret;
128     *pp = p;
129     return (ret);
130  err:
131     ASN1err(ASN1_F_C2I_ASN1_BIT_STRING, i);
132     if ((a == NULL) || (*a != ret))
133         ASN1_BIT_STRING_free(ret);
134     return (NULL);
135 }
136
137 /*
138  * These next 2 functions from Goetz Babin-Ebell <babinebell@trustcenter.de>
139  */
140 int ASN1_BIT_STRING_set_bit(ASN1_BIT_STRING *a, int n, int value)
141 {
142     int w, v, iv;
143     unsigned char *c;
144
145     w = n / 8;
146     v = 1 << (7 - (n & 0x07));
147     iv = ~v;
148     if (!value)
149         v = 0;
150
151     if (a == NULL)
152         return 0;
153
154     a->flags &= ~(ASN1_STRING_FLAG_BITS_LEFT | 0x07); /* clear, set on write */
155
156     if ((a->length < (w + 1)) || (a->data == NULL)) {
157         if (!value)
158             return (1);         /* Don't need to set */
159         c = OPENSSL_clear_realloc(a->data, a->length, w + 1);
160         if (c == NULL) {
161             ASN1err(ASN1_F_ASN1_BIT_STRING_SET_BIT, ERR_R_MALLOC_FAILURE);
162             return 0;
163         }
164         if (w + 1 - a->length > 0)
165             memset(c + a->length, 0, w + 1 - a->length);
166         a->data = c;
167         a->length = w + 1;
168     }
169     a->data[w] = ((a->data[w]) & iv) | v;
170     while ((a->length > 0) && (a->data[a->length - 1] == 0))
171         a->length--;
172     return (1);
173 }
174
175 int ASN1_BIT_STRING_get_bit(const ASN1_BIT_STRING *a, int n)
176 {
177     int w, v;
178
179     w = n / 8;
180     v = 1 << (7 - (n & 0x07));
181     if ((a == NULL) || (a->length < (w + 1)) || (a->data == NULL))
182         return (0);
183     return ((a->data[w] & v) != 0);
184 }
185
186 /*
187  * Checks if the given bit string contains only bits specified by
188  * the flags vector. Returns 0 if there is at least one bit set in 'a'
189  * which is not specified in 'flags', 1 otherwise.
190  * 'len' is the length of 'flags'.
191  */
192 int ASN1_BIT_STRING_check(const ASN1_BIT_STRING *a,
193                           const unsigned char *flags, int flags_len)
194 {
195     int i, ok;
196     /* Check if there is one bit set at all. */
197     if (!a || !a->data)
198         return 1;
199
200     /*
201      * Check each byte of the internal representation of the bit string.
202      */
203     ok = 1;
204     for (i = 0; i < a->length && ok; ++i) {
205         unsigned char mask = i < flags_len ? ~flags[i] : 0xff;
206         /* We are done if there is an unneeded bit set. */
207         ok = (a->data[i] & mask) == 0;
208     }
209     return ok;
210 }