|
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