Harald Welte | c757239 | 2021-09-17 08:23:09 +0200 | [diff] [blame] | 1 | /* |
| 2 | * RFC 1521 base64 encoding/decoding |
| 3 | * |
| 4 | * Copyright (C) 2006-2015, ARM Limited, All Rights Reserved |
| 5 | * |
| 6 | * This file is part of mbed TLS (https://tls.mbed.org) |
| 7 | * |
| 8 | * This program is free software; you can redistribute it and/or modify |
| 9 | * it under the terms of the GNU General Public License as published by |
| 10 | * the Free Software Foundation; either version 2 of the License, or |
| 11 | * (at your option) any later version. |
| 12 | * |
| 13 | * This program is distributed in the hope that it will be useful, |
| 14 | * but WITHOUT ANY WARRANTY; without even the implied warranty of |
| 15 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the |
| 16 | * GNU General Public License for more details. |
| 17 | * |
| 18 | * You should have received a copy of the GNU General Public License along |
| 19 | * with this program; if not, write to the Free Software Foundation, Inc., |
| 20 | * 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA. |
| 21 | */ |
| 22 | |
Harald Welte | 292f9e7 | 2021-09-17 08:35:32 +0200 | [diff] [blame] | 23 | #include <osmocom/core/base64.h> |
Harald Welte | c757239 | 2021-09-17 08:23:09 +0200 | [diff] [blame] | 24 | |
| 25 | #include <stdint.h> |
Harald Welte | c757239 | 2021-09-17 08:23:09 +0200 | [diff] [blame] | 26 | #include <stdio.h> |
Harald Welte | 292f9e7 | 2021-09-17 08:35:32 +0200 | [diff] [blame] | 27 | #include <errno.h> |
Harald Welte | c757239 | 2021-09-17 08:23:09 +0200 | [diff] [blame] | 28 | |
Harald Welte | d075e3a | 2021-09-17 08:45:25 +0200 | [diff] [blame] | 29 | static const unsigned char base64_enc_map[64] = { |
| 30 | 'A', 'B', 'C', 'D', 'E', 'F', 'G', 'H', 'I', 'J', |
| 31 | 'K', 'L', 'M', 'N', 'O', 'P', 'Q', 'R', 'S', 'T', |
| 32 | 'U', 'V', 'W', 'X', 'Y', 'Z', 'a', 'b', 'c', 'd', |
| 33 | 'e', 'f', 'g', 'h', 'i', 'j', 'k', 'l', 'm', 'n', |
| 34 | 'o', 'p', 'q', 'r', 's', 't', 'u', 'v', 'w', 'x', |
| 35 | 'y', 'z', '0', '1', '2', '3', '4', '5', '6', '7', |
| 36 | '8', '9', '+', '/' |
Harald Welte | c757239 | 2021-09-17 08:23:09 +0200 | [diff] [blame] | 37 | }; |
| 38 | |
Harald Welte | d075e3a | 2021-09-17 08:45:25 +0200 | [diff] [blame] | 39 | static const unsigned char base64_dec_map[128] = { |
| 40 | 127, 127, 127, 127, 127, 127, 127, 127, 127, 127, |
| 41 | 127, 127, 127, 127, 127, 127, 127, 127, 127, 127, |
| 42 | 127, 127, 127, 127, 127, 127, 127, 127, 127, 127, |
| 43 | 127, 127, 127, 127, 127, 127, 127, 127, 127, 127, |
| 44 | 127, 127, 127, 62, 127, 127, 127, 63, 52, 53, |
| 45 | 54, 55, 56, 57, 58, 59, 60, 61, 127, 127, |
| 46 | 127, 64, 127, 127, 127, 0, 1, 2, 3, 4, |
| 47 | 5, 6, 7, 8, 9, 10, 11, 12, 13, 14, |
| 48 | 15, 16, 17, 18, 19, 20, 21, 22, 23, 24, |
| 49 | 25, 127, 127, 127, 127, 127, 127, 26, 27, 28, |
| 50 | 29, 30, 31, 32, 33, 34, 35, 36, 37, 38, |
| 51 | 39, 40, 41, 42, 43, 44, 45, 46, 47, 48, |
| 52 | 49, 50, 51, 127, 127, 127, 127, 127 |
Harald Welte | c757239 | 2021-09-17 08:23:09 +0200 | [diff] [blame] | 53 | }; |
| 54 | |
| 55 | /* |
| 56 | * Encode a buffer into base64 format |
| 57 | */ |
Harald Welte | d075e3a | 2021-09-17 08:45:25 +0200 | [diff] [blame] | 58 | int osmo_base64_encode(unsigned char *dst, size_t dlen, size_t *olen, |
| 59 | const unsigned char *src, size_t slen) |
Harald Welte | c757239 | 2021-09-17 08:23:09 +0200 | [diff] [blame] | 60 | { |
Harald Welte | d075e3a | 2021-09-17 08:45:25 +0200 | [diff] [blame] | 61 | size_t i, n; |
| 62 | int C1, C2, C3; |
| 63 | unsigned char *p; |
Harald Welte | c757239 | 2021-09-17 08:23:09 +0200 | [diff] [blame] | 64 | |
Harald Welte | d075e3a | 2021-09-17 08:45:25 +0200 | [diff] [blame] | 65 | if (slen == 0) { |
| 66 | *olen = 0; |
| 67 | return 0; |
| 68 | } |
Harald Welte | c757239 | 2021-09-17 08:23:09 +0200 | [diff] [blame] | 69 | |
Harald Welte | d075e3a | 2021-09-17 08:45:25 +0200 | [diff] [blame] | 70 | n = (slen << 3) / 6; |
Harald Welte | c757239 | 2021-09-17 08:23:09 +0200 | [diff] [blame] | 71 | |
Harald Welte | d075e3a | 2021-09-17 08:45:25 +0200 | [diff] [blame] | 72 | switch ((slen << 3) - (n * 6)) { |
| 73 | case 2: |
| 74 | n += 3; |
| 75 | break; |
| 76 | case 4: |
| 77 | n += 2; |
| 78 | break; |
| 79 | default: |
| 80 | break; |
| 81 | } |
Harald Welte | c757239 | 2021-09-17 08:23:09 +0200 | [diff] [blame] | 82 | |
Harald Welte | d075e3a | 2021-09-17 08:45:25 +0200 | [diff] [blame] | 83 | if (dlen < n + 1) { |
| 84 | *olen = n + 1; |
| 85 | return -ENOBUFS; |
| 86 | } |
Harald Welte | c757239 | 2021-09-17 08:23:09 +0200 | [diff] [blame] | 87 | |
Harald Welte | d075e3a | 2021-09-17 08:45:25 +0200 | [diff] [blame] | 88 | n = (slen / 3) * 3; |
Harald Welte | c757239 | 2021-09-17 08:23:09 +0200 | [diff] [blame] | 89 | |
Harald Welte | d075e3a | 2021-09-17 08:45:25 +0200 | [diff] [blame] | 90 | for (i = 0, p = dst; i < n; i += 3) { |
| 91 | C1 = *src++; |
| 92 | C2 = *src++; |
| 93 | C3 = *src++; |
Harald Welte | c757239 | 2021-09-17 08:23:09 +0200 | [diff] [blame] | 94 | |
Harald Welte | d075e3a | 2021-09-17 08:45:25 +0200 | [diff] [blame] | 95 | *p++ = base64_enc_map[(C1 >> 2) & 0x3F]; |
| 96 | *p++ = base64_enc_map[(((C1 & 3) << 4) + (C2 >> 4)) & 0x3F]; |
| 97 | *p++ = base64_enc_map[(((C2 & 15) << 2) + (C3 >> 6)) & 0x3F]; |
| 98 | *p++ = base64_enc_map[C3 & 0x3F]; |
| 99 | } |
Harald Welte | c757239 | 2021-09-17 08:23:09 +0200 | [diff] [blame] | 100 | |
Harald Welte | d075e3a | 2021-09-17 08:45:25 +0200 | [diff] [blame] | 101 | if (i < slen) { |
| 102 | C1 = *src++; |
| 103 | C2 = ((i + 1) < slen) ? *src++ : 0; |
Harald Welte | c757239 | 2021-09-17 08:23:09 +0200 | [diff] [blame] | 104 | |
Harald Welte | d075e3a | 2021-09-17 08:45:25 +0200 | [diff] [blame] | 105 | *p++ = base64_enc_map[(C1 >> 2) & 0x3F]; |
| 106 | *p++ = base64_enc_map[(((C1 & 3) << 4) + (C2 >> 4)) & 0x3F]; |
Harald Welte | c757239 | 2021-09-17 08:23:09 +0200 | [diff] [blame] | 107 | |
Harald Welte | d075e3a | 2021-09-17 08:45:25 +0200 | [diff] [blame] | 108 | if ((i + 1) < slen) |
| 109 | *p++ = base64_enc_map[((C2 & 15) << 2) & 0x3F]; |
| 110 | else |
| 111 | *p++ = '='; |
Harald Welte | c757239 | 2021-09-17 08:23:09 +0200 | [diff] [blame] | 112 | |
Harald Welte | d075e3a | 2021-09-17 08:45:25 +0200 | [diff] [blame] | 113 | *p++ = '='; |
| 114 | } |
Harald Welte | c757239 | 2021-09-17 08:23:09 +0200 | [diff] [blame] | 115 | |
Harald Welte | d075e3a | 2021-09-17 08:45:25 +0200 | [diff] [blame] | 116 | *olen = p - dst; |
| 117 | *p = 0; |
Harald Welte | c757239 | 2021-09-17 08:23:09 +0200 | [diff] [blame] | 118 | |
Harald Welte | d075e3a | 2021-09-17 08:45:25 +0200 | [diff] [blame] | 119 | return 0; |
Harald Welte | c757239 | 2021-09-17 08:23:09 +0200 | [diff] [blame] | 120 | } |
| 121 | |
| 122 | /* |
| 123 | * Decode a base64-formatted buffer |
| 124 | */ |
Harald Welte | d075e3a | 2021-09-17 08:45:25 +0200 | [diff] [blame] | 125 | int osmo_base64_decode(unsigned char *dst, size_t dlen, size_t *olen, |
| 126 | const unsigned char *src, size_t slen) |
Harald Welte | c757239 | 2021-09-17 08:23:09 +0200 | [diff] [blame] | 127 | { |
Harald Welte | d075e3a | 2021-09-17 08:45:25 +0200 | [diff] [blame] | 128 | size_t i, n; |
| 129 | uint32_t j, x; |
| 130 | unsigned char *p; |
Harald Welte | c757239 | 2021-09-17 08:23:09 +0200 | [diff] [blame] | 131 | |
Harald Welte | d075e3a | 2021-09-17 08:45:25 +0200 | [diff] [blame] | 132 | /* First pass: check for validity and get output length */ |
| 133 | for (i = n = j = 0; i < slen; i++) { |
| 134 | /* Skip spaces before checking for EOL */ |
| 135 | x = 0; |
| 136 | while (i < slen && src[i] == ' ') { |
| 137 | ++i; |
| 138 | ++x; |
| 139 | } |
Harald Welte | c757239 | 2021-09-17 08:23:09 +0200 | [diff] [blame] | 140 | |
Harald Welte | d075e3a | 2021-09-17 08:45:25 +0200 | [diff] [blame] | 141 | /* Spaces at end of buffer are OK */ |
| 142 | if (i == slen) |
| 143 | break; |
Harald Welte | c757239 | 2021-09-17 08:23:09 +0200 | [diff] [blame] | 144 | |
Harald Welte | d075e3a | 2021-09-17 08:45:25 +0200 | [diff] [blame] | 145 | if ((slen - i) >= 2 && src[i] == '\r' && src[i + 1] == '\n') |
| 146 | continue; |
Harald Welte | c757239 | 2021-09-17 08:23:09 +0200 | [diff] [blame] | 147 | |
Harald Welte | d075e3a | 2021-09-17 08:45:25 +0200 | [diff] [blame] | 148 | if (src[i] == '\n') |
| 149 | continue; |
Harald Welte | c757239 | 2021-09-17 08:23:09 +0200 | [diff] [blame] | 150 | |
Harald Welte | d075e3a | 2021-09-17 08:45:25 +0200 | [diff] [blame] | 151 | /* Space inside a line is an error */ |
| 152 | if (x != 0) |
| 153 | return -EINVAL; |
Harald Welte | c757239 | 2021-09-17 08:23:09 +0200 | [diff] [blame] | 154 | |
Harald Welte | d075e3a | 2021-09-17 08:45:25 +0200 | [diff] [blame] | 155 | if (src[i] == '=' && ++j > 2) |
| 156 | return -EINVAL; |
Harald Welte | c757239 | 2021-09-17 08:23:09 +0200 | [diff] [blame] | 157 | |
Harald Welte | d075e3a | 2021-09-17 08:45:25 +0200 | [diff] [blame] | 158 | if (src[i] > 127 || base64_dec_map[src[i]] == 127) |
| 159 | return -EINVAL; |
Harald Welte | c757239 | 2021-09-17 08:23:09 +0200 | [diff] [blame] | 160 | |
Harald Welte | d075e3a | 2021-09-17 08:45:25 +0200 | [diff] [blame] | 161 | if (base64_dec_map[src[i]] < 64 && j != 0) |
| 162 | return -EINVAL; |
Harald Welte | c757239 | 2021-09-17 08:23:09 +0200 | [diff] [blame] | 163 | |
Harald Welte | d075e3a | 2021-09-17 08:45:25 +0200 | [diff] [blame] | 164 | n++; |
| 165 | } |
Harald Welte | c757239 | 2021-09-17 08:23:09 +0200 | [diff] [blame] | 166 | |
Harald Welte | d075e3a | 2021-09-17 08:45:25 +0200 | [diff] [blame] | 167 | if (n == 0) |
| 168 | return 0; |
Harald Welte | c757239 | 2021-09-17 08:23:09 +0200 | [diff] [blame] | 169 | |
Harald Welte | d075e3a | 2021-09-17 08:45:25 +0200 | [diff] [blame] | 170 | n = ((n * 6) + 7) >> 3; |
| 171 | n -= j; |
Harald Welte | c757239 | 2021-09-17 08:23:09 +0200 | [diff] [blame] | 172 | |
Harald Welte | d075e3a | 2021-09-17 08:45:25 +0200 | [diff] [blame] | 173 | if (dst == NULL || dlen < n) { |
| 174 | *olen = n; |
| 175 | return -ENOBUFS; |
| 176 | } |
Harald Welte | c757239 | 2021-09-17 08:23:09 +0200 | [diff] [blame] | 177 | |
Harald Welte | d075e3a | 2021-09-17 08:45:25 +0200 | [diff] [blame] | 178 | for (j = 3, n = x = 0, p = dst; i > 0; i--, src++) { |
| 179 | if (*src == '\r' || *src == '\n' || *src == ' ') |
| 180 | continue; |
Harald Welte | c757239 | 2021-09-17 08:23:09 +0200 | [diff] [blame] | 181 | |
Harald Welte | d075e3a | 2021-09-17 08:45:25 +0200 | [diff] [blame] | 182 | j -= (base64_dec_map[*src] == 64); |
| 183 | x = (x << 6) | (base64_dec_map[*src] & 0x3F); |
Harald Welte | c757239 | 2021-09-17 08:23:09 +0200 | [diff] [blame] | 184 | |
Harald Welte | d075e3a | 2021-09-17 08:45:25 +0200 | [diff] [blame] | 185 | if (++n == 4) { |
| 186 | n = 0; |
| 187 | if (j > 0) |
| 188 | *p++ = (unsigned char)(x >> 16); |
| 189 | if (j > 1) |
| 190 | *p++ = (unsigned char)(x >> 8); |
| 191 | if (j > 2) |
| 192 | *p++ = (unsigned char)(x); |
| 193 | } |
| 194 | } |
Harald Welte | c757239 | 2021-09-17 08:23:09 +0200 | [diff] [blame] | 195 | |
Harald Welte | d075e3a | 2021-09-17 08:45:25 +0200 | [diff] [blame] | 196 | *olen = p - dst; |
Harald Welte | c757239 | 2021-09-17 08:23:09 +0200 | [diff] [blame] | 197 | |
Harald Welte | d075e3a | 2021-09-17 08:45:25 +0200 | [diff] [blame] | 198 | return 0; |
Harald Welte | c757239 | 2021-09-17 08:23:09 +0200 | [diff] [blame] | 199 | } |