aboutsummaryrefslogtreecommitdiff
path: root/circuitpython/extmod/moductypes.c
diff options
context:
space:
mode:
authorRaghuram Subramani <raghus2247@gmail.com>2022-06-19 19:47:51 +0530
committerRaghuram Subramani <raghus2247@gmail.com>2022-06-19 19:47:51 +0530
commit4fd287655a72b9aea14cdac715ad5b90ed082ed2 (patch)
tree65d393bc0e699dd12d05b29ba568e04cea666207 /circuitpython/extmod/moductypes.c
parent0150f70ce9c39e9e6dd878766c0620c85e47bed0 (diff)
add circuitpython code
Diffstat (limited to 'circuitpython/extmod/moductypes.c')
-rw-r--r--circuitpython/extmod/moductypes.c709
1 files changed, 709 insertions, 0 deletions
diff --git a/circuitpython/extmod/moductypes.c b/circuitpython/extmod/moductypes.c
new file mode 100644
index 0000000..265cbd6
--- /dev/null
+++ b/circuitpython/extmod/moductypes.c
@@ -0,0 +1,709 @@
+// Copyright (c) 2014-2018 Paul Sokolovsky
+// SPDX-FileCopyrightText: 2014 MicroPython & CircuitPython contributors (https://github.com/adafruit/circuitpython/graphs/contributors)
+//
+// SPDX-License-Identifier: MIT
+
+#include <assert.h>
+#include <string.h>
+#include <stdint.h>
+
+#include "py/runtime.h"
+#include "py/objtuple.h"
+#include "py/binary.h"
+
+#include "supervisor/shared/translate.h"
+
+#if MICROPY_PY_UCTYPES
+
+// The uctypes module allows defining the layout of a raw data structure (using
+// terms of the C language), and then access memory buffers using this definition.
+// The module also provides convenience functions to access memory buffers
+// contained in Python objects or wrap memory buffers in Python objects.
+
+#define LAYOUT_LITTLE_ENDIAN (0)
+#define LAYOUT_BIG_ENDIAN (1)
+#define LAYOUT_NATIVE (2)
+
+#define VAL_TYPE_BITS 4
+#define BITF_LEN_BITS 5
+#define BITF_OFF_BITS 5
+#define OFFSET_BITS 17
+#define LEN_BITS (OFFSET_BITS + BITF_OFF_BITS)
+#if VAL_TYPE_BITS + BITF_LEN_BITS + BITF_OFF_BITS + OFFSET_BITS != 31
+#error Invalid encoding field length
+#endif
+
+enum {
+ UINT8, INT8, UINT16, INT16,
+ UINT32, INT32, UINT64, INT64,
+
+ BFUINT8, BFINT8, BFUINT16, BFINT16,
+ BFUINT32, BFINT32,
+
+ FLOAT32, FLOAT64,
+};
+
+#define AGG_TYPE_BITS 2
+
+enum {
+ STRUCT, PTR, ARRAY,
+};
+
+// Here we need to set sign bit right
+#define TYPE2SMALLINT(x, nbits) ((((int)x) << (32 - nbits)) >> 1)
+#define GET_TYPE(x, nbits) (((x) >> (31 - nbits)) & ((1 << nbits) - 1))
+// Bit 0 is "is_signed"
+#define GET_SCALAR_SIZE(val_type) (1 << ((val_type) >> 1))
+#define VALUE_MASK(type_nbits) ~((int)0x80000000 >> type_nbits)
+
+#define IS_SCALAR_ARRAY(tuple_desc) ((tuple_desc)->len == 2)
+// We cannot apply the below to INT8, as their range [-128, 127]
+#define IS_SCALAR_ARRAY_OF_BYTES(tuple_desc) (GET_TYPE(MP_OBJ_SMALL_INT_VALUE((tuple_desc)->items[1]), VAL_TYPE_BITS) == UINT8)
+
+// "struct" in uctypes context means "structural", i.e. aggregate, type.
+STATIC const mp_obj_type_t uctypes_struct_type;
+
+typedef struct _mp_obj_uctypes_struct_t {
+ mp_obj_base_t base;
+ mp_obj_t desc;
+ byte *addr;
+ uint32_t flags;
+} mp_obj_uctypes_struct_t;
+
+STATIC NORETURN void syntax_error(void) {
+ mp_raise_TypeError(MP_ERROR_TEXT("syntax error in uctypes descriptor"));
+}
+
+STATIC mp_obj_t uctypes_struct_make_new(const mp_obj_type_t *type, size_t n_args, size_t n_kw, const mp_obj_t *args) {
+ mp_arg_check_num(n_args, n_kw, 2, 3, false);
+ mp_obj_uctypes_struct_t *o = m_new_obj(mp_obj_uctypes_struct_t);
+ o->base.type = type;
+ o->addr = (void *)(uintptr_t)mp_obj_int_get_truncated(args[0]);
+ o->desc = args[1];
+ o->flags = LAYOUT_NATIVE;
+ if (n_args == 3) {
+ o->flags = mp_obj_get_int(args[2]);
+ }
+ return MP_OBJ_FROM_PTR(o);
+}
+
+STATIC void uctypes_struct_print(const mp_print_t *print, mp_obj_t self_in, mp_print_kind_t kind) {
+ (void)kind;
+ mp_obj_uctypes_struct_t *self = MP_OBJ_TO_PTR(self_in);
+ const char *typen = "unk";
+ if (mp_obj_is_dict_or_ordereddict(self->desc)) {
+ typen = "STRUCT";
+ } else if (mp_obj_is_type(self->desc, &mp_type_tuple)) {
+ mp_obj_tuple_t *t = MP_OBJ_TO_PTR(self->desc);
+ mp_int_t offset = MP_OBJ_SMALL_INT_VALUE(t->items[0]);
+ uint agg_type = GET_TYPE(offset, AGG_TYPE_BITS);
+ switch (agg_type) {
+ case PTR:
+ typen = "PTR";
+ break;
+ case ARRAY:
+ typen = "ARRAY";
+ break;
+ }
+ } else {
+ typen = "ERROR";
+ }
+ mp_printf(print, "<struct %s %p>", typen, self->addr);
+}
+
+// Get size of any type descriptor
+STATIC mp_uint_t uctypes_struct_size(mp_obj_t desc_in, int layout_type, mp_uint_t *max_field_size);
+
+// Get size of scalar type descriptor
+static inline mp_uint_t uctypes_struct_scalar_size(int val_type) {
+ if (val_type == FLOAT32) {
+ return 4;
+ } else {
+ return GET_SCALAR_SIZE(val_type & 7);
+ }
+}
+
+// Get size of aggregate type descriptor
+STATIC mp_uint_t uctypes_struct_agg_size(mp_obj_tuple_t *t, int layout_type, mp_uint_t *max_field_size) {
+ mp_uint_t total_size = 0;
+
+ mp_int_t offset_ = MP_OBJ_SMALL_INT_VALUE(t->items[0]);
+ mp_uint_t agg_type = GET_TYPE(offset_, AGG_TYPE_BITS);
+
+ switch (agg_type) {
+ case STRUCT:
+ return uctypes_struct_size(t->items[1], layout_type, max_field_size);
+ case PTR:
+ if (sizeof(void *) > *max_field_size) {
+ *max_field_size = sizeof(void *);
+ }
+ return sizeof(void *);
+ case ARRAY: {
+ mp_int_t arr_sz = MP_OBJ_SMALL_INT_VALUE(t->items[1]);
+ uint val_type = GET_TYPE(arr_sz, VAL_TYPE_BITS);
+ arr_sz &= VALUE_MASK(VAL_TYPE_BITS);
+ mp_uint_t item_s;
+ if (t->len == 2) {
+ // Elements of array are scalar
+ item_s = uctypes_struct_scalar_size(val_type);
+ if (item_s > *max_field_size) {
+ *max_field_size = item_s;
+ }
+ } else {
+ // Elements of array are aggregates
+ item_s = uctypes_struct_size(t->items[2], layout_type, max_field_size);
+ }
+
+ return item_s * arr_sz;
+ }
+ default:
+ assert(0);
+ }
+
+ return total_size;
+}
+
+STATIC mp_uint_t uctypes_struct_size(mp_obj_t desc_in, int layout_type, mp_uint_t *max_field_size) {
+ if (!mp_obj_is_dict_or_ordereddict(desc_in)) {
+ if (mp_obj_is_type(desc_in, &mp_type_tuple)) {
+ return uctypes_struct_agg_size((mp_obj_tuple_t *)MP_OBJ_TO_PTR(desc_in), layout_type, max_field_size);
+ } else if (mp_obj_is_small_int(desc_in)) {
+ // We allow sizeof on both type definitions and structures/structure fields,
+ // but scalar structure field is lowered into native Python int, so all
+ // type info is lost. So, we cannot say if it's scalar type description,
+ // or such lowered scalar.
+ mp_raise_TypeError(MP_ERROR_TEXT("cannot unambiguously get sizeof scalar"));
+ }
+ syntax_error();
+ }
+
+ mp_obj_dict_t *d = MP_OBJ_TO_PTR(desc_in);
+ mp_uint_t total_size = 0;
+
+ for (mp_uint_t i = 0; i < d->map.alloc; i++) {
+ if (mp_map_slot_is_filled(&d->map, i)) {
+ mp_obj_t v = d->map.table[i].value;
+ if (mp_obj_is_small_int(v)) {
+ mp_uint_t offset = MP_OBJ_SMALL_INT_VALUE(v);
+ mp_uint_t val_type = GET_TYPE(offset, VAL_TYPE_BITS);
+ offset &= VALUE_MASK(VAL_TYPE_BITS);
+ if (val_type >= BFUINT8 && val_type <= BFINT32) {
+ offset &= (1 << OFFSET_BITS) - 1;
+ }
+ mp_uint_t s = uctypes_struct_scalar_size(val_type);
+ if (s > *max_field_size) {
+ *max_field_size = s;
+ }
+ if (offset + s > total_size) {
+ total_size = offset + s;
+ }
+ } else {
+ if (!mp_obj_is_type(v, &mp_type_tuple)) {
+ syntax_error();
+ }
+ mp_obj_tuple_t *t = MP_OBJ_TO_PTR(v);
+ mp_int_t offset = MP_OBJ_SMALL_INT_VALUE(t->items[0]);
+ offset &= VALUE_MASK(AGG_TYPE_BITS);
+ mp_uint_t s = uctypes_struct_agg_size(t, layout_type, max_field_size);
+ if (offset + s > total_size) {
+ total_size = offset + s;
+ }
+ }
+ }
+ }
+
+ // Round size up to alignment of biggest field
+ if (layout_type == LAYOUT_NATIVE) {
+ total_size = (total_size + *max_field_size - 1) & ~(*max_field_size - 1);
+ }
+ return total_size;
+}
+
+STATIC mp_obj_t uctypes_struct_sizeof(size_t n_args, const mp_obj_t *args) {
+ mp_obj_t obj_in = args[0];
+ mp_uint_t max_field_size = 0;
+ if (mp_obj_is_type(obj_in, &mp_type_bytearray)) {
+ return mp_obj_len(obj_in);
+ }
+ int layout_type = LAYOUT_NATIVE;
+ // We can apply sizeof either to structure definition (a dict)
+ // or to instantiated structure
+ if (mp_obj_is_type(obj_in, &uctypes_struct_type)) {
+ if (n_args != 1) {
+ mp_raise_TypeError(NULL);
+ }
+ // Extract structure definition
+ mp_obj_uctypes_struct_t *obj = MP_OBJ_TO_PTR(obj_in);
+ obj_in = obj->desc;
+ layout_type = obj->flags;
+ } else {
+ if (n_args == 2) {
+ layout_type = mp_obj_get_int(args[1]);
+ }
+ }
+ mp_uint_t size = uctypes_struct_size(obj_in, layout_type, &max_field_size);
+ return MP_OBJ_NEW_SMALL_INT(size);
+}
+STATIC MP_DEFINE_CONST_FUN_OBJ_VAR_BETWEEN(uctypes_struct_sizeof_obj, 1, 2, uctypes_struct_sizeof);
+
+static inline mp_obj_t get_unaligned(uint val_type, byte *p, int big_endian) {
+ char struct_type = big_endian ? '>' : '<';
+ static const char type2char[16] = "BbHhIiQq------fd";
+ return mp_binary_get_val(struct_type, type2char[val_type], p, &p);
+}
+
+static inline void set_unaligned(uint val_type, byte *p, int big_endian, mp_obj_t val) {
+ char struct_type = big_endian ? '>' : '<';
+ static const char type2char[16] = "BbHhIiQq------fd";
+ mp_binary_set_val(struct_type, type2char[val_type], val, p, &p);
+}
+
+static inline mp_uint_t get_aligned_basic(uint val_type, void *p) {
+ switch (val_type) {
+ case UINT8:
+ return *(uint8_t *)p;
+ case UINT16:
+ return *(uint16_t *)p;
+ case UINT32:
+ return *(uint32_t *)p;
+ }
+ assert(0);
+ return 0;
+}
+
+static inline void set_aligned_basic(uint val_type, void *p, mp_uint_t v) {
+ switch (val_type) {
+ case UINT8:
+ *(uint8_t *)p = (uint8_t)v;
+ return;
+ case UINT16:
+ *(uint16_t *)p = (uint16_t)v;
+ return;
+ case UINT32:
+ *(uint32_t *)p = (uint32_t)v;
+ return;
+ }
+ assert(0);
+}
+
+STATIC mp_obj_t get_aligned(uint val_type, void *p, mp_int_t index) {
+ switch (val_type) {
+ case UINT8:
+ return MP_OBJ_NEW_SMALL_INT(((uint8_t *)p)[index]);
+ case INT8:
+ return MP_OBJ_NEW_SMALL_INT(((int8_t *)p)[index]);
+ case UINT16:
+ return MP_OBJ_NEW_SMALL_INT(((uint16_t *)p)[index]);
+ case INT16:
+ return MP_OBJ_NEW_SMALL_INT(((int16_t *)p)[index]);
+ case UINT32:
+ return mp_obj_new_int_from_uint(((uint32_t *)p)[index]);
+ case INT32:
+ return mp_obj_new_int(((int32_t *)p)[index]);
+ case UINT64:
+ return mp_obj_new_int_from_ull(((uint64_t *)p)[index]);
+ case INT64:
+ return mp_obj_new_int_from_ll(((int64_t *)p)[index]);
+ #if MICROPY_PY_BUILTINS_FLOAT
+ case FLOAT32:
+ return mp_obj_new_float_from_f(((float *)p)[index]);
+ case FLOAT64:
+ return mp_obj_new_float_from_d(((double *)p)[index]);
+ #endif
+ default:
+ assert(0);
+ return MP_OBJ_NULL;
+ }
+}
+
+STATIC void set_aligned(uint val_type, void *p, mp_int_t index, mp_obj_t val) {
+ #if MICROPY_PY_BUILTINS_FLOAT
+ if (val_type == FLOAT32 || val_type == FLOAT64) {
+ if (val_type == FLOAT32) {
+ ((float *)p)[index] = mp_obj_get_float_to_f(val);
+ } else {
+ ((double *)p)[index] = mp_obj_get_float_to_d(val);
+ }
+ return;
+ }
+ #endif
+ mp_int_t v = mp_obj_get_int_truncated(val);
+ switch (val_type) {
+ case UINT8:
+ ((uint8_t *)p)[index] = (uint8_t)v;
+ return;
+ case INT8:
+ ((int8_t *)p)[index] = (int8_t)v;
+ return;
+ case UINT16:
+ ((uint16_t *)p)[index] = (uint16_t)v;
+ return;
+ case INT16:
+ ((int16_t *)p)[index] = (int16_t)v;
+ return;
+ case UINT32:
+ ((uint32_t *)p)[index] = (uint32_t)v;
+ return;
+ case INT32:
+ ((int32_t *)p)[index] = (int32_t)v;
+ return;
+ case INT64:
+ case UINT64:
+ if (sizeof(mp_int_t) == 8) {
+ ((uint64_t *)p)[index] = (uint64_t)v;
+ } else {
+ // TODO: Doesn't offer atomic store semantics, but should at least try
+ set_unaligned(val_type, (void *)&((uint64_t *)p)[index], MP_ENDIANNESS_BIG, val);
+ }
+ return;
+ default:
+ assert(0);
+ }
+}
+
+STATIC mp_obj_t uctypes_struct_attr_op(mp_obj_t self_in, qstr attr, mp_obj_t set_val) {
+ mp_obj_uctypes_struct_t *self = MP_OBJ_TO_PTR(self_in);
+
+ if (!mp_obj_is_dict_or_ordereddict(self->desc)) {
+ mp_raise_TypeError(MP_ERROR_TEXT("struct: no fields"));
+ }
+
+ mp_obj_t deref = mp_obj_dict_get(self->desc, MP_OBJ_NEW_QSTR(attr));
+ if (mp_obj_is_small_int(deref)) {
+ mp_int_t offset = MP_OBJ_SMALL_INT_VALUE(deref);
+ mp_uint_t val_type = GET_TYPE(offset, VAL_TYPE_BITS);
+ offset &= VALUE_MASK(VAL_TYPE_BITS);
+
+ if (val_type <= INT64 || val_type == FLOAT32 || val_type == FLOAT64) {
+ if (self->flags == LAYOUT_NATIVE) {
+ if (set_val == MP_OBJ_NULL) {
+ return get_aligned(val_type, self->addr + offset, 0);
+ } else {
+ set_aligned(val_type, self->addr + offset, 0, set_val);
+ return set_val; // just !MP_OBJ_NULL
+ }
+ } else {
+ if (set_val == MP_OBJ_NULL) {
+ return get_unaligned(val_type, self->addr + offset, self->flags);
+ } else {
+ set_unaligned(val_type, self->addr + offset, self->flags, set_val);
+ return set_val; // just !MP_OBJ_NULL
+ }
+ }
+ } else if (val_type >= BFUINT8 && val_type <= BFINT32) {
+ uint bit_offset = (offset >> OFFSET_BITS) & 31;
+ uint bit_len = (offset >> LEN_BITS) & 31;
+ offset &= (1 << OFFSET_BITS) - 1;
+ mp_uint_t val;
+ if (self->flags == LAYOUT_NATIVE) {
+ val = get_aligned_basic(val_type & 6, self->addr + offset);
+ } else {
+ val = mp_binary_get_int(GET_SCALAR_SIZE(val_type & 7), val_type & 1, self->flags, self->addr + offset);
+ }
+ if (set_val == MP_OBJ_NULL) {
+ val >>= bit_offset;
+ val &= (1 << bit_len) - 1;
+ // TODO: signed
+ assert((val_type & 1) == 0);
+ return mp_obj_new_int(val);
+ } else {
+ mp_uint_t set_val_int = (mp_uint_t)mp_obj_get_int(set_val);
+ mp_uint_t mask = (1 << bit_len) - 1;
+ set_val_int &= mask;
+ set_val_int <<= bit_offset;
+ mask <<= bit_offset;
+ val = (val & ~mask) | set_val_int;
+
+ if (self->flags == LAYOUT_NATIVE) {
+ set_aligned_basic(val_type & 6, self->addr + offset, val);
+ } else {
+ mp_binary_set_int(GET_SCALAR_SIZE(val_type & 7), self->flags == LAYOUT_BIG_ENDIAN,
+ self->addr + offset, val);
+ }
+ return set_val; // just !MP_OBJ_NULL
+ }
+ }
+
+ assert(0);
+ return MP_OBJ_NULL;
+ }
+
+ if (!mp_obj_is_type(deref, &mp_type_tuple)) {
+ syntax_error();
+ }
+
+ if (set_val != MP_OBJ_NULL) {
+ // Cannot assign to aggregate
+ syntax_error();
+ }
+
+ mp_obj_tuple_t *sub = MP_OBJ_TO_PTR(deref);
+ mp_int_t offset = MP_OBJ_SMALL_INT_VALUE(sub->items[0]);
+ mp_uint_t agg_type = GET_TYPE(offset, AGG_TYPE_BITS);
+ offset &= VALUE_MASK(AGG_TYPE_BITS);
+
+ switch (agg_type) {
+ case STRUCT: {
+ mp_obj_uctypes_struct_t *o = m_new_obj(mp_obj_uctypes_struct_t);
+ o->base.type = &uctypes_struct_type;
+ o->desc = sub->items[1];
+ o->addr = self->addr + offset;
+ o->flags = self->flags;
+ return MP_OBJ_FROM_PTR(o);
+ }
+ case ARRAY: {
+ mp_uint_t dummy;
+ if (IS_SCALAR_ARRAY(sub) && IS_SCALAR_ARRAY_OF_BYTES(sub)) {
+ return mp_obj_new_bytearray_by_ref(uctypes_struct_agg_size(sub, self->flags, &dummy), self->addr + offset);
+ }
+ // Fall thru to return uctypes struct object
+ MP_FALLTHROUGH
+ }
+ case PTR: {
+ mp_obj_uctypes_struct_t *o = m_new_obj(mp_obj_uctypes_struct_t);
+ o->base.type = &uctypes_struct_type;
+ o->desc = MP_OBJ_FROM_PTR(sub);
+ o->addr = self->addr + offset;
+ o->flags = self->flags;
+ return MP_OBJ_FROM_PTR(o);
+ }
+ }
+
+ // Should be unreachable once all cases are handled
+ return MP_OBJ_NULL;
+}
+
+STATIC void uctypes_struct_attr(mp_obj_t self_in, qstr attr, mp_obj_t *dest) {
+ if (dest[0] == MP_OBJ_NULL) {
+ // load attribute
+ mp_obj_t val = uctypes_struct_attr_op(self_in, attr, MP_OBJ_NULL);
+ dest[0] = val;
+ } else {
+ // delete/store attribute
+ if (uctypes_struct_attr_op(self_in, attr, dest[1]) != MP_OBJ_NULL) {
+ dest[0] = MP_OBJ_NULL; // indicate success
+ }
+ }
+}
+
+STATIC mp_obj_t uctypes_struct_subscr(mp_obj_t base_in, mp_obj_t index_in, mp_obj_t value) {
+ mp_obj_uctypes_struct_t *self = mp_obj_cast_to_native_base(base_in, &uctypes_struct_type);
+
+ if (value == MP_OBJ_NULL) {
+ // delete
+ return MP_OBJ_NULL; // op not supported
+ } else {
+ // load / store
+ if (!mp_obj_is_type(self->desc, &mp_type_tuple)) {
+ mp_raise_TypeError(MP_ERROR_TEXT("struct: can't index"));
+ }
+
+ mp_obj_tuple_t *t = MP_OBJ_TO_PTR(self->desc);
+ mp_int_t offset = MP_OBJ_SMALL_INT_VALUE(t->items[0]);
+ uint agg_type = GET_TYPE(offset, AGG_TYPE_BITS);
+
+ mp_int_t index = MP_OBJ_SMALL_INT_VALUE(index_in);
+
+ if (agg_type == ARRAY) {
+ mp_int_t arr_sz = MP_OBJ_SMALL_INT_VALUE(t->items[1]);
+ uint val_type = GET_TYPE(arr_sz, VAL_TYPE_BITS);
+ arr_sz &= VALUE_MASK(VAL_TYPE_BITS);
+ if (index >= arr_sz) {
+ mp_raise_msg(&mp_type_IndexError, MP_ERROR_TEXT("struct: index out of range"));
+ }
+
+ if (t->len == 2) {
+ // array of scalars
+ if (self->flags == LAYOUT_NATIVE) {
+ if (value == MP_OBJ_SENTINEL) {
+ return get_aligned(val_type, self->addr, index);
+ } else {
+ set_aligned(val_type, self->addr, index, value);
+ return value; // just !MP_OBJ_NULL
+ }
+ } else {
+ byte *p = self->addr + uctypes_struct_scalar_size(val_type) * index;
+ if (value == MP_OBJ_SENTINEL) {
+ return get_unaligned(val_type, p, self->flags);
+ } else {
+ set_unaligned(val_type, p, self->flags, value);
+ return value; // just !MP_OBJ_NULL
+ }
+ }
+ } else if (value == MP_OBJ_SENTINEL) {
+ mp_uint_t dummy = 0;
+ mp_uint_t size = uctypes_struct_size(t->items[2], self->flags, &dummy);
+ mp_obj_uctypes_struct_t *o = m_new_obj(mp_obj_uctypes_struct_t);
+ o->base.type = &uctypes_struct_type;
+ o->desc = t->items[2];
+ o->addr = self->addr + size * index;
+ o->flags = self->flags;
+ return MP_OBJ_FROM_PTR(o);
+ } else {
+ return MP_OBJ_NULL; // op not supported
+ }
+
+ } else if (agg_type == PTR) {
+ byte *p = *(void **)self->addr;
+ if (mp_obj_is_small_int(t->items[1])) {
+ uint val_type = GET_TYPE(MP_OBJ_SMALL_INT_VALUE(t->items[1]), VAL_TYPE_BITS);
+ return get_aligned(val_type, p, index);
+ } else {
+ mp_uint_t dummy = 0;
+ mp_uint_t size = uctypes_struct_size(t->items[1], self->flags, &dummy);
+ mp_obj_uctypes_struct_t *o = m_new_obj(mp_obj_uctypes_struct_t);
+ o->base.type = &uctypes_struct_type;
+ o->desc = t->items[1];
+ o->addr = p + size * index;
+ o->flags = self->flags;
+ return MP_OBJ_FROM_PTR(o);
+ }
+ }
+
+ assert(0);
+ return MP_OBJ_NULL;
+ }
+}
+
+STATIC mp_obj_t uctypes_struct_unary_op(mp_unary_op_t op, mp_obj_t self_in) {
+ mp_obj_uctypes_struct_t *self = MP_OBJ_TO_PTR(self_in);
+ switch (op) {
+ case MP_UNARY_OP_INT:
+ if (mp_obj_is_type(self->desc, &mp_type_tuple)) {
+ mp_obj_tuple_t *t = MP_OBJ_TO_PTR(self->desc);
+ mp_int_t offset = MP_OBJ_SMALL_INT_VALUE(t->items[0]);
+ uint agg_type = GET_TYPE(offset, AGG_TYPE_BITS);
+ if (agg_type == PTR) {
+ byte *p = *(void **)self->addr;
+ return mp_obj_new_int((mp_int_t)(uintptr_t)p);
+ }
+ }
+ MP_FALLTHROUGH
+
+ default:
+ return MP_OBJ_NULL; // op not supported
+ }
+}
+
+STATIC mp_int_t uctypes_get_buffer(mp_obj_t self_in, mp_buffer_info_t *bufinfo, mp_uint_t flags) {
+ (void)flags;
+ mp_obj_uctypes_struct_t *self = MP_OBJ_TO_PTR(self_in);
+ mp_uint_t max_field_size = 0;
+ mp_uint_t size = uctypes_struct_size(self->desc, self->flags, &max_field_size);
+
+ bufinfo->buf = self->addr;
+ bufinfo->len = size;
+ bufinfo->typecode = BYTEARRAY_TYPECODE;
+ return 0;
+}
+
+// addressof()
+// Return address of object's data (applies to objects providing the buffer interface).
+STATIC mp_obj_t uctypes_struct_addressof(mp_obj_t buf) {
+ mp_buffer_info_t bufinfo;
+ mp_get_buffer_raise(buf, &bufinfo, MP_BUFFER_READ);
+ return mp_obj_new_int((mp_int_t)(uintptr_t)bufinfo.buf);
+}
+MP_DEFINE_CONST_FUN_OBJ_1(uctypes_struct_addressof_obj, uctypes_struct_addressof);
+
+// bytearray_at()
+// Capture memory at given address of given size as bytearray.
+STATIC mp_obj_t uctypes_struct_bytearray_at(mp_obj_t ptr, mp_obj_t size) {
+ return mp_obj_new_bytearray_by_ref(mp_obj_int_get_truncated(size), (void *)(uintptr_t)mp_obj_int_get_truncated(ptr));
+}
+MP_DEFINE_CONST_FUN_OBJ_2(uctypes_struct_bytearray_at_obj, uctypes_struct_bytearray_at);
+
+// bytes_at()
+// Capture memory at given address of given size as bytes.
+STATIC mp_obj_t uctypes_struct_bytes_at(mp_obj_t ptr, mp_obj_t size) {
+ return mp_obj_new_bytes((void *)(uintptr_t)mp_obj_int_get_truncated(ptr), mp_obj_int_get_truncated(size));
+}
+MP_DEFINE_CONST_FUN_OBJ_2(uctypes_struct_bytes_at_obj, uctypes_struct_bytes_at);
+
+STATIC const mp_obj_type_t uctypes_struct_type = {
+ { &mp_type_type },
+ .flags = MP_TYPE_FLAG_EXTENDED,
+ .name = MP_QSTR_struct,
+ .print = uctypes_struct_print,
+ .make_new = uctypes_struct_make_new,
+ .attr = uctypes_struct_attr,
+ MP_TYPE_EXTENDED_FIELDS(
+ .subscr = uctypes_struct_subscr,
+ .unary_op = uctypes_struct_unary_op,
+ .buffer_p = { .get_buffer = uctypes_get_buffer },
+ ),
+};
+
+STATIC const mp_rom_map_elem_t mp_module_uctypes_globals_table[] = {
+ { MP_ROM_QSTR(MP_QSTR___name__), MP_ROM_QSTR(MP_QSTR_uctypes) },
+ { MP_ROM_QSTR(MP_QSTR_struct), MP_ROM_PTR(&uctypes_struct_type) },
+ { MP_ROM_QSTR(MP_QSTR_sizeof), MP_ROM_PTR(&uctypes_struct_sizeof_obj) },
+ { MP_ROM_QSTR(MP_QSTR_addressof), MP_ROM_PTR(&uctypes_struct_addressof_obj) },
+ { MP_ROM_QSTR(MP_QSTR_bytes_at), MP_ROM_PTR(&uctypes_struct_bytes_at_obj) },
+ { MP_ROM_QSTR(MP_QSTR_bytearray_at), MP_ROM_PTR(&uctypes_struct_bytearray_at_obj) },
+
+ { MP_ROM_QSTR(MP_QSTR_NATIVE), MP_ROM_INT(LAYOUT_NATIVE) },
+ { MP_ROM_QSTR(MP_QSTR_LITTLE_ENDIAN), MP_ROM_INT(LAYOUT_LITTLE_ENDIAN) },
+ { MP_ROM_QSTR(MP_QSTR_BIG_ENDIAN), MP_ROM_INT(LAYOUT_BIG_ENDIAN) },
+
+ { MP_ROM_QSTR(MP_QSTR_VOID), MP_ROM_INT(TYPE2SMALLINT(UINT8, VAL_TYPE_BITS)) },
+
+ { MP_ROM_QSTR(MP_QSTR_UINT8), MP_ROM_INT(TYPE2SMALLINT(UINT8, VAL_TYPE_BITS)) },
+ { MP_ROM_QSTR(MP_QSTR_INT8), MP_ROM_INT(TYPE2SMALLINT(INT8, VAL_TYPE_BITS)) },
+ { MP_ROM_QSTR(MP_QSTR_UINT16), MP_ROM_INT(TYPE2SMALLINT(UINT16, VAL_TYPE_BITS)) },
+ { MP_ROM_QSTR(MP_QSTR_INT16), MP_ROM_INT(TYPE2SMALLINT(INT16, VAL_TYPE_BITS)) },
+ { MP_ROM_QSTR(MP_QSTR_UINT32), MP_ROM_INT(TYPE2SMALLINT(UINT32, VAL_TYPE_BITS)) },
+ { MP_ROM_QSTR(MP_QSTR_INT32), MP_ROM_INT(TYPE2SMALLINT(INT32, VAL_TYPE_BITS)) },
+ { MP_ROM_QSTR(MP_QSTR_UINT64), MP_ROM_INT(TYPE2SMALLINT(UINT64, VAL_TYPE_BITS)) },
+ { MP_ROM_QSTR(MP_QSTR_INT64), MP_ROM_INT(TYPE2SMALLINT(INT64, VAL_TYPE_BITS)) },
+
+ { MP_ROM_QSTR(MP_QSTR_BFUINT8), MP_ROM_INT(TYPE2SMALLINT(BFUINT8, VAL_TYPE_BITS)) },
+ { MP_ROM_QSTR(MP_QSTR_BFINT8), MP_ROM_INT(TYPE2SMALLINT(BFINT8, VAL_TYPE_BITS)) },
+ { MP_ROM_QSTR(MP_QSTR_BFUINT16), MP_ROM_INT(TYPE2SMALLINT(BFUINT16, VAL_TYPE_BITS)) },
+ { MP_ROM_QSTR(MP_QSTR_BFINT16), MP_ROM_INT(TYPE2SMALLINT(BFINT16, VAL_TYPE_BITS)) },
+ { MP_ROM_QSTR(MP_QSTR_BFUINT32), MP_ROM_INT(TYPE2SMALLINT(BFUINT32, VAL_TYPE_BITS)) },
+ { MP_ROM_QSTR(MP_QSTR_BFINT32), MP_ROM_INT(TYPE2SMALLINT(BFINT32, VAL_TYPE_BITS)) },
+
+ { MP_ROM_QSTR(MP_QSTR_BF_POS), MP_ROM_INT(OFFSET_BITS) },
+ { MP_ROM_QSTR(MP_QSTR_BF_LEN), MP_ROM_INT(LEN_BITS) },
+
+ #if MICROPY_PY_BUILTINS_FLOAT
+ { MP_ROM_QSTR(MP_QSTR_FLOAT32), MP_ROM_INT(TYPE2SMALLINT(FLOAT32, VAL_TYPE_BITS)) },
+ { MP_ROM_QSTR(MP_QSTR_FLOAT64), MP_ROM_INT(TYPE2SMALLINT(FLOAT64, VAL_TYPE_BITS)) },
+ #endif
+
+ #if MICROPY_PY_UCTYPES_NATIVE_C_TYPES
+ // C native type aliases. These depend on GCC-compatible predefined
+ // preprocessor macros.
+ #if __SIZEOF_SHORT__ == 2
+ { MP_ROM_QSTR(MP_QSTR_SHORT), MP_ROM_INT(TYPE2SMALLINT(INT16, VAL_TYPE_BITS)) },
+ { MP_ROM_QSTR(MP_QSTR_USHORT), MP_ROM_INT(TYPE2SMALLINT(UINT16, VAL_TYPE_BITS)) },
+ #endif
+ #if __SIZEOF_INT__ == 4
+ { MP_ROM_QSTR(MP_QSTR_INT), MP_ROM_INT(TYPE2SMALLINT(INT32, VAL_TYPE_BITS)) },
+ { MP_ROM_QSTR(MP_QSTR_UINT), MP_ROM_INT(TYPE2SMALLINT(UINT32, VAL_TYPE_BITS)) },
+ #endif
+ #if __SIZEOF_LONG__ == 4
+ { MP_ROM_QSTR(MP_QSTR_LONG), MP_ROM_INT(TYPE2SMALLINT(INT32, VAL_TYPE_BITS)) },
+ { MP_ROM_QSTR(MP_QSTR_ULONG), MP_ROM_INT(TYPE2SMALLINT(UINT32, VAL_TYPE_BITS)) },
+ #elif __SIZEOF_LONG__ == 8
+ { MP_ROM_QSTR(MP_QSTR_LONG), MP_ROM_INT(TYPE2SMALLINT(INT64, VAL_TYPE_BITS)) },
+ { MP_ROM_QSTR(MP_QSTR_ULONG), MP_ROM_INT(TYPE2SMALLINT(UINT64, VAL_TYPE_BITS)) },
+ #endif
+ #if __SIZEOF_LONG_LONG__ == 8
+ { MP_ROM_QSTR(MP_QSTR_LONGLONG), MP_ROM_INT(TYPE2SMALLINT(INT64, VAL_TYPE_BITS)) },
+ { MP_ROM_QSTR(MP_QSTR_ULONGLONG), MP_ROM_INT(TYPE2SMALLINT(UINT64, VAL_TYPE_BITS)) },
+ #endif
+ #endif // MICROPY_PY_UCTYPES_NATIVE_C_TYPES
+
+ { MP_ROM_QSTR(MP_QSTR_PTR), MP_ROM_INT(TYPE2SMALLINT(PTR, AGG_TYPE_BITS)) },
+ { MP_ROM_QSTR(MP_QSTR_ARRAY), MP_ROM_INT(TYPE2SMALLINT(ARRAY, AGG_TYPE_BITS)) },
+};
+STATIC MP_DEFINE_CONST_DICT(mp_module_uctypes_globals, mp_module_uctypes_globals_table);
+
+const mp_obj_module_t mp_module_uctypes = {
+ .base = { &mp_type_module },
+ .globals = (mp_obj_dict_t *)&mp_module_uctypes_globals,
+};
+
+#endif