|
1 | 1 | #include <stdint.h>
|
| 2 | +#include <stdlib.h> |
2 | 3 | #include <assert.h>
|
3 | 4 |
|
4 | 5 | #include "misc.h"
|
|
9 | 10 |
|
10 | 11 | // Helpers to work with binary-encoded data
|
11 | 12 |
|
12 |
| -int mp_binary_get_size(char typecode) { |
13 |
| - // This assumes that unsigned and signed types are of the same type, |
14 |
| - // which is invariant for [u]intN_t. |
15 |
| - switch (typecode) { |
16 |
| - case BYTEARRAY_TYPECODE: |
17 |
| - case 'b': |
18 |
| - case 'B': |
19 |
| - return sizeof(int8_t); |
20 |
| - case 'h': |
21 |
| - case 'H': |
22 |
| - return sizeof(int16_t); |
23 |
| - case 'i': |
24 |
| - case 'I': |
25 |
| - return sizeof(int32_t); |
26 |
| - case 'l': |
27 |
| - case 'L': |
28 |
| - return sizeof(int32_t); |
29 |
| - case 'q': |
30 |
| - case 'Q': |
31 |
| - return sizeof(long long); |
32 |
| -#if MICROPY_ENABLE_FLOAT |
33 |
| - case 'f': |
34 |
| - return sizeof(float); |
35 |
| - case 'd': |
36 |
| - return sizeof(double); |
37 |
| -#endif |
| 13 | +int mp_binary_get_size(char struct_type, char val_type, uint *palign) { |
| 14 | + int size = 0; |
| 15 | + int align = 1; |
| 16 | + switch (struct_type) { |
| 17 | + case '<': case '>': |
| 18 | + switch (val_type) { |
| 19 | + case 'b': case 'B': |
| 20 | + size = 1; break; |
| 21 | + case 'h': case 'H': |
| 22 | + size = 2; break; |
| 23 | + case 'i': case 'I': |
| 24 | + size = 4; break; |
| 25 | + case 'l': case 'L': |
| 26 | + size = 4; break; |
| 27 | + case 'q': case 'Q': |
| 28 | + size = 8; break; |
| 29 | + } |
| 30 | + break; |
| 31 | + case '@': { |
| 32 | + // TODO: |
| 33 | + // The simplest heuristic for alignment is to align by value |
| 34 | + // size, but that doesn't work for "bigger than int" types, |
| 35 | + // for example, long long may very well have long alignment |
| 36 | + // So, we introduce separate alignment handling, but having |
| 37 | + // formal support for that is different from actually supporting |
| 38 | + // particular (or any) ABI. |
| 39 | + switch (val_type) { |
| 40 | + case BYTEARRAY_TYPECODE: |
| 41 | + case 'b': case 'B': |
| 42 | + align = size = 1; break; |
| 43 | + case 'h': case 'H': |
| 44 | + align = size = sizeof(short); break; |
| 45 | + case 'i': case 'I': |
| 46 | + align = size = sizeof(int); break; |
| 47 | + case 'l': case 'L': |
| 48 | + align = size = sizeof(long); break; |
| 49 | + case 'q': case 'Q': |
| 50 | + // TODO: This is for x86 |
| 51 | + align = sizeof(int); size = sizeof(long long); break; |
| 52 | + } |
| 53 | + } |
38 | 54 | }
|
39 |
| - return -1; |
| 55 | + if (palign != NULL) { |
| 56 | + *palign = align; |
| 57 | + } |
| 58 | + return size; |
40 | 59 | }
|
41 | 60 |
|
42 | 61 | mp_obj_t mp_binary_get_val_array(char typecode, void *p, int index) {
|
@@ -80,53 +99,17 @@ mp_obj_t mp_binary_get_val_array(char typecode, void *p, int index) {
|
80 | 99 | #define is_signed(typecode) (typecode > 'Z')
|
81 | 100 | mp_obj_t mp_binary_get_val(char struct_type, char val_type, byte **ptr) {
|
82 | 101 | byte *p = *ptr;
|
83 |
| - uint size = 0; |
84 |
| - switch (struct_type) { |
85 |
| - case '<': case '>': |
86 |
| - switch (val_type) { |
87 |
| - case 'b': case 'B': |
88 |
| - size = 1; break; |
89 |
| - case 'h': case 'H': |
90 |
| - size = 2; break; |
91 |
| - case 'i': case 'I': |
92 |
| - size = 4; break; |
93 |
| - case 'l': case 'L': |
94 |
| - size = 4; break; |
95 |
| - case 'q': case 'Q': |
96 |
| - size = 8; break; |
97 |
| - } |
98 |
| - break; |
99 |
| - case '@': { |
100 |
| - // TODO: |
101 |
| - // The simplest heuristic for alignment is to align by value |
102 |
| - // size, but that doesn't work for "bigger than int" types, |
103 |
| - // for example, long long may very well have long alignment |
104 |
| - // So, we introduce separate alignment handling, but having |
105 |
| - // formal support for that is different from actually supporting |
106 |
| - // particular (or any) ABI. |
107 |
| - uint align = 0; |
108 |
| - switch (val_type) { |
109 |
| - case 'b': case 'B': |
110 |
| - align = size = 1; break; |
111 |
| - case 'h': case 'H': |
112 |
| - align = size = sizeof(short); break; |
113 |
| - case 'i': case 'I': |
114 |
| - align = size = sizeof(int); break; |
115 |
| - case 'l': case 'L': |
116 |
| - align = size = sizeof(long); break; |
117 |
| - case 'q': case 'Q': |
118 |
| - // TODO: This is for x86 |
119 |
| - align = sizeof(int); size = sizeof(long long); break; |
120 |
| - } |
121 |
| - // Make pointer aligned |
122 |
| - p = (byte*)(((machine_uint_t)p + align - 1) & ~(align - 1)); |
123 |
| - #if MP_ENDIANNESS_LITTLE |
124 |
| - struct_type = '<'; |
125 |
| - #else |
126 |
| - struct_type = '>'; |
127 |
| - #endif |
128 |
| - break; |
129 |
| - } |
| 102 | + uint align; |
| 103 | + |
| 104 | + int size = mp_binary_get_size(struct_type, val_type, &align); |
| 105 | + if (struct_type == '@') { |
| 106 | + // Make pointer aligned |
| 107 | + p = (byte*)(((machine_uint_t)p + align - 1) & ~(align - 1)); |
| 108 | + #if MP_ENDIANNESS_LITTLE |
| 109 | + struct_type = '<'; |
| 110 | + #else |
| 111 | + struct_type = '>'; |
| 112 | + #endif |
130 | 113 | }
|
131 | 114 |
|
132 | 115 | int delta;
|
|
0 commit comments