+enum tracer_display_base {
+ TRACER_DISPLAY_BASE_2,
+ TRACER_DISPLAY_BASE_8,
+ TRACER_DISPLAY_BASE_10,
+ TRACER_DISPLAY_BASE_16,
+};
+
+union int64_value {
+ uint64_t u;
+ int64_t s;
+};
+
+static struct side_tracer_handle *tracer_handle;
+
+static
+void tracer_print_struct(const struct side_type *type_desc, const struct side_arg_vec *side_arg_vec);
+static
+void tracer_print_variant(const struct side_type *type_desc, const struct side_arg_variant *side_arg_variant);
+static
+void tracer_print_array(const struct side_type *type_desc, const struct side_arg_vec *side_arg_vec);
+static
+void tracer_print_vla(const struct side_type *type_desc, const struct side_arg_vec *side_arg_vec);
+static
+void tracer_print_vla_visitor(const struct side_type *type_desc, void *app_ctx);
+static
+void tracer_print_dynamic(const struct side_arg *dynamic_item);
+static
+uint32_t tracer_print_gather_bool_type(const struct side_type_gather *type_gather, const void *_ptr);
+static
+uint32_t tracer_print_gather_byte_type(const struct side_type_gather *type_gather, const void *_ptr);
+static
+uint32_t tracer_print_gather_integer_type(const struct side_type_gather *type_gather, const void *_ptr,
+ enum tracer_display_base default_base);
+static
+uint32_t tracer_print_gather_float_type(const struct side_type_gather *type_gather, const void *_ptr);
+static
+uint32_t tracer_print_gather_string_type(const struct side_type_gather *type_gather, const void *_ptr);
+static
+uint32_t tracer_print_gather_enum_type(const struct side_type_gather *type_gather, const void *_ptr);
+static
+uint32_t tracer_print_gather_struct(const struct side_type_gather *type_gather, const void *_ptr);
+static
+uint32_t tracer_print_gather_array(const struct side_type_gather *type_gather, const void *_ptr);
+static
+uint32_t tracer_print_gather_vla(const struct side_type_gather *type_gather, const void *_ptr,
+ const void *_length_ptr);
+static
+void tracer_print_type(const struct side_type *type_desc, const struct side_arg *item);
+
+static
+void tracer_convert_string_to_utf8(const void *p, uint8_t unit_size, enum side_type_label_byte_order byte_order,
+ size_t *strlen_with_null,
+ char **output_str)
+{
+ size_t ret, inbytesleft = 0, outbytesleft, bufsize;
+ const char *str = p, *fromcode;
+ char *inbuf = (char *) p, *outbuf, *buf;
+ iconv_t cd;
+
+ switch (unit_size) {
+ case 1:
+ if (strlen_with_null)
+ *strlen_with_null = strlen(str) + 1;
+ *output_str = (char *) str;
+ return;
+ case 2:
+ {
+ const uint16_t *p16 = p;
+
+ switch (byte_order) {
+ case SIDE_TYPE_BYTE_ORDER_LE:
+ {
+ fromcode = "UTF-16LE";
+ break;
+ }
+ case SIDE_TYPE_BYTE_ORDER_BE:
+ {
+ fromcode = "UTF-16BE";
+ break;
+ }
+ default:
+ fprintf(stderr, "Unknown byte order\n");
+ abort();
+ }
+ for (; *p16; p16++)
+ inbytesleft += 2;
+ /*
+ * Worse case is U+FFFF UTF-16 (2 bytes) converting to
+ * { ef, bf, bf } UTF-8 (3 bytes).
+ */
+ bufsize = inbytesleft / 2 * 3 + 1;
+ break;
+ }
+ case 4:
+ {
+ const uint32_t *p32 = p;
+
+ switch (byte_order) {
+ case SIDE_TYPE_BYTE_ORDER_LE:
+ {
+ fromcode = "UTF-32LE";
+ break;
+ }
+ case SIDE_TYPE_BYTE_ORDER_BE:
+ {
+ fromcode = "UTF-32BE";
+ break;
+ }
+ default:
+ fprintf(stderr, "Unknown byte order\n");
+ abort();
+ }
+ for (; *p32; p32++)
+ inbytesleft += 4;
+ /*
+ * Each 4-byte UTF-32 character converts to at most a
+ * 4-byte UTF-8 character.
+ */
+ bufsize = inbytesleft + 1;
+ break;
+ }
+ default:
+ fprintf(stderr, "Unknown string unit size %" PRIu8 "\n", unit_size);
+ abort();
+ }
+
+ cd = iconv_open("UTF8", fromcode);
+ if (cd == (iconv_t) -1) {
+ perror("iconv_open");
+ abort();
+ }
+ buf = malloc(bufsize);
+ if (!buf) {
+ abort();
+ }
+ outbuf = (char *) buf;
+ outbytesleft = bufsize;
+ ret = iconv(cd, &inbuf, &inbytesleft, &outbuf, &outbytesleft);
+ if (ret == (size_t) -1) {
+ perror("iconv");
+ abort();
+ }
+ if (inbytesleft) {
+ fprintf(stderr, "Buffer too small to convert string input\n");
+ abort();
+ }
+ (*outbuf++) = '\0';
+ if (iconv_close(cd) == -1) {
+ perror("iconv_close");
+ abort();
+ }
+ if (strlen_with_null)
+ *strlen_with_null = outbuf - buf;
+ *output_str = buf;
+}
+
+static
+void tracer_print_string(const void *p, uint8_t unit_size, enum side_type_label_byte_order byte_order,
+ size_t *strlen_with_null)
+{
+ char *output_str = NULL;
+
+ tracer_convert_string_to_utf8(p, unit_size, byte_order, strlen_with_null, &output_str);
+ printf("\"%s\"", output_str);
+ if (output_str != p)
+ free(output_str);
+}
+
+static
+int64_t get_attr_integer_value(const struct side_attr *attr)
+{
+ int64_t val;
+
+ switch (attr->value.type) {
+ case SIDE_ATTR_TYPE_U8:
+ val = attr->value.u.integer_value.side_u8;
+ break;
+ case SIDE_ATTR_TYPE_U16:
+ val = attr->value.u.integer_value.side_u16;
+ break;
+ case SIDE_ATTR_TYPE_U32:
+ val = attr->value.u.integer_value.side_u32;
+ break;
+ case SIDE_ATTR_TYPE_U64:
+ val = attr->value.u.integer_value.side_u64;
+ break;
+ case SIDE_ATTR_TYPE_S8:
+ val = attr->value.u.integer_value.side_s8;
+ break;
+ case SIDE_ATTR_TYPE_S16:
+ val = attr->value.u.integer_value.side_s16;
+ break;
+ case SIDE_ATTR_TYPE_S32:
+ val = attr->value.u.integer_value.side_s32;
+ break;
+ case SIDE_ATTR_TYPE_S64:
+ val = attr->value.u.integer_value.side_s64;
+ break;
+ default:
+ fprintf(stderr, "Unexpected attribute type\n");
+ abort();
+ }
+ return val;
+}
+
+static
+enum tracer_display_base get_attr_display_base(const struct side_attr *_attr, uint32_t nr_attr,
+ enum tracer_display_base default_base)
+{
+ uint32_t i;
+
+ for (i = 0; i < nr_attr; i++) {
+ const struct side_attr *attr = &_attr[i];
+ char *utf8_str = NULL;
+ bool cmp;
+
+ tracer_convert_string_to_utf8(side_ptr_get(attr->key.p), attr->key.unit_size,
+ attr->key.byte_order, NULL, &utf8_str);
+ cmp = strcmp(utf8_str, "std.integer.base");
+ if (utf8_str != side_ptr_get(attr->key.p))
+ free(utf8_str);
+ if (!cmp) {
+ int64_t val = get_attr_integer_value(attr);
+
+ switch (val) {
+ case 2:
+ return TRACER_DISPLAY_BASE_2;
+ case 8:
+ return TRACER_DISPLAY_BASE_8;
+ case 10:
+ return TRACER_DISPLAY_BASE_10;
+ case 16:
+ return TRACER_DISPLAY_BASE_16;
+ default:
+ fprintf(stderr, "Unexpected integer display base: %" PRId64 "\n", val);
+ abort();
+ }
+ }
+ }
+ return default_base; /* Default */
+}
+
+static
+void tracer_print_attr_type(const char *separator, const struct side_attr *attr)
+{
+ char *utf8_str = NULL;
+
+ tracer_convert_string_to_utf8(side_ptr_get(attr->key.p), attr->key.unit_size,
+ attr->key.byte_order, NULL, &utf8_str);
+ printf("{ key%s \"%s\", value%s ", separator, utf8_str, separator);
+ if (utf8_str != side_ptr_get(attr->key.p))
+ free(utf8_str);
+ switch (attr->value.type) {
+ case SIDE_ATTR_TYPE_BOOL:
+ printf("%s", attr->value.u.bool_value ? "true" : "false");
+ break;
+ case SIDE_ATTR_TYPE_U8:
+ printf("%" PRIu8, attr->value.u.integer_value.side_u8);
+ break;
+ case SIDE_ATTR_TYPE_U16:
+ printf("%" PRIu16, attr->value.u.integer_value.side_u16);
+ break;
+ case SIDE_ATTR_TYPE_U32:
+ printf("%" PRIu32, attr->value.u.integer_value.side_u32);
+ break;
+ case SIDE_ATTR_TYPE_U64:
+ printf("%" PRIu64, attr->value.u.integer_value.side_u64);
+ break;
+ case SIDE_ATTR_TYPE_S8:
+ printf("%" PRId8, attr->value.u.integer_value.side_s8);
+ break;
+ case SIDE_ATTR_TYPE_S16:
+ printf("%" PRId16, attr->value.u.integer_value.side_s16);
+ break;
+ case SIDE_ATTR_TYPE_S32:
+ printf("%" PRId32, attr->value.u.integer_value.side_s32);
+ break;
+ case SIDE_ATTR_TYPE_S64:
+ printf("%" PRId64, attr->value.u.integer_value.side_s64);
+ break;
+ case SIDE_ATTR_TYPE_FLOAT_BINARY16:
+#if __HAVE_FLOAT16
+ printf("%g", (double) attr->value.u.float_value.side_float_binary16);
+ break;
+#else
+ fprintf(stderr, "ERROR: Unsupported binary16 float type\n");
+ abort();
+#endif
+ case SIDE_ATTR_TYPE_FLOAT_BINARY32:
+#if __HAVE_FLOAT32
+ printf("%g", (double) attr->value.u.float_value.side_float_binary32);
+ break;
+#else
+ fprintf(stderr, "ERROR: Unsupported binary32 float type\n");
+ abort();
+#endif
+ case SIDE_ATTR_TYPE_FLOAT_BINARY64:
+#if __HAVE_FLOAT64
+ printf("%g", (double) attr->value.u.float_value.side_float_binary64);
+ break;
+#else
+ fprintf(stderr, "ERROR: Unsupported binary64 float type\n");
+ abort();
+#endif
+ case SIDE_ATTR_TYPE_FLOAT_BINARY128:
+#if __HAVE_FLOAT128
+ printf("%Lg", (long double) attr->value.u.float_value.side_float_binary128);
+ break;
+#else
+ fprintf(stderr, "ERROR: Unsupported binary128 float type\n");
+ abort();
+#endif
+ case SIDE_ATTR_TYPE_STRING:
+ tracer_print_string(side_ptr_get(attr->value.u.string_value.p),
+ attr->value.u.string_value.unit_size,
+ attr->value.u.string_value.byte_order, NULL);
+ break;
+ default:
+ fprintf(stderr, "ERROR: <UNKNOWN ATTRIBUTE TYPE>");
+ abort();
+ }
+ printf(" }");
+}
+
+static
+void print_attributes(const char *prefix_str, const char *separator,
+ const struct side_attr *attr, uint32_t nr_attr)
+{
+ uint32_t i;
+
+ if (!nr_attr)
+ return;
+ printf("%s%s [ ", prefix_str, separator);
+ for (i = 0; i < nr_attr; i++) {
+ printf("%s", i ? ", " : "");
+ tracer_print_attr_type(separator, &attr[i]);
+ }
+ printf(" ]");
+}
+
+static
+union int64_value tracer_load_integer_value(const struct side_type_integer *type_integer,
+ const union side_integer_value *value,
+ uint16_t offset_bits, uint16_t *_len_bits)
+{
+ union int64_value v64;
+ uint16_t len_bits;
+ bool reverse_bo;
+
+ if (!type_integer->len_bits)
+ len_bits = type_integer->integer_size * CHAR_BIT;
+ else
+ len_bits = type_integer->len_bits;
+ if (len_bits + offset_bits > type_integer->integer_size * CHAR_BIT)
+ abort();
+ reverse_bo = type_integer->byte_order != SIDE_TYPE_BYTE_ORDER_HOST;
+ switch (type_integer->integer_size) {
+ case 1:
+ if (type_integer->signedness)
+ v64.s = value->side_s8;
+ else
+ v64.u = value->side_u8;
+ break;
+ case 2:
+ if (type_integer->signedness) {
+ int16_t side_s16;
+
+ side_s16 = value->side_s16;
+ if (reverse_bo)
+ side_s16 = side_bswap_16(side_s16);
+ v64.s = side_s16;
+ } else {
+ uint16_t side_u16;
+
+ side_u16 = value->side_u16;
+ if (reverse_bo)
+ side_u16 = side_bswap_16(side_u16);
+ v64.u = side_u16;
+ }
+ break;
+ case 4:
+ if (type_integer->signedness) {
+ int32_t side_s32;
+
+ side_s32 = value->side_s32;
+ if (reverse_bo)
+ side_s32 = side_bswap_32(side_s32);
+ v64.s = side_s32;
+ } else {
+ uint32_t side_u32;
+
+ side_u32 = value->side_u32;
+ if (reverse_bo)
+ side_u32 = side_bswap_32(side_u32);
+ v64.u = side_u32;
+ }
+ break;
+ case 8:
+ if (type_integer->signedness) {
+ int64_t side_s64;
+
+ side_s64 = value->side_s64;
+ if (reverse_bo)
+ side_s64 = side_bswap_64(side_s64);
+ v64.s = side_s64;
+ } else {
+ uint64_t side_u64;
+
+ side_u64 = value->side_u64;
+ if (reverse_bo)
+ side_u64 = side_bswap_64(side_u64);
+ v64.u = side_u64;
+ }
+ break;
+ default:
+ abort();
+ }
+ v64.u >>= offset_bits;
+ if (len_bits < 64) {
+ v64.u &= (1ULL << len_bits) - 1;
+ if (type_integer->signedness) {
+ /* Sign-extend. */
+ if (v64.u & (1ULL << (len_bits - 1)))
+ v64.u |= ~((1ULL << len_bits) - 1);
+ }
+ }
+ if (_len_bits)
+ *_len_bits = len_bits;
+ return v64;
+}
+
+static
+void print_enum_labels(const struct side_enum_mappings *mappings, union int64_value v64)
+{
+ uint32_t i, print_count = 0;
+
+ printf(", labels: [ ");
+ for (i = 0; i < mappings->nr_mappings; i++) {
+ const struct side_enum_mapping *mapping = &mappings->mappings[i];
+
+ if (mapping->range_end < mapping->range_begin) {
+ fprintf(stderr, "ERROR: Unexpected enum range: %" PRIu64 "-%" PRIu64 "\n",
+ mapping->range_begin, mapping->range_end);
+ abort();
+ }
+ if (v64.s >= mapping->range_begin && v64.s <= mapping->range_end) {
+ printf("%s", print_count++ ? ", " : "");
+ tracer_print_string(side_ptr_get(mapping->label.p), mapping->label.unit_size, mapping->label.byte_order, NULL);
+ }
+ }
+ if (!print_count)
+ printf("<NO LABEL>");
+ printf(" ]");
+}
+
+static
+void tracer_print_enum(const struct side_type *type_desc, const struct side_arg *item)
+{
+ const struct side_enum_mappings *mappings = type_desc->u.side_enum.mappings;
+ const struct side_type *elem_type = type_desc->u.side_enum.elem_type;
+ union int64_value v64;
+
+ if (elem_type->type != item->type) {
+ fprintf(stderr, "ERROR: Unexpected enum element type\n");
+ abort();
+ }
+ v64 = tracer_load_integer_value(&elem_type->u.side_integer,
+ &item->u.side_static.integer_value, 0, NULL);
+ print_attributes("attr", ":", mappings->attr, mappings->nr_attr);
+ printf("%s", mappings->nr_attr ? ", " : "");
+ tracer_print_type(elem_type, item);
+ print_enum_labels(mappings, v64);
+}
+
+static
+uint32_t elem_type_to_stride(const struct side_type *elem_type)
+{
+ uint32_t stride_bit;
+
+ switch (elem_type->type) {
+ case SIDE_TYPE_BYTE:
+ stride_bit = 8;
+ break;
+
+ case SIDE_TYPE_U8:
+ case SIDE_TYPE_U16:
+ case SIDE_TYPE_U32:
+ case SIDE_TYPE_U64:
+ case SIDE_TYPE_S8:
+ case SIDE_TYPE_S16:
+ case SIDE_TYPE_S32:
+ case SIDE_TYPE_S64:
+ return elem_type->u.side_integer.integer_size * CHAR_BIT;
+ default:
+ fprintf(stderr, "ERROR: Unexpected enum bitmap element type\n");
+ abort();
+ }
+ return stride_bit;
+}
+
+static
+void tracer_print_enum_bitmap(const struct side_type *type_desc,
+ const struct side_arg *item)
+{
+ const struct side_enum_bitmap_mappings *side_enum_mappings = type_desc->u.side_enum_bitmap.mappings;
+ const struct side_type *enum_elem_type = type_desc->u.side_enum_bitmap.elem_type, *elem_type;
+ uint32_t i, print_count = 0, stride_bit, nr_items;
+ const struct side_arg *array_item;
+
+ switch (enum_elem_type->type) {
+ case SIDE_TYPE_U8: /* Fall-through */
+ case SIDE_TYPE_BYTE: /* Fall-through */
+ case SIDE_TYPE_U16: /* Fall-through */
+ case SIDE_TYPE_U32: /* Fall-through */
+ case SIDE_TYPE_U64: /* Fall-through */
+ case SIDE_TYPE_S8: /* Fall-through */
+ case SIDE_TYPE_S16: /* Fall-through */
+ case SIDE_TYPE_S32: /* Fall-through */
+ case SIDE_TYPE_S64:
+ elem_type = enum_elem_type;
+ array_item = item;
+ nr_items = 1;
+ break;
+ case SIDE_TYPE_ARRAY:
+ elem_type = enum_elem_type->u.side_array.elem_type;
+ array_item = item->u.side_static.side_array->sav;
+ nr_items = type_desc->u.side_array.length;
+ break;
+ case SIDE_TYPE_VLA:
+ elem_type = enum_elem_type->u.side_vla.elem_type;
+ array_item = item->u.side_static.side_vla->sav;
+ nr_items = item->u.side_static.side_vla->len;
+ break;
+ default:
+ fprintf(stderr, "ERROR: Unexpected enum element type\n");
+ abort();
+ }
+ stride_bit = elem_type_to_stride(elem_type);
+
+ print_attributes("attr", ":", side_enum_mappings->attr, side_enum_mappings->nr_attr);
+ printf("%s", side_enum_mappings->nr_attr ? ", " : "");
+ printf("labels: [ ");
+ for (i = 0; i < side_enum_mappings->nr_mappings; i++) {
+ const struct side_enum_bitmap_mapping *mapping = &side_enum_mappings->mappings[i];
+ bool match = false;
+ uint64_t bit;
+
+ if (mapping->range_end < mapping->range_begin) {
+ fprintf(stderr, "ERROR: Unexpected enum bitmap range: %" PRIu64 "-%" PRIu64 "\n",
+ mapping->range_begin, mapping->range_end);
+ abort();
+ }
+ for (bit = mapping->range_begin; bit <= mapping->range_end; bit++) {
+ if (bit > (nr_items * stride_bit) - 1)
+ break;
+ if (elem_type->type == SIDE_TYPE_BYTE) {
+ uint8_t v = array_item[bit / 8].u.side_static.byte_value;
+ if (v & (1ULL << (bit % 8))) {
+ match = true;
+ goto match;
+ }
+ } else {
+ union int64_value v64;
+
+ v64 = tracer_load_integer_value(&elem_type->u.side_integer,
+ &array_item[bit / stride_bit].u.side_static.integer_value,
+ 0, NULL);
+ if (v64.u & (1ULL << (bit % stride_bit))) {
+ match = true;
+ goto match;
+ }
+ }
+ }
+match:
+ if (match) {
+ printf("%s", print_count++ ? ", " : "");
+ tracer_print_string(side_ptr_get(mapping->label.p), mapping->label.unit_size, mapping->label.byte_order, NULL);
+ }
+ }
+ if (!print_count)
+ printf("<NO LABEL>");
+ printf(" ]");
+}
+
+static
+void print_integer_binary(uint64_t v, int bits)
+{
+ int i;
+
+ printf("0b");
+ v <<= 64 - bits;
+ for (i = 0; i < bits; i++) {
+ printf("%c", v & (1ULL << 63) ? '1' : '0');
+ v <<= 1;
+ }
+}
+
+static
+void tracer_print_type_header(const char *separator,
+ const struct side_attr *attr, uint32_t nr_attr)
+{
+ print_attributes("attr", separator, attr, nr_attr);
+ printf("%s", nr_attr ? ", " : "");
+ printf("value%s ", separator);
+}
+
+static
+void tracer_print_type_bool(const char *separator,
+ const struct side_type_bool *type_bool,
+ const union side_bool_value *value,
+ uint16_t offset_bits)
+{
+ uint32_t len_bits;
+ bool reverse_bo;
+ uint64_t v;
+
+ if (!type_bool->len_bits)
+ len_bits = type_bool->bool_size * CHAR_BIT;
+ else
+ len_bits = type_bool->len_bits;
+ if (len_bits + offset_bits > type_bool->bool_size * CHAR_BIT)
+ abort();
+ reverse_bo = type_bool->byte_order != SIDE_TYPE_BYTE_ORDER_HOST;
+ switch (type_bool->bool_size) {
+ case 1:
+ v = value->side_bool8;
+ break;
+ case 2:
+ {
+ uint16_t side_u16;
+
+ side_u16 = value->side_bool16;
+ if (reverse_bo)
+ side_u16 = side_bswap_16(side_u16);
+ v = side_u16;
+ break;
+ }
+ case 4:
+ {
+ uint32_t side_u32;
+
+ side_u32 = value->side_bool32;
+ if (reverse_bo)
+ side_u32 = side_bswap_32(side_u32);
+ v = side_u32;
+ break;
+ }
+ case 8:
+ {
+ uint64_t side_u64;
+
+ side_u64 = value->side_bool64;
+ if (reverse_bo)
+ side_u64 = side_bswap_64(side_u64);
+ v = side_u64;
+ break;
+ }
+ default:
+ abort();
+ }
+ v >>= offset_bits;
+ if (len_bits < 64)
+ v &= (1ULL << len_bits) - 1;
+ tracer_print_type_header(separator, type_bool->attr, type_bool->nr_attr);
+ printf("%s", v ? "true" : "false");
+}
+
+static
+void tracer_print_type_integer(const char *separator,
+ const struct side_type_integer *type_integer,
+ const union side_integer_value *value,
+ uint16_t offset_bits,
+ enum tracer_display_base default_base)
+{
+ enum tracer_display_base base;
+ union int64_value v64;
+ uint16_t len_bits;
+
+ v64 = tracer_load_integer_value(type_integer, value, offset_bits, &len_bits);
+ tracer_print_type_header(separator, type_integer->attr, type_integer->nr_attr);
+ base = get_attr_display_base(type_integer->attr, type_integer->nr_attr, default_base);
+ switch (base) {
+ case TRACER_DISPLAY_BASE_2:
+ print_integer_binary(v64.u, len_bits);
+ break;
+ case TRACER_DISPLAY_BASE_8:
+ /* Clear sign bits beyond len_bits */
+ if (len_bits < 64)
+ v64.u &= (1ULL << len_bits) - 1;
+ printf("0%" PRIo64, v64.u);
+ break;
+ case TRACER_DISPLAY_BASE_10:
+ if (type_integer->signedness)
+ printf("%" PRId64, v64.s);
+ else
+ printf("%" PRIu64, v64.u);
+ break;
+ case TRACER_DISPLAY_BASE_16:
+ /* Clear sign bits beyond len_bits */
+ if (len_bits < 64)
+ v64.u &= (1ULL << len_bits) - 1;
+ printf("0x%" PRIx64, v64.u);
+ break;
+ default:
+ abort();
+ }
+}
+