| 1 | /* |
| 2 | * This file is part of the MicroPython project, http://micropython.org/ |
| 3 | * |
| 4 | * The MIT License (MIT) |
| 5 | * |
| 6 | * Copyright (c) 2013, 2014 Damien P. George |
| 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 <assert.h> |
| 28 | #include <string.h> |
| 29 | #include <stdio.h> |
| 30 | |
| 31 | #include "py/mpstate.h" |
| 32 | #include "py/qstr.h" |
| 33 | #include "py/gc.h" |
| 34 | #include "py/runtime.h" |
| 35 | |
| 36 | // NOTE: we are using linear arrays to store and search for qstr's (unique strings, interned strings) |
| 37 | // ultimately we will replace this with a static hash table of some kind |
| 38 | // also probably need to include the length in the string data, to allow null bytes in the string |
| 39 | |
| 40 | #if MICROPY_DEBUG_VERBOSE // print debugging info |
| 41 | #define DEBUG_printf DEBUG_printf |
| 42 | #else // don't print debugging info |
| 43 | #define DEBUG_printf(...) (void)0 |
| 44 | #endif |
| 45 | |
| 46 | // A qstr is an index into the qstr pool. |
| 47 | // The data for a qstr contains (hash, length, data): |
| 48 | // - hash (configurable number of bytes) |
| 49 | // - length (configurable number of bytes) |
| 50 | // - data ("length" number of bytes) |
| 51 | // - \0 terminated (so they can be printed using printf) |
| 52 | |
| 53 | #if MICROPY_QSTR_BYTES_IN_HASH == 1 |
| 54 | #define Q_HASH_MASK (0xff) |
| 55 | #define Q_GET_HASH(q) ((mp_uint_t)(q)[0]) |
| 56 | #define Q_SET_HASH(q, hash) do { (q)[0] = (hash); } while (0) |
| 57 | #elif MICROPY_QSTR_BYTES_IN_HASH == 2 |
| 58 | #define Q_HASH_MASK (0xffff) |
| 59 | #define Q_GET_HASH(q) ((mp_uint_t)(q)[0] | ((mp_uint_t)(q)[1] << 8)) |
| 60 | #define Q_SET_HASH(q, hash) do { (q)[0] = (hash); (q)[1] = (hash) >> 8; } while (0) |
| 61 | #else |
| 62 | #error unimplemented qstr hash decoding |
| 63 | #endif |
| 64 | #define Q_GET_ALLOC(q) (MICROPY_QSTR_BYTES_IN_HASH + MICROPY_QSTR_BYTES_IN_LEN + Q_GET_LENGTH(q) + 1) |
| 65 | #define Q_GET_DATA(q) ((q) + MICROPY_QSTR_BYTES_IN_HASH + MICROPY_QSTR_BYTES_IN_LEN) |
| 66 | #if MICROPY_QSTR_BYTES_IN_LEN == 1 |
| 67 | #define Q_GET_LENGTH(q) ((q)[MICROPY_QSTR_BYTES_IN_HASH]) |
| 68 | #define Q_SET_LENGTH(q, len) do { (q)[MICROPY_QSTR_BYTES_IN_HASH] = (len); } while (0) |
| 69 | #elif MICROPY_QSTR_BYTES_IN_LEN == 2 |
| 70 | #define Q_GET_LENGTH(q) ((q)[MICROPY_QSTR_BYTES_IN_HASH] | ((q)[MICROPY_QSTR_BYTES_IN_HASH + 1] << 8)) |
| 71 | #define Q_SET_LENGTH(q, len) do { (q)[MICROPY_QSTR_BYTES_IN_HASH] = (len); (q)[MICROPY_QSTR_BYTES_IN_HASH + 1] = (len) >> 8; } while (0) |
| 72 | #else |
| 73 | #error unimplemented qstr length decoding |
| 74 | #endif |
| 75 | |
| 76 | #if MICROPY_PY_THREAD && !MICROPY_PY_THREAD_GIL |
| 77 | #define QSTR_ENTER() mp_thread_mutex_lock(&MP_STATE_VM(qstr_mutex), 1) |
| 78 | #define QSTR_EXIT() mp_thread_mutex_unlock(&MP_STATE_VM(qstr_mutex)) |
| 79 | #else |
| 80 | #define QSTR_ENTER() |
| 81 | #define QSTR_EXIT() |
| 82 | #endif |
| 83 | |
| 84 | // Initial number of entries for qstr pool, set so that the first dynamically |
| 85 | // allocated pool is twice this size. The value here must be <= MP_QSTRnumber_of. |
| 86 | #define MICROPY_ALLOC_QSTR_ENTRIES_INIT (10) |
| 87 | |
| 88 | // this must match the equivalent function in makeqstrdata.py |
| 89 | mp_uint_t qstr_compute_hash(const byte *data, size_t len) { |
| 90 | // djb2 algorithm; see http://www.cse.yorku.ca/~oz/hash.html |
| 91 | mp_uint_t hash = 5381; |
| 92 | for (const byte *top = data + len; data < top; data++) { |
| 93 | hash = ((hash << 5) + hash) ^ (*data); // hash * 33 ^ data |
| 94 | } |
| 95 | hash &= Q_HASH_MASK; |
| 96 | // Make sure that valid hash is never zero, zero means "hash not computed" |
| 97 | if (hash == 0) { |
| 98 | hash++; |
| 99 | } |
| 100 | return hash; |
| 101 | } |
| 102 | |
| 103 | const qstr_pool_t mp_qstr_const_pool = { |
| 104 | NULL, // no previous pool |
| 105 | 0, // no previous pool |
| 106 | MICROPY_ALLOC_QSTR_ENTRIES_INIT, |
| 107 | MP_QSTRnumber_of, // corresponds to number of strings in array just below |
| 108 | { |
| 109 | #ifndef NO_QSTR |
| 110 | #define QDEF(id, str) str, |
| 111 | #include "genhdr/qstrdefs.generated.h" |
| 112 | #undef QDEF |
| 113 | #endif |
| 114 | }, |
| 115 | }; |
| 116 | |
| 117 | #ifdef MICROPY_QSTR_EXTRA_POOL |
| 118 | extern const qstr_pool_t MICROPY_QSTR_EXTRA_POOL; |
| 119 | #define CONST_POOL MICROPY_QSTR_EXTRA_POOL |
| 120 | #else |
| 121 | #define CONST_POOL mp_qstr_const_pool |
| 122 | #endif |
| 123 | |
| 124 | void qstr_init(void) { |
| 125 | MP_STATE_VM(last_pool) = (qstr_pool_t *)&CONST_POOL; // we won't modify the const_pool since it has no allocated room left |
| 126 | MP_STATE_VM(qstr_last_chunk) = NULL; |
| 127 | |
| 128 | #if MICROPY_PY_THREAD && !MICROPY_PY_THREAD_GIL |
| 129 | mp_thread_mutex_init(&MP_STATE_VM(qstr_mutex)); |
| 130 | #endif |
| 131 | } |
| 132 | |
| 133 | STATIC const byte *find_qstr(qstr q) { |
| 134 | // search pool for this qstr |
| 135 | // total_prev_len==0 in the final pool, so the loop will always terminate |
| 136 | qstr_pool_t *pool = MP_STATE_VM(last_pool); |
| 137 | while (q < pool->total_prev_len) { |
| 138 | pool = pool->prev; |
| 139 | } |
| 140 | return pool->qstrs[q - pool->total_prev_len]; |
| 141 | } |
| 142 | |
| 143 | // qstr_mutex must be taken while in this function |
| 144 | STATIC qstr qstr_add(const byte *q_ptr) { |
| 145 | DEBUG_printf("QSTR: add hash=%d len=%d data=%.*s\n" , Q_GET_HASH(q_ptr), Q_GET_LENGTH(q_ptr), Q_GET_LENGTH(q_ptr), Q_GET_DATA(q_ptr)); |
| 146 | |
| 147 | // make sure we have room in the pool for a new qstr |
| 148 | if (MP_STATE_VM(last_pool)->len >= MP_STATE_VM(last_pool)->alloc) { |
| 149 | size_t new_alloc = MP_STATE_VM(last_pool)->alloc * 2; |
| 150 | #ifdef MICROPY_QSTR_EXTRA_POOL |
| 151 | // Put a lower bound on the allocation size in case the extra qstr pool has few entries |
| 152 | new_alloc = MAX(MICROPY_ALLOC_QSTR_ENTRIES_INIT, new_alloc); |
| 153 | #endif |
| 154 | qstr_pool_t *pool = m_new_obj_var_maybe(qstr_pool_t, const char *, new_alloc); |
| 155 | if (pool == NULL) { |
| 156 | QSTR_EXIT(); |
| 157 | m_malloc_fail(new_alloc); |
| 158 | } |
| 159 | pool->prev = MP_STATE_VM(last_pool); |
| 160 | pool->total_prev_len = MP_STATE_VM(last_pool)->total_prev_len + MP_STATE_VM(last_pool)->len; |
| 161 | pool->alloc = new_alloc; |
| 162 | pool->len = 0; |
| 163 | MP_STATE_VM(last_pool) = pool; |
| 164 | DEBUG_printf("QSTR: allocate new pool of size %d\n" , MP_STATE_VM(last_pool)->alloc); |
| 165 | } |
| 166 | |
| 167 | // add the new qstr |
| 168 | MP_STATE_VM(last_pool)->qstrs[MP_STATE_VM(last_pool)->len++] = q_ptr; |
| 169 | |
| 170 | // return id for the newly-added qstr |
| 171 | return MP_STATE_VM(last_pool)->total_prev_len + MP_STATE_VM(last_pool)->len - 1; |
| 172 | } |
| 173 | |
| 174 | qstr qstr_find_strn(const char *str, size_t str_len) { |
| 175 | // work out hash of str |
| 176 | mp_uint_t str_hash = qstr_compute_hash((const byte *)str, str_len); |
| 177 | |
| 178 | // search pools for the data |
| 179 | for (qstr_pool_t *pool = MP_STATE_VM(last_pool); pool != NULL; pool = pool->prev) { |
| 180 | for (const byte **q = pool->qstrs, **q_top = pool->qstrs + pool->len; q < q_top; q++) { |
| 181 | if (Q_GET_HASH(*q) == str_hash && Q_GET_LENGTH(*q) == str_len && memcmp(Q_GET_DATA(*q), str, str_len) == 0) { |
| 182 | return pool->total_prev_len + (q - pool->qstrs); |
| 183 | } |
| 184 | } |
| 185 | } |
| 186 | |
| 187 | // not found; return null qstr |
| 188 | return 0; |
| 189 | } |
| 190 | |
| 191 | qstr qstr_from_str(const char *str) { |
| 192 | return qstr_from_strn(str, strlen(str)); |
| 193 | } |
| 194 | |
| 195 | qstr qstr_from_strn(const char *str, size_t len) { |
| 196 | QSTR_ENTER(); |
| 197 | qstr q = qstr_find_strn(str, len); |
| 198 | if (q == 0) { |
| 199 | // qstr does not exist in interned pool so need to add it |
| 200 | |
| 201 | // check that len is not too big |
| 202 | if (len >= (1 << (8 * MICROPY_QSTR_BYTES_IN_LEN))) { |
| 203 | QSTR_EXIT(); |
| 204 | mp_raise_msg(&mp_type_RuntimeError, MP_ERROR_TEXT("name too long" )); |
| 205 | } |
| 206 | |
| 207 | // compute number of bytes needed to intern this string |
| 208 | size_t n_bytes = MICROPY_QSTR_BYTES_IN_HASH + MICROPY_QSTR_BYTES_IN_LEN + len + 1; |
| 209 | |
| 210 | if (MP_STATE_VM(qstr_last_chunk) != NULL && MP_STATE_VM(qstr_last_used) + n_bytes > MP_STATE_VM(qstr_last_alloc)) { |
| 211 | // not enough room at end of previously interned string so try to grow |
| 212 | byte *new_p = m_renew_maybe(byte, MP_STATE_VM(qstr_last_chunk), MP_STATE_VM(qstr_last_alloc), MP_STATE_VM(qstr_last_alloc) + n_bytes, false); |
| 213 | if (new_p == NULL) { |
| 214 | // could not grow existing memory; shrink it to fit previous |
| 215 | (void)m_renew_maybe(byte, MP_STATE_VM(qstr_last_chunk), MP_STATE_VM(qstr_last_alloc), MP_STATE_VM(qstr_last_used), false); |
| 216 | MP_STATE_VM(qstr_last_chunk) = NULL; |
| 217 | } else { |
| 218 | // could grow existing memory |
| 219 | MP_STATE_VM(qstr_last_alloc) += n_bytes; |
| 220 | } |
| 221 | } |
| 222 | |
| 223 | if (MP_STATE_VM(qstr_last_chunk) == NULL) { |
| 224 | // no existing memory for the interned string so allocate a new chunk |
| 225 | size_t al = n_bytes; |
| 226 | if (al < MICROPY_ALLOC_QSTR_CHUNK_INIT) { |
| 227 | al = MICROPY_ALLOC_QSTR_CHUNK_INIT; |
| 228 | } |
| 229 | MP_STATE_VM(qstr_last_chunk) = m_new_maybe(byte, al); |
| 230 | if (MP_STATE_VM(qstr_last_chunk) == NULL) { |
| 231 | // failed to allocate a large chunk so try with exact size |
| 232 | MP_STATE_VM(qstr_last_chunk) = m_new_maybe(byte, n_bytes); |
| 233 | if (MP_STATE_VM(qstr_last_chunk) == NULL) { |
| 234 | QSTR_EXIT(); |
| 235 | m_malloc_fail(n_bytes); |
| 236 | } |
| 237 | al = n_bytes; |
| 238 | } |
| 239 | MP_STATE_VM(qstr_last_alloc) = al; |
| 240 | MP_STATE_VM(qstr_last_used) = 0; |
| 241 | } |
| 242 | |
| 243 | // allocate memory from the chunk for this new interned string's data |
| 244 | byte *q_ptr = MP_STATE_VM(qstr_last_chunk) + MP_STATE_VM(qstr_last_used); |
| 245 | MP_STATE_VM(qstr_last_used) += n_bytes; |
| 246 | |
| 247 | // store the interned strings' data |
| 248 | mp_uint_t hash = qstr_compute_hash((const byte *)str, len); |
| 249 | Q_SET_HASH(q_ptr, hash); |
| 250 | Q_SET_LENGTH(q_ptr, len); |
| 251 | memcpy(q_ptr + MICROPY_QSTR_BYTES_IN_HASH + MICROPY_QSTR_BYTES_IN_LEN, str, len); |
| 252 | q_ptr[MICROPY_QSTR_BYTES_IN_HASH + MICROPY_QSTR_BYTES_IN_LEN + len] = '\0'; |
| 253 | q = qstr_add(q_ptr); |
| 254 | } |
| 255 | QSTR_EXIT(); |
| 256 | return q; |
| 257 | } |
| 258 | |
| 259 | mp_uint_t qstr_hash(qstr q) { |
| 260 | const byte *qd = find_qstr(q); |
| 261 | return Q_GET_HASH(qd); |
| 262 | } |
| 263 | |
| 264 | size_t qstr_len(qstr q) { |
| 265 | const byte *qd = find_qstr(q); |
| 266 | return Q_GET_LENGTH(qd); |
| 267 | } |
| 268 | |
| 269 | const char *qstr_str(qstr q) { |
| 270 | const byte *qd = find_qstr(q); |
| 271 | return (const char *)Q_GET_DATA(qd); |
| 272 | } |
| 273 | |
| 274 | const byte *qstr_data(qstr q, size_t *len) { |
| 275 | const byte *qd = find_qstr(q); |
| 276 | *len = Q_GET_LENGTH(qd); |
| 277 | return Q_GET_DATA(qd); |
| 278 | } |
| 279 | |
| 280 | void qstr_pool_info(size_t *n_pool, size_t *n_qstr, size_t *n_str_data_bytes, size_t *n_total_bytes) { |
| 281 | QSTR_ENTER(); |
| 282 | *n_pool = 0; |
| 283 | *n_qstr = 0; |
| 284 | *n_str_data_bytes = 0; |
| 285 | *n_total_bytes = 0; |
| 286 | for (qstr_pool_t *pool = MP_STATE_VM(last_pool); pool != NULL && pool != &CONST_POOL; pool = pool->prev) { |
| 287 | *n_pool += 1; |
| 288 | *n_qstr += pool->len; |
| 289 | for (const byte **q = pool->qstrs, **q_top = pool->qstrs + pool->len; q < q_top; q++) { |
| 290 | *n_str_data_bytes += Q_GET_ALLOC(*q); |
| 291 | } |
| 292 | #if MICROPY_ENABLE_GC |
| 293 | *n_total_bytes += gc_nbytes(pool); // this counts actual bytes used in heap |
| 294 | #else |
| 295 | *n_total_bytes += sizeof(qstr_pool_t) + sizeof(qstr) * pool->alloc; |
| 296 | #endif |
| 297 | } |
| 298 | *n_total_bytes += *n_str_data_bytes; |
| 299 | QSTR_EXIT(); |
| 300 | } |
| 301 | |
| 302 | #if MICROPY_PY_MICROPYTHON_MEM_INFO |
| 303 | void qstr_dump_data(void) { |
| 304 | QSTR_ENTER(); |
| 305 | for (qstr_pool_t *pool = MP_STATE_VM(last_pool); pool != NULL && pool != &CONST_POOL; pool = pool->prev) { |
| 306 | for (const byte **q = pool->qstrs, **q_top = pool->qstrs + pool->len; q < q_top; q++) { |
| 307 | mp_printf(&mp_plat_print, "Q(%s)\n" , Q_GET_DATA(*q)); |
| 308 | } |
| 309 | } |
| 310 | QSTR_EXIT(); |
| 311 | } |
| 312 | #endif |
| 313 | |
| 314 | #if MICROPY_ROM_TEXT_COMPRESSION |
| 315 | |
| 316 | #ifdef NO_QSTR |
| 317 | |
| 318 | // If NO_QSTR is set, it means we're doing QSTR extraction. |
| 319 | // So we won't yet have "genhdr/compressed.data.h" |
| 320 | |
| 321 | #else |
| 322 | |
| 323 | // Emit the compressed_string_data string. |
| 324 | #define MP_COMPRESSED_DATA(x) STATIC const char *compressed_string_data = x; |
| 325 | #define MP_MATCH_COMPRESSED(a, b) |
| 326 | #include "genhdr/compressed.data.h" |
| 327 | #undef MP_COMPRESSED_DATA |
| 328 | #undef MP_MATCH_COMPRESSED |
| 329 | |
| 330 | #endif // NO_QSTR |
| 331 | |
| 332 | // This implements the "common word" compression scheme (see makecompresseddata.py) where the most |
| 333 | // common 128 words in error messages are replaced by their index into the list of common words. |
| 334 | |
| 335 | // The compressed string data is delimited by setting high bit in the final char of each word. |
| 336 | // e.g. aaaa<0x80|a>bbbbbb<0x80|b>.... |
| 337 | // This method finds the n'th string. |
| 338 | STATIC const byte *find_uncompressed_string(uint8_t n) { |
| 339 | const byte *c = (byte *)compressed_string_data; |
| 340 | while (n > 0) { |
| 341 | while ((*c & 0x80) == 0) { |
| 342 | ++c; |
| 343 | } |
| 344 | ++c; |
| 345 | --n; |
| 346 | } |
| 347 | return c; |
| 348 | } |
| 349 | |
| 350 | // Given a compressed string in src, decompresses it into dst. |
| 351 | // dst must be large enough (use MP_MAX_UNCOMPRESSED_TEXT_LEN+1). |
| 352 | void mp_decompress_rom_string(byte *dst, const mp_rom_error_text_t src_chr) { |
| 353 | // Skip past the 0xff marker. |
| 354 | const byte *src = (byte *)src_chr + 1; |
| 355 | // Need to add spaces around compressed words, except for the first (i.e. transition from 1<->2). |
| 356 | // 0 = start, 1 = compressed, 2 = regular. |
| 357 | int state = 0; |
| 358 | while (*src) { |
| 359 | if ((byte) * src >= 128) { |
| 360 | if (state != 0) { |
| 361 | *dst++ = ' '; |
| 362 | } |
| 363 | state = 1; |
| 364 | |
| 365 | // High bit set, replace with common word. |
| 366 | const byte *word = find_uncompressed_string(*src & 0x7f); |
| 367 | // The word is terminated by the final char having its high bit set. |
| 368 | while ((*word & 0x80) == 0) { |
| 369 | *dst++ = *word++; |
| 370 | } |
| 371 | *dst++ = (*word & 0x7f); |
| 372 | } else { |
| 373 | // Otherwise just copy one char. |
| 374 | if (state == 1) { |
| 375 | *dst++ = ' '; |
| 376 | } |
| 377 | state = 2; |
| 378 | |
| 379 | *dst++ = *src; |
| 380 | } |
| 381 | ++src; |
| 382 | } |
| 383 | // Add null-terminator. |
| 384 | *dst = 0; |
| 385 | } |
| 386 | |
| 387 | #endif // MICROPY_ROM_TEXT_COMPRESSION |
| 388 | |