| 1 | /* |
| 2 | * This file is part of the MicroPython project, http://micropython.org/ |
| 3 | * |
| 4 | * The MIT License (MIT) |
| 5 | * |
| 6 | * Copyright (c) 2014 Paul Sokolovsky |
| 7 | * |
| 8 | * Permission is hereby granted, free of charge, to any person obtaining a copy |
| 9 | * of this software and associated documentation files (the "Software"), to deal |
| 10 | * in the Software without restriction, including without limitation the rights |
| 11 | * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell |
| 12 | * copies of the Software, and to permit persons to whom the Software is |
| 13 | * furnished to do so, subject to the following conditions: |
| 14 | * |
| 15 | * The above copyright notice and this permission notice shall be included in |
| 16 | * all copies or substantial portions of the Software. |
| 17 | * |
| 18 | * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR |
| 19 | * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, |
| 20 | * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE |
| 21 | * AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER |
| 22 | * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, |
| 23 | * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN |
| 24 | * THE SOFTWARE. |
| 25 | */ |
| 26 | |
| 27 | #include <stdio.h> |
| 28 | #include <assert.h> |
| 29 | #include <string.h> |
| 30 | |
| 31 | #include "py/runtime.h" |
| 32 | #include "py/binary.h" |
| 33 | |
| 34 | #if MICROPY_PY_UBINASCII |
| 35 | |
| 36 | STATIC mp_obj_t mod_binascii_hexlify(size_t n_args, const mp_obj_t *args) { |
| 37 | // First argument is the data to convert. |
| 38 | // Second argument is an optional separator to be used between values. |
| 39 | const char *sep = NULL; |
| 40 | mp_buffer_info_t bufinfo; |
| 41 | mp_get_buffer_raise(args[0], &bufinfo, MP_BUFFER_READ); |
| 42 | |
| 43 | // Code below assumes non-zero buffer length when computing size with |
| 44 | // separator, so handle the zero-length case here. |
| 45 | if (bufinfo.len == 0) { |
| 46 | return mp_const_empty_bytes; |
| 47 | } |
| 48 | |
| 49 | vstr_t vstr; |
| 50 | size_t out_len = bufinfo.len * 2; |
| 51 | if (n_args > 1) { |
| 52 | // 1-char separator between hex numbers |
| 53 | out_len += bufinfo.len - 1; |
| 54 | sep = mp_obj_str_get_str(args[1]); |
| 55 | } |
| 56 | vstr_init_len(&vstr, out_len); |
| 57 | byte *in = bufinfo.buf, *out = (byte *)vstr.buf; |
| 58 | for (mp_uint_t i = bufinfo.len; i--;) { |
| 59 | byte d = (*in >> 4); |
| 60 | if (d > 9) { |
| 61 | d += 'a' - '9' - 1; |
| 62 | } |
| 63 | *out++ = d + '0'; |
| 64 | d = (*in++ & 0xf); |
| 65 | if (d > 9) { |
| 66 | d += 'a' - '9' - 1; |
| 67 | } |
| 68 | *out++ = d + '0'; |
| 69 | if (sep != NULL && i != 0) { |
| 70 | *out++ = *sep; |
| 71 | } |
| 72 | } |
| 73 | return mp_obj_new_str_from_vstr(&mp_type_bytes, &vstr); |
| 74 | } |
| 75 | STATIC MP_DEFINE_CONST_FUN_OBJ_VAR_BETWEEN(mod_binascii_hexlify_obj, 1, 2, mod_binascii_hexlify); |
| 76 | |
| 77 | STATIC mp_obj_t mod_binascii_unhexlify(mp_obj_t data) { |
| 78 | mp_buffer_info_t bufinfo; |
| 79 | mp_get_buffer_raise(data, &bufinfo, MP_BUFFER_READ); |
| 80 | |
| 81 | if ((bufinfo.len & 1) != 0) { |
| 82 | mp_raise_ValueError(MP_ERROR_TEXT("odd-length string" )); |
| 83 | } |
| 84 | vstr_t vstr; |
| 85 | vstr_init_len(&vstr, bufinfo.len / 2); |
| 86 | byte *in = bufinfo.buf, *out = (byte *)vstr.buf; |
| 87 | byte hex_byte = 0; |
| 88 | for (mp_uint_t i = bufinfo.len; i--;) { |
| 89 | byte hex_ch = *in++; |
| 90 | if (unichar_isxdigit(hex_ch)) { |
| 91 | hex_byte += unichar_xdigit_value(hex_ch); |
| 92 | } else { |
| 93 | mp_raise_ValueError(MP_ERROR_TEXT("non-hex digit found" )); |
| 94 | } |
| 95 | if (i & 1) { |
| 96 | hex_byte <<= 4; |
| 97 | } else { |
| 98 | *out++ = hex_byte; |
| 99 | hex_byte = 0; |
| 100 | } |
| 101 | } |
| 102 | return mp_obj_new_str_from_vstr(&mp_type_bytes, &vstr); |
| 103 | } |
| 104 | STATIC MP_DEFINE_CONST_FUN_OBJ_1(mod_binascii_unhexlify_obj, mod_binascii_unhexlify); |
| 105 | |
| 106 | // If ch is a character in the base64 alphabet, and is not a pad character, then |
| 107 | // the corresponding integer between 0 and 63, inclusively, is returned. |
| 108 | // Otherwise, -1 is returned. |
| 109 | static int mod_binascii_sextet(byte ch) { |
| 110 | if (ch >= 'A' && ch <= 'Z') { |
| 111 | return ch - 'A'; |
| 112 | } else if (ch >= 'a' && ch <= 'z') { |
| 113 | return ch - 'a' + 26; |
| 114 | } else if (ch >= '0' && ch <= '9') { |
| 115 | return ch - '0' + 52; |
| 116 | } else if (ch == '+') { |
| 117 | return 62; |
| 118 | } else if (ch == '/') { |
| 119 | return 63; |
| 120 | } else { |
| 121 | return -1; |
| 122 | } |
| 123 | } |
| 124 | |
| 125 | STATIC mp_obj_t mod_binascii_a2b_base64(mp_obj_t data) { |
| 126 | mp_buffer_info_t bufinfo; |
| 127 | mp_get_buffer_raise(data, &bufinfo, MP_BUFFER_READ); |
| 128 | byte *in = bufinfo.buf; |
| 129 | |
| 130 | vstr_t vstr; |
| 131 | vstr_init(&vstr, (bufinfo.len / 4) * 3 + 1); // Potentially over-allocate |
| 132 | byte *out = (byte *)vstr.buf; |
| 133 | |
| 134 | uint shift = 0; |
| 135 | int nbits = 0; // Number of meaningful bits in shift |
| 136 | bool hadpad = false; // Had a pad character since last valid character |
| 137 | for (size_t i = 0; i < bufinfo.len; i++) { |
| 138 | if (in[i] == '=') { |
| 139 | if ((nbits == 2) || ((nbits == 4) && hadpad)) { |
| 140 | nbits = 0; |
| 141 | break; |
| 142 | } |
| 143 | hadpad = true; |
| 144 | } |
| 145 | |
| 146 | int sextet = mod_binascii_sextet(in[i]); |
| 147 | if (sextet == -1) { |
| 148 | continue; |
| 149 | } |
| 150 | hadpad = false; |
| 151 | shift = (shift << 6) | sextet; |
| 152 | nbits += 6; |
| 153 | |
| 154 | if (nbits >= 8) { |
| 155 | nbits -= 8; |
| 156 | out[vstr.len++] = (shift >> nbits) & 0xFF; |
| 157 | } |
| 158 | } |
| 159 | |
| 160 | if (nbits) { |
| 161 | mp_raise_ValueError(MP_ERROR_TEXT("incorrect padding" )); |
| 162 | } |
| 163 | |
| 164 | return mp_obj_new_str_from_vstr(&mp_type_bytes, &vstr); |
| 165 | } |
| 166 | STATIC MP_DEFINE_CONST_FUN_OBJ_1(mod_binascii_a2b_base64_obj, mod_binascii_a2b_base64); |
| 167 | |
| 168 | STATIC mp_obj_t mod_binascii_b2a_base64(mp_obj_t data) { |
| 169 | mp_buffer_info_t bufinfo; |
| 170 | mp_get_buffer_raise(data, &bufinfo, MP_BUFFER_READ); |
| 171 | |
| 172 | vstr_t vstr; |
| 173 | vstr_init_len(&vstr, ((bufinfo.len != 0) ? (((bufinfo.len - 1) / 3) + 1) * 4 : 0) + 1); |
| 174 | |
| 175 | // First pass, we convert input buffer to numeric base 64 values |
| 176 | byte *in = bufinfo.buf, *out = (byte *)vstr.buf; |
| 177 | mp_uint_t i; |
| 178 | for (i = bufinfo.len; i >= 3; i -= 3) { |
| 179 | *out++ = (in[0] & 0xFC) >> 2; |
| 180 | *out++ = (in[0] & 0x03) << 4 | (in[1] & 0xF0) >> 4; |
| 181 | *out++ = (in[1] & 0x0F) << 2 | (in[2] & 0xC0) >> 6; |
| 182 | *out++ = in[2] & 0x3F; |
| 183 | in += 3; |
| 184 | } |
| 185 | if (i != 0) { |
| 186 | *out++ = (in[0] & 0xFC) >> 2; |
| 187 | if (i == 2) { |
| 188 | *out++ = (in[0] & 0x03) << 4 | (in[1] & 0xF0) >> 4; |
| 189 | *out++ = (in[1] & 0x0F) << 2; |
| 190 | } else { |
| 191 | *out++ = (in[0] & 0x03) << 4; |
| 192 | *out++ = 64; |
| 193 | } |
| 194 | *out = 64; |
| 195 | } |
| 196 | |
| 197 | // Second pass, we convert number base 64 values to actual base64 ascii encoding |
| 198 | out = (byte *)vstr.buf; |
| 199 | for (mp_uint_t j = vstr.len - 1; j--;) { |
| 200 | if (*out < 26) { |
| 201 | *out += 'A'; |
| 202 | } else if (*out < 52) { |
| 203 | *out += 'a' - 26; |
| 204 | } else if (*out < 62) { |
| 205 | *out += '0' - 52; |
| 206 | } else if (*out == 62) { |
| 207 | *out = '+'; |
| 208 | } else if (*out == 63) { |
| 209 | *out = '/'; |
| 210 | } else { |
| 211 | *out = '='; |
| 212 | } |
| 213 | out++; |
| 214 | } |
| 215 | *out = '\n'; |
| 216 | return mp_obj_new_str_from_vstr(&mp_type_bytes, &vstr); |
| 217 | } |
| 218 | STATIC MP_DEFINE_CONST_FUN_OBJ_1(mod_binascii_b2a_base64_obj, mod_binascii_b2a_base64); |
| 219 | |
| 220 | #if MICROPY_PY_UBINASCII_CRC32 |
| 221 | #include "uzlib/tinf.h" |
| 222 | |
| 223 | STATIC mp_obj_t mod_binascii_crc32(size_t n_args, const mp_obj_t *args) { |
| 224 | mp_buffer_info_t bufinfo; |
| 225 | mp_get_buffer_raise(args[0], &bufinfo, MP_BUFFER_READ); |
| 226 | uint32_t crc = (n_args > 1) ? mp_obj_get_int_truncated(args[1]) : 0; |
| 227 | crc = uzlib_crc32(bufinfo.buf, bufinfo.len, crc ^ 0xffffffff); |
| 228 | return mp_obj_new_int_from_uint(crc ^ 0xffffffff); |
| 229 | } |
| 230 | STATIC MP_DEFINE_CONST_FUN_OBJ_VAR_BETWEEN(mod_binascii_crc32_obj, 1, 2, mod_binascii_crc32); |
| 231 | #endif |
| 232 | |
| 233 | STATIC const mp_rom_map_elem_t mp_module_binascii_globals_table[] = { |
| 234 | { MP_ROM_QSTR(MP_QSTR___name__), MP_ROM_QSTR(MP_QSTR_ubinascii) }, |
| 235 | { MP_ROM_QSTR(MP_QSTR_hexlify), MP_ROM_PTR(&mod_binascii_hexlify_obj) }, |
| 236 | { MP_ROM_QSTR(MP_QSTR_unhexlify), MP_ROM_PTR(&mod_binascii_unhexlify_obj) }, |
| 237 | { MP_ROM_QSTR(MP_QSTR_a2b_base64), MP_ROM_PTR(&mod_binascii_a2b_base64_obj) }, |
| 238 | { MP_ROM_QSTR(MP_QSTR_b2a_base64), MP_ROM_PTR(&mod_binascii_b2a_base64_obj) }, |
| 239 | #if MICROPY_PY_UBINASCII_CRC32 |
| 240 | { MP_ROM_QSTR(MP_QSTR_crc32), MP_ROM_PTR(&mod_binascii_crc32_obj) }, |
| 241 | #endif |
| 242 | }; |
| 243 | |
| 244 | STATIC MP_DEFINE_CONST_DICT(mp_module_binascii_globals, mp_module_binascii_globals_table); |
| 245 | |
| 246 | const mp_obj_module_t mp_module_ubinascii = { |
| 247 | .base = { &mp_type_module }, |
| 248 | .globals = (mp_obj_dict_t *)&mp_module_binascii_globals, |
| 249 | }; |
| 250 | |
| 251 | #endif // MICROPY_PY_UBINASCII |
| 252 | |