Ashley Mills / axTLS

Rough and ready port of axTLS

crypto/crypto_misc.c@0:5a29fd060ac8, 2013-05-13 (annotated)

Committer:
ashleymills
Date:
Mon May 13 18:15:18 2013 +0000
Revision:
0:5a29fd060ac8
initial commit

Who changed what in which revision?

UserRevisionLine numberNew contents of line
ashleymills 0:5a29fd060ac8 1 /*
ashleymills 0:5a29fd060ac8 2 * Copyright (c) 2007, Cameron Rich
ashleymills 0:5a29fd060ac8 3 *
ashleymills 0:5a29fd060ac8 4 * All rights reserved.
ashleymills 0:5a29fd060ac8 5 *
ashleymills 0:5a29fd060ac8 6 * Redistribution and use in source and binary forms, with or without
ashleymills 0:5a29fd060ac8 7 * modification, are permitted provided that the following conditions are met:
ashleymills 0:5a29fd060ac8 8 *
ashleymills 0:5a29fd060ac8 9 * * Redistributions of source code must retain the above copyright notice,
ashleymills 0:5a29fd060ac8 10 * this list of conditions and the following disclaimer.
ashleymills 0:5a29fd060ac8 11 * * Redistributions in binary form must reproduce the above copyright notice,
ashleymills 0:5a29fd060ac8 12 * this list of conditions and the following disclaimer in the documentation
ashleymills 0:5a29fd060ac8 13 * and/or other materials provided with the distribution.
ashleymills 0:5a29fd060ac8 14 * * Neither the name of the axTLS project nor the names of its contributors
ashleymills 0:5a29fd060ac8 15 * may be used to endorse or promote products derived from this software
ashleymills 0:5a29fd060ac8 16 * without specific prior written permission.
ashleymills 0:5a29fd060ac8 17 *
ashleymills 0:5a29fd060ac8 18 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
ashleymills 0:5a29fd060ac8 19 * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
ashleymills 0:5a29fd060ac8 20 * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR
ashleymills 0:5a29fd060ac8 21 * A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR
ashleymills 0:5a29fd060ac8 22 * CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL,
ashleymills 0:5a29fd060ac8 23 * EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO,
ashleymills 0:5a29fd060ac8 24 * PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR
ashleymills 0:5a29fd060ac8 25 * PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF
ashleymills 0:5a29fd060ac8 26 * LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING
ashleymills 0:5a29fd060ac8 27 * NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS
ashleymills 0:5a29fd060ac8 28 * SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
ashleymills 0:5a29fd060ac8 29 */
ashleymills 0:5a29fd060ac8 30
ashleymills 0:5a29fd060ac8 31 /**
ashleymills 0:5a29fd060ac8 32 * Some misc. routines to help things out
ashleymills 0:5a29fd060ac8 33 */
ashleymills 0:5a29fd060ac8 34
ashleymills 0:5a29fd060ac8 35 #include <stdlib.h>
ashleymills 0:5a29fd060ac8 36 #include <string.h>
ashleymills 0:5a29fd060ac8 37 #include <stdarg.h>
ashleymills 0:5a29fd060ac8 38 #include <stdio.h>
ashleymills 0:5a29fd060ac8 39 #include "os_port.h"
ashleymills 0:5a29fd060ac8 40 #include <lwip/def.h>
ashleymills 0:5a29fd060ac8 41 #include "sockets.h"
ashleymills 0:5a29fd060ac8 42 #include "crypto_misc.h"
ashleymills 0:5a29fd060ac8 43 #include "config.h"
ashleymills 0:5a29fd060ac8 44
ashleymills 0:5a29fd060ac8 45 #include <time.h>
ashleymills 0:5a29fd060ac8 46 #ifdef CONFIG_WIN32_USE_CRYPTO_LIB
ashleymills 0:5a29fd060ac8 47 #include "wincrypt.h"
ashleymills 0:5a29fd060ac8 48 #endif
ashleymills 0:5a29fd060ac8 49
ashleymills 0:5a29fd060ac8 50 #ifndef WIN32
ashleymills 0:5a29fd060ac8 51 static int rng_fd = -1;
ashleymills 0:5a29fd060ac8 52 #elif defined(CONFIG_WIN32_USE_CRYPTO_LIB)
ashleymills 0:5a29fd060ac8 53 static HCRYPTPROV gCryptProv;
ashleymills 0:5a29fd060ac8 54 #endif
ashleymills 0:5a29fd060ac8 55
ashleymills 0:5a29fd060ac8 56 #if (!defined(CONFIG_USE_DEV_URANDOM) && !defined(CONFIG_WIN32_USE_CRYPTO_LIB))
ashleymills 0:5a29fd060ac8 57 /* change to processor registers as appropriate */
ashleymills 0:5a29fd060ac8 58 #define ENTROPY_POOL_SIZE 32
ashleymills 0:5a29fd060ac8 59 #define ENTROPY_COUNTER1 ((((uint64_t)tv.tv_sec)<<32) | tv.tv_usec)
ashleymills 0:5a29fd060ac8 60 #define ENTROPY_COUNTER2 rand()
ashleymills 0:5a29fd060ac8 61 static uint8_t entropy_pool[ENTROPY_POOL_SIZE];
ashleymills 0:5a29fd060ac8 62 #endif
ashleymills 0:5a29fd060ac8 63
ashleymills 0:5a29fd060ac8 64 const char * const unsupported_str = "Error: Feature not supported\n";
ashleymills 0:5a29fd060ac8 65
ashleymills 0:5a29fd060ac8 66 #ifndef CONFIG_SSL_SKELETON_MODE
ashleymills 0:5a29fd060ac8 67 /**
ashleymills 0:5a29fd060ac8 68 * Retrieve a file and put it into memory
ashleymills 0:5a29fd060ac8 69 * @return The size of the file, or -1 on failure.
ashleymills 0:5a29fd060ac8 70 */
ashleymills 0:5a29fd060ac8 71 int get_file(const char *filename, uint8_t **buf)
ashleymills 0:5a29fd060ac8 72 {
ashleymills 0:5a29fd060ac8 73 int total_bytes = 0;
ashleymills 0:5a29fd060ac8 74 int bytes_read = 0;
ashleymills 0:5a29fd060ac8 75 int filesize;
ashleymills 0:5a29fd060ac8 76 FILE *stream = fopen(filename, "rb");
ashleymills 0:5a29fd060ac8 77
ashleymills 0:5a29fd060ac8 78 if (stream == NULL)
ashleymills 0:5a29fd060ac8 79 {
ashleymills 0:5a29fd060ac8 80 #ifdef CONFIG_SSL_FULL_MODE
ashleymills 0:5a29fd060ac8 81 printf("file '%s' does not exist\n", filename); TTY_FLUSH();
ashleymills 0:5a29fd060ac8 82 #endif
ashleymills 0:5a29fd060ac8 83 return -1;
ashleymills 0:5a29fd060ac8 84 }
ashleymills 0:5a29fd060ac8 85
ashleymills 0:5a29fd060ac8 86 /* Win CE doesn't support stat() */
ashleymills 0:5a29fd060ac8 87 fseek(stream, 0, SEEK_END);
ashleymills 0:5a29fd060ac8 88 filesize = ftell(stream);
ashleymills 0:5a29fd060ac8 89 *buf = (uint8_t *)malloc(filesize);
ashleymills 0:5a29fd060ac8 90 fseek(stream, 0, SEEK_SET);
ashleymills 0:5a29fd060ac8 91
ashleymills 0:5a29fd060ac8 92 do
ashleymills 0:5a29fd060ac8 93 {
ashleymills 0:5a29fd060ac8 94 bytes_read = fread(*buf+total_bytes, 1, filesize-total_bytes, stream);
ashleymills 0:5a29fd060ac8 95 total_bytes += bytes_read;
ashleymills 0:5a29fd060ac8 96 } while (total_bytes < filesize && bytes_read > 0);
ashleymills 0:5a29fd060ac8 97
ashleymills 0:5a29fd060ac8 98 fclose(stream);
ashleymills 0:5a29fd060ac8 99 return filesize;
ashleymills 0:5a29fd060ac8 100 }
ashleymills 0:5a29fd060ac8 101 #endif
ashleymills 0:5a29fd060ac8 102
ashleymills 0:5a29fd060ac8 103 /**
ashleymills 0:5a29fd060ac8 104 * Initialise the Random Number Generator engine.
ashleymills 0:5a29fd060ac8 105 * - On Win32 use the platform SDK's crypto engine.
ashleymills 0:5a29fd060ac8 106 * - On Linux use /dev/urandom
ashleymills 0:5a29fd060ac8 107 * - If none of these work then use a custom RNG.
ashleymills 0:5a29fd060ac8 108 */
ashleymills 0:5a29fd060ac8 109 EXP_FUNC void STDCALL RNG_initialize()
ashleymills 0:5a29fd060ac8 110 {
ashleymills 0:5a29fd060ac8 111 #if !defined(WIN32) && defined(CONFIG_USE_DEV_URANDOM)
ashleymills 0:5a29fd060ac8 112 rng_fd = ax_open("/dev/urandom", O_RDONLY);
ashleymills 0:5a29fd060ac8 113 #elif defined(WIN32) && defined(CONFIG_WIN32_USE_CRYPTO_LIB)
ashleymills 0:5a29fd060ac8 114 if (!CryptAcquireContext(&gCryptProv,
ashleymills 0:5a29fd060ac8 115 NULL, NULL, PROV_RSA_FULL, 0))
ashleymills 0:5a29fd060ac8 116 {
ashleymills 0:5a29fd060ac8 117 if (GetLastError() == NTE_BAD_KEYSET &&
ashleymills 0:5a29fd060ac8 118 !CryptAcquireContext(&gCryptProv,
ashleymills 0:5a29fd060ac8 119 NULL,
ashleymills 0:5a29fd060ac8 120 NULL,
ashleymills 0:5a29fd060ac8 121 PROV_RSA_FULL,
ashleymills 0:5a29fd060ac8 122 CRYPT_NEWKEYSET))
ashleymills 0:5a29fd060ac8 123 {
ashleymills 0:5a29fd060ac8 124 printf("CryptoLib: %x\n", unsupported_str, GetLastError());
ashleymills 0:5a29fd060ac8 125 exit(1);
ashleymills 0:5a29fd060ac8 126 }
ashleymills 0:5a29fd060ac8 127 }
ashleymills 0:5a29fd060ac8 128 #else
ashleymills 0:5a29fd060ac8 129 /* start of with a stack to copy across */
ashleymills 0:5a29fd060ac8 130 int i;
ashleymills 0:5a29fd060ac8 131 memcpy(entropy_pool, &i, ENTROPY_POOL_SIZE);
ashleymills 0:5a29fd060ac8 132 srand((unsigned int)&i);
ashleymills 0:5a29fd060ac8 133 #endif
ashleymills 0:5a29fd060ac8 134 }
ashleymills 0:5a29fd060ac8 135
ashleymills 0:5a29fd060ac8 136 /**
ashleymills 0:5a29fd060ac8 137 * If no /dev/urandom, then initialise the RNG with something interesting.
ashleymills 0:5a29fd060ac8 138 */
ashleymills 0:5a29fd060ac8 139 EXP_FUNC void STDCALL RNG_custom_init(const uint8_t *seed_buf, int size)
ashleymills 0:5a29fd060ac8 140 {
ashleymills 0:5a29fd060ac8 141 #if defined(WIN32) || defined(CONFIG_WIN32_USE_CRYPTO_LIB)
ashleymills 0:5a29fd060ac8 142 int i;
ashleymills 0:5a29fd060ac8 143
ashleymills 0:5a29fd060ac8 144 for (i = 0; i < ENTROPY_POOL_SIZE && i < size; i++)
ashleymills 0:5a29fd060ac8 145 entropy_pool[i] ^= seed_buf[i];
ashleymills 0:5a29fd060ac8 146 #endif
ashleymills 0:5a29fd060ac8 147 }
ashleymills 0:5a29fd060ac8 148
ashleymills 0:5a29fd060ac8 149 /**
ashleymills 0:5a29fd060ac8 150 * Terminate the RNG engine.
ashleymills 0:5a29fd060ac8 151 */
ashleymills 0:5a29fd060ac8 152 EXP_FUNC void STDCALL RNG_terminate(void)
ashleymills 0:5a29fd060ac8 153 {
ashleymills 0:5a29fd060ac8 154 #ifndef WIN32
ashleymills 0:5a29fd060ac8 155 //close(rng_fd);
ashleymills 0:5a29fd060ac8 156 #elif defined(CONFIG_WIN32_USE_CRYPTO_LIB)
ashleymills 0:5a29fd060ac8 157 CryptReleaseContext(gCryptProv, 0);
ashleymills 0:5a29fd060ac8 158 #endif
ashleymills 0:5a29fd060ac8 159 }
ashleymills 0:5a29fd060ac8 160
ashleymills 0:5a29fd060ac8 161 /**
ashleymills 0:5a29fd060ac8 162 * Set a series of bytes with a random number. Individual bytes can be 0
ashleymills 0:5a29fd060ac8 163 */
ashleymills 0:5a29fd060ac8 164 EXP_FUNC void STDCALL get_random(int num_rand_bytes, uint8_t *rand_data)
ashleymills 0:5a29fd060ac8 165 {
ashleymills 0:5a29fd060ac8 166 #if !defined(WIN32) && defined(CONFIG_USE_DEV_URANDOM)
ashleymills 0:5a29fd060ac8 167 /* use the Linux default */
ashleymills 0:5a29fd060ac8 168 read(rng_fd, rand_data, num_rand_bytes); /* read from /dev/urandom */
ashleymills 0:5a29fd060ac8 169 #elif defined(WIN32) && defined(CONFIG_WIN32_USE_CRYPTO_LIB)
ashleymills 0:5a29fd060ac8 170 /* use Microsoft Crypto Libraries */
ashleymills 0:5a29fd060ac8 171 CryptGenRandom(gCryptProv, num_rand_bytes, rand_data);
ashleymills 0:5a29fd060ac8 172 #else /* nothing else to use, so use a custom RNG */
ashleymills 0:5a29fd060ac8 173 /* The method we use when we've got nothing better. Use RC4, time
ashleymills 0:5a29fd060ac8 174 and a couple of random seeds to generate a random sequence */
ashleymills 0:5a29fd060ac8 175 RC4_CTX rng_ctx;
ashleymills 0:5a29fd060ac8 176 struct timeval tv;
ashleymills 0:5a29fd060ac8 177 MD5_CTX rng_digest_ctx;
ashleymills 0:5a29fd060ac8 178 uint8_t digest[MD5_SIZE];
ashleymills 0:5a29fd060ac8 179 uint64_t *ep;
ashleymills 0:5a29fd060ac8 180 int i;
ashleymills 0:5a29fd060ac8 181
ashleymills 0:5a29fd060ac8 182 /* A proper implementation would use counters etc for entropy */
ashleymills 0:5a29fd060ac8 183 // XXX XXX XX X need to seed this properly
ashleymills 0:5a29fd060ac8 184 gettimeofday(&tv, NULL);
ashleymills 0:5a29fd060ac8 185 ep = (uint64_t *)entropy_pool;
ashleymills 0:5a29fd060ac8 186
ashleymills 0:5a29fd060ac8 187 ep[0] ^= ENTROPY_COUNTER1;
ashleymills 0:5a29fd060ac8 188 ep[1] ^= ENTROPY_COUNTER2;
ashleymills 0:5a29fd060ac8 189
ashleymills 0:5a29fd060ac8 190
ashleymills 0:5a29fd060ac8 191 /* use a digested version of the entropy pool as a key */
ashleymills 0:5a29fd060ac8 192 MD5_Init(&rng_digest_ctx);
ashleymills 0:5a29fd060ac8 193 MD5_Update(&rng_digest_ctx, entropy_pool, ENTROPY_POOL_SIZE);
ashleymills 0:5a29fd060ac8 194 MD5_Final(digest, &rng_digest_ctx);
ashleymills 0:5a29fd060ac8 195
ashleymills 0:5a29fd060ac8 196 /* come up with the random sequence */
ashleymills 0:5a29fd060ac8 197 RC4_setup(&rng_ctx, digest, MD5_SIZE); /* use as a key */
ashleymills 0:5a29fd060ac8 198 memcpy(rand_data, entropy_pool, num_rand_bytes < ENTROPY_POOL_SIZE ?
ashleymills 0:5a29fd060ac8 199 num_rand_bytes : ENTROPY_POOL_SIZE);
ashleymills 0:5a29fd060ac8 200 RC4_crypt(&rng_ctx, rand_data, rand_data, num_rand_bytes);
ashleymills 0:5a29fd060ac8 201
ashleymills 0:5a29fd060ac8 202 /* move things along */
ashleymills 0:5a29fd060ac8 203 for (i = ENTROPY_POOL_SIZE-1; i >= MD5_SIZE ; i--)
ashleymills 0:5a29fd060ac8 204 entropy_pool[i] = entropy_pool[i-MD5_SIZE];
ashleymills 0:5a29fd060ac8 205
ashleymills 0:5a29fd060ac8 206 /* insert the digest at the start of the entropy pool */
ashleymills 0:5a29fd060ac8 207 memcpy(entropy_pool, digest, MD5_SIZE);
ashleymills 0:5a29fd060ac8 208 #endif
ashleymills 0:5a29fd060ac8 209 }
ashleymills 0:5a29fd060ac8 210
ashleymills 0:5a29fd060ac8 211 /**
ashleymills 0:5a29fd060ac8 212 * Set a series of bytes with a random number. Individual bytes are not zero.
ashleymills 0:5a29fd060ac8 213 */
ashleymills 0:5a29fd060ac8 214 void get_random_NZ(int num_rand_bytes, uint8_t *rand_data)
ashleymills 0:5a29fd060ac8 215 {
ashleymills 0:5a29fd060ac8 216 int i;
ashleymills 0:5a29fd060ac8 217 get_random(num_rand_bytes, rand_data);
ashleymills 0:5a29fd060ac8 218
ashleymills 0:5a29fd060ac8 219 for (i = 0; i < num_rand_bytes; i++)
ashleymills 0:5a29fd060ac8 220 {
ashleymills 0:5a29fd060ac8 221 while (rand_data[i] == 0) /* can't be 0 */
ashleymills 0:5a29fd060ac8 222 rand_data[i] = (uint8_t)(rand());
ashleymills 0:5a29fd060ac8 223 }
ashleymills 0:5a29fd060ac8 224 }
ashleymills 0:5a29fd060ac8 225
ashleymills 0:5a29fd060ac8 226 /**
ashleymills 0:5a29fd060ac8 227 * Some useful diagnostic routines
ashleymills 0:5a29fd060ac8 228 */
ashleymills 0:5a29fd060ac8 229 #if defined(CONFIG_SSL_FULL_MODE) || defined(CONFIG_DEBUG)
ashleymills 0:5a29fd060ac8 230 int hex_finish;
ashleymills 0:5a29fd060ac8 231 int hex_index;
ashleymills 0:5a29fd060ac8 232
ashleymills 0:5a29fd060ac8 233 static void print_hex_init(int finish)
ashleymills 0:5a29fd060ac8 234 {
ashleymills 0:5a29fd060ac8 235 hex_finish = finish;
ashleymills 0:5a29fd060ac8 236 hex_index = 0;
ashleymills 0:5a29fd060ac8 237 }
ashleymills 0:5a29fd060ac8 238
ashleymills 0:5a29fd060ac8 239 static void print_hex(uint8_t hex)
ashleymills 0:5a29fd060ac8 240 {
ashleymills 0:5a29fd060ac8 241 static int column;
ashleymills 0:5a29fd060ac8 242
ashleymills 0:5a29fd060ac8 243 if (hex_index == 0)
ashleymills 0:5a29fd060ac8 244 {
ashleymills 0:5a29fd060ac8 245 column = 0;
ashleymills 0:5a29fd060ac8 246 }
ashleymills 0:5a29fd060ac8 247
ashleymills 0:5a29fd060ac8 248 printf("%02x ", hex);
ashleymills 0:5a29fd060ac8 249 if (++column == 8)
ashleymills 0:5a29fd060ac8 250 {
ashleymills 0:5a29fd060ac8 251 printf(": ");
ashleymills 0:5a29fd060ac8 252 }
ashleymills 0:5a29fd060ac8 253 else if (column >= 16)
ashleymills 0:5a29fd060ac8 254 {
ashleymills 0:5a29fd060ac8 255 printf("\r\n");
ashleymills 0:5a29fd060ac8 256 column = 0;
ashleymills 0:5a29fd060ac8 257 }
ashleymills 0:5a29fd060ac8 258
ashleymills 0:5a29fd060ac8 259 if (++hex_index >= hex_finish && column > 0)
ashleymills 0:5a29fd060ac8 260 {
ashleymills 0:5a29fd060ac8 261 printf("\r\n");
ashleymills 0:5a29fd060ac8 262 }
ashleymills 0:5a29fd060ac8 263 }
ashleymills 0:5a29fd060ac8 264
ashleymills 0:5a29fd060ac8 265 /**
ashleymills 0:5a29fd060ac8 266 * Spit out a blob of data for diagnostics. The data is is a nice column format
ashleymills 0:5a29fd060ac8 267 * for easy reading.
ashleymills 0:5a29fd060ac8 268 *
ashleymills 0:5a29fd060ac8 269 * @param format [in] The string (with possible embedded format characters)
ashleymills 0:5a29fd060ac8 270 * @param size [in] The number of numbers to print
ashleymills 0:5a29fd060ac8 271 * @param data [in] The start of data to use
ashleymills 0:5a29fd060ac8 272 * @param ... [in] Any additional arguments
ashleymills 0:5a29fd060ac8 273 */
ashleymills 0:5a29fd060ac8 274 EXP_FUNC void STDCALL print_blob(const char *format,
ashleymills 0:5a29fd060ac8 275 const uint8_t *data, int size, ...)
ashleymills 0:5a29fd060ac8 276 {
ashleymills 0:5a29fd060ac8 277 int i;
ashleymills 0:5a29fd060ac8 278 char tmp[80];
ashleymills 0:5a29fd060ac8 279 va_list(ap);
ashleymills 0:5a29fd060ac8 280
ashleymills 0:5a29fd060ac8 281 va_start(ap, size);
ashleymills 0:5a29fd060ac8 282 sprintf(tmp, "%s\n", format);
ashleymills 0:5a29fd060ac8 283 vprintf(tmp, ap);
ashleymills 0:5a29fd060ac8 284 print_hex_init(size);
ashleymills 0:5a29fd060ac8 285 for (i = 0; i < size; i++)
ashleymills 0:5a29fd060ac8 286 {
ashleymills 0:5a29fd060ac8 287 print_hex(data[i]);
ashleymills 0:5a29fd060ac8 288 }
ashleymills 0:5a29fd060ac8 289
ashleymills 0:5a29fd060ac8 290 va_end(ap);
ashleymills 0:5a29fd060ac8 291 TTY_FLUSH();
ashleymills 0:5a29fd060ac8 292 }
ashleymills 0:5a29fd060ac8 293 #elif defined(WIN32)
ashleymills 0:5a29fd060ac8 294 /* VC6.0 doesn't handle variadic macros */
ashleymills 0:5a29fd060ac8 295 EXP_FUNC void STDCALL print_blob(const char *format, const unsigned char *data,
ashleymills 0:5a29fd060ac8 296 int size, ...) {}
ashleymills 0:5a29fd060ac8 297 #endif
ashleymills 0:5a29fd060ac8 298
ashleymills 0:5a29fd060ac8 299 #if defined(CONFIG_SSL_HAS_PEM) || defined(CONFIG_HTTP_HAS_AUTHORIZATION)
ashleymills 0:5a29fd060ac8 300 /* base64 to binary lookup table */
ashleymills 0:5a29fd060ac8 301 static const uint8_t map[128] =
ashleymills 0:5a29fd060ac8 302 {
ashleymills 0:5a29fd060ac8 303 255, 255, 255, 255, 255, 255, 255, 255, 255, 255, 255, 255,
ashleymills 0:5a29fd060ac8 304 255, 255, 255, 255, 255, 255, 255, 255, 255, 255, 255, 255,
ashleymills 0:5a29fd060ac8 305 255, 255, 255, 255, 255, 255, 255, 255, 255, 255, 255, 255,
ashleymills 0:5a29fd060ac8 306 255, 255, 255, 255, 255, 255, 255, 62, 255, 255, 255, 63,
ashleymills 0:5a29fd060ac8 307 52, 53, 54, 55, 56, 57, 58, 59, 60, 61, 255, 255,
ashleymills 0:5a29fd060ac8 308 255, 254, 255, 255, 255, 0, 1, 2, 3, 4, 5, 6,
ashleymills 0:5a29fd060ac8 309 7, 8, 9, 10, 11, 12, 13, 14, 15, 16, 17, 18,
ashleymills 0:5a29fd060ac8 310 19, 20, 21, 22, 23, 24, 25, 255, 255, 255, 255, 255,
ashleymills 0:5a29fd060ac8 311 255, 26, 27, 28, 29, 30, 31, 32, 33, 34, 35, 36,
ashleymills 0:5a29fd060ac8 312 37, 38, 39, 40, 41, 42, 43, 44, 45, 46, 47, 48,
ashleymills 0:5a29fd060ac8 313 49, 50, 51, 255, 255, 255, 255, 255
ashleymills 0:5a29fd060ac8 314 };
ashleymills 0:5a29fd060ac8 315
ashleymills 0:5a29fd060ac8 316 EXP_FUNC int STDCALL base64_decode(const char *in, int len,
ashleymills 0:5a29fd060ac8 317 uint8_t *out, int *outlen)
ashleymills 0:5a29fd060ac8 318 {
ashleymills 0:5a29fd060ac8 319 int g, t, x, y, z;
ashleymills 0:5a29fd060ac8 320 uint8_t c;
ashleymills 0:5a29fd060ac8 321 int ret = -1;
ashleymills 0:5a29fd060ac8 322
ashleymills 0:5a29fd060ac8 323 g = 3;
ashleymills 0:5a29fd060ac8 324 for (x = y = z = t = 0; x < len; x++)
ashleymills 0:5a29fd060ac8 325 {
ashleymills 0:5a29fd060ac8 326 if ((c = map[in[x]&0x7F]) == 0xff)
ashleymills 0:5a29fd060ac8 327 continue;
ashleymills 0:5a29fd060ac8 328
ashleymills 0:5a29fd060ac8 329 if (c == 254) /* this is the end... */
ashleymills 0:5a29fd060ac8 330 {
ashleymills 0:5a29fd060ac8 331 c = 0;
ashleymills 0:5a29fd060ac8 332
ashleymills 0:5a29fd060ac8 333 if (--g < 0)
ashleymills 0:5a29fd060ac8 334 goto error;
ashleymills 0:5a29fd060ac8 335 }
ashleymills 0:5a29fd060ac8 336 else if (g != 3) /* only allow = at end */
ashleymills 0:5a29fd060ac8 337 goto error;
ashleymills 0:5a29fd060ac8 338
ashleymills 0:5a29fd060ac8 339 t = (t<<6) | c;
ashleymills 0:5a29fd060ac8 340
ashleymills 0:5a29fd060ac8 341 if (++y == 4)
ashleymills 0:5a29fd060ac8 342 {
ashleymills 0:5a29fd060ac8 343 out[z++] = (uint8_t)((t>>16)&255);
ashleymills 0:5a29fd060ac8 344
ashleymills 0:5a29fd060ac8 345 if (g > 1)
ashleymills 0:5a29fd060ac8 346 out[z++] = (uint8_t)((t>>8)&255);
ashleymills 0:5a29fd060ac8 347
ashleymills 0:5a29fd060ac8 348 if (g > 2)
ashleymills 0:5a29fd060ac8 349 out[z++] = (uint8_t)(t&255);
ashleymills 0:5a29fd060ac8 350
ashleymills 0:5a29fd060ac8 351 y = t = 0;
ashleymills 0:5a29fd060ac8 352 }
ashleymills 0:5a29fd060ac8 353
ashleymills 0:5a29fd060ac8 354 /* check that we don't go past the output buffer */
ashleymills 0:5a29fd060ac8 355 if (z > *outlen)
ashleymills 0:5a29fd060ac8 356 goto error;
ashleymills 0:5a29fd060ac8 357 }
ashleymills 0:5a29fd060ac8 358
ashleymills 0:5a29fd060ac8 359 if (y != 0)
ashleymills 0:5a29fd060ac8 360 goto error;
ashleymills 0:5a29fd060ac8 361
ashleymills 0:5a29fd060ac8 362 *outlen = z;
ashleymills 0:5a29fd060ac8 363 ret = 0;
ashleymills 0:5a29fd060ac8 364
ashleymills 0:5a29fd060ac8 365 error:
ashleymills 0:5a29fd060ac8 366 #ifdef CONFIG_SSL_FULL_MODE
ashleymills 0:5a29fd060ac8 367 if (ret < 0)
ashleymills 0:5a29fd060ac8 368 printf("Error: Invalid base64\n"); TTY_FLUSH();
ashleymills 0:5a29fd060ac8 369 #endif
ashleymills 0:5a29fd060ac8 370 TTY_FLUSH();
ashleymills 0:5a29fd060ac8 371 return ret;
ashleymills 0:5a29fd060ac8 372
ashleymills 0:5a29fd060ac8 373 }
ashleymills 0:5a29fd060ac8 374 #endif
ashleymills 0:5a29fd060ac8 375