*
* Integers read/write functions.
*
- * Copyright (c) 2010 Mathieu Desnoyers <mathieu.desnoyers@efficios.com>
+ * Copyright 2010 - Mathieu Desnoyers <mathieu.desnoyers@efficios.com>
*
- * This library is free software; you can redistribute it and/or
- * modify it under the terms of the GNU Lesser General Public
- * License as published by the Free Software Foundation; either
- * version 2.1 of the License, or (at your option) any later version.
+ * Permission is hereby granted, free of charge, to any person obtaining a copy
+ * of this software and associated documentation files (the "Software"), to deal
+ * in the Software without restriction, including without limitation the rights
+ * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
+ * copies of the Software, and to permit persons to whom the Software is
+ * furnished to do so, subject to the following conditions:
*
- * This library is distributed in the hope that it will be useful,
- * but WITHOUT ANY WARRANTY; without even the implied warranty of
- * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
- * Lesser General Public License for more details.
- *
- * You should have received a copy of the GNU Lesser General Public
- * License along with this library; if not, write to the Free Software
- * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA
+ * The above copyright notice and this permission notice shall be included in
+ * all copies or substantial portions of the Software.
*/
-#include <ctf/ctf-types.h>
+#include <babeltrace/ctf/types.h>
+#include <babeltrace/bitfield.h>
#include <stdint.h>
#include <glib.h>
#include <endian.h>
-uint64_t ctf_uint_read(const uint8_t *ptr, size_t len, int byte_order)
+static
+void _aligned_integer_read(struct stream_pos *ppos,
+ struct definition *definition)
{
- int rbo = (byte_order != BYTE_ORDER); /* reverse byte order */
-
- switch (len) {
- case 8:
- {
- uint8_t v;
-
- v = *(const uint8_t *)ptr;
- return v;
- }
- case 16:
- {
- uint16_t v;
-
- v = *(const uint16_t *)ptr;
- return rbo ? GUINT16_SWAP_LE_BE(v) : v;
- }
- case 32:
- {
- uint32_t v;
-
- v = *(const uint32_t *)ptr;
- return rbo ? GUINT32_SWAP_LE_BE(v) : v;
- }
- case 64:
- {
- uint64_t v;
-
- v = *(const uint64_t *)ptr;
- return rbo ? GUINT64_SWAP_LE_BE(v) : v;
- }
- default:
- assert(0);
+ struct definition_integer *integer_definition =
+ container_of(definition, struct definition_integer, p);
+ const struct declaration_integer *integer_declaration =
+ integer_definition->declaration;
+ struct ctf_stream_pos *pos = ctf_pos(ppos);
+ int rbo = (integer_declaration->byte_order != BYTE_ORDER); /* reverse byte order */
+
+ ctf_align_pos(pos, integer_declaration->p.alignment);
+ assert(!(pos->offset % CHAR_BIT));
+
+ if (!integer_declaration->signedness) {
+ switch (integer_declaration->len) {
+ case 8:
+ {
+ uint8_t v;
+
+ v = *(const uint8_t *)pos->base;
+ integer_definition->value._unsigned = v;
+ break;
+ }
+ case 16:
+ {
+ uint16_t v;
+
+ v = *(const uint16_t *)pos->base;
+ integer_definition->value._unsigned =
+ rbo ? GUINT16_SWAP_LE_BE(v) : v;
+ break;
+ }
+ case 32:
+ {
+ uint32_t v;
+
+ v = *(const uint32_t *)pos->base;
+ integer_definition->value._unsigned =
+ rbo ? GUINT32_SWAP_LE_BE(v) : v;
+ break;
+ }
+ case 64:
+ {
+ uint64_t v;
+
+ v = *(const uint64_t *)pos->base;
+ integer_definition->value._unsigned =
+ rbo ? GUINT64_SWAP_LE_BE(v) : v;
+ break;
+ }
+ default:
+ assert(0);
+ }
+ } else {
+ switch (integer_declaration->len) {
+ case 8:
+ {
+ int8_t v;
+
+ v = *(const int8_t *)pos->base;
+ integer_definition->value._signed = v;
+ break;
+ }
+ case 16:
+ {
+ int16_t v;
+
+ v = *(const int16_t *)pos->base;
+ integer_definition->value._signed =
+ rbo ? GUINT16_SWAP_LE_BE(v) : v;
+ break;
+ }
+ case 32:
+ {
+ int32_t v;
+
+ v = *(const int32_t *)pos->base;
+ integer_definition->value._signed =
+ rbo ? GUINT32_SWAP_LE_BE(v) : v;
+ break;
+ }
+ case 64:
+ {
+ int64_t v;
+
+ v = *(const int64_t *)pos->base;
+ integer_definition->value._signed =
+ rbo ? GUINT64_SWAP_LE_BE(v) : v;
+ break;
+ }
+ default:
+ assert(0);
+ }
}
+ ctf_move_pos(pos, integer_declaration->len);
}
-int64_t ctf_int_read(const uint8_t *ptr, size_t len, int byte_order)
+static
+void _aligned_integer_write(struct stream_pos *ppos,
+ struct definition *definition)
{
- int rbo = (byte_order != BYTE_ORDER); /* reverse byte order */
+ struct definition_integer *integer_definition =
+ container_of(definition, struct definition_integer, p);
+ const struct declaration_integer *integer_declaration =
+ integer_definition->declaration;
+ struct ctf_stream_pos *pos = ctf_pos(ppos);
+ int rbo = (integer_declaration->byte_order != BYTE_ORDER); /* reverse byte order */
- switch (len) {
- case 8:
- {
- int8_t v;
+ ctf_align_pos(pos, integer_declaration->p.alignment);
+ assert(!(pos->offset % CHAR_BIT));
- v = *(const int8_t *)ptr;
- return v;
- }
- case 16:
- {
- int16_t v;
-
- v = *(const int16_t *)ptr;
- return rbo ? GUINT16_SWAP_LE_BE(v) : v;
- }
- case 32:
- {
- int32_t v;
-
- v = *(const int32_t *)ptr;
- return rbo ? GUINT32_SWAP_LE_BE(v) : v;
- }
- case 64:
- {
- int64_t v;
-
- v = *(const int64_t *)ptr;
- return rbo ? GUINT64_SWAP_LE_BE(v) : v;
- }
- default:
- assert(0);
+ if (pos->dummy)
+ goto end;
+ if (!integer_declaration->signedness) {
+ uint64_t v = integer_definition->value._unsigned;
+
+ switch (integer_declaration->len) {
+ case 8: *(uint8_t *) ctf_get_pos_addr(pos) = (uint8_t) v;
+ break;
+ case 16:
+ *(uint16_t *) ctf_get_pos_addr(pos) = rbo ?
+ GUINT16_SWAP_LE_BE((uint16_t) v) :
+ (uint16_t) v;
+ break;
+ case 32:
+ *(uint32_t *) ctf_get_pos_addr(pos) = rbo ?
+ GUINT32_SWAP_LE_BE((uint32_t) v) :
+ (uint32_t) v;
+ break;
+ case 64:
+ *(uint64_t *) ctf_get_pos_addr(pos) = rbo ?
+ GUINT64_SWAP_LE_BE(v) : v;
+ break;
+ default:
+ assert(0);
+ }
+ } else {
+ int64_t v = integer_definition->value._signed;
+
+ switch (integer_declaration->len) {
+ case 8: *(int8_t *) ctf_get_pos_addr(pos) = (int8_t) v;
+ break;
+ case 16:
+ *(int16_t *) ctf_get_pos_addr(pos) = rbo ?
+ GUINT16_SWAP_LE_BE((int16_t) v) :
+ (int16_t) v;
+ break;
+ case 32:
+ *(int32_t *) ctf_get_pos_addr(pos) = rbo ?
+ GUINT32_SWAP_LE_BE((int32_t) v) :
+ (int32_t) v;
+ break;
+ case 64:
+ *(int64_t *) ctf_get_pos_addr(pos) = rbo ?
+ GUINT64_SWAP_LE_BE(v) : v;
+ break;
+ default:
+ assert(0);
+ }
}
+end:
+ ctf_move_pos(pos, integer_declaration->len);
}
-size_t ctf_uint_write(uint8_t *ptr, size_t len, int byte_order, uint64_t v)
+void ctf_integer_read(struct stream_pos *ppos, struct definition *definition)
{
- int rbo = (byte_order != BYTE_ORDER); /* reverse byte order */
-
- if (!ptr)
- goto end;
-
- switch (len) {
- case 8: *(uint8_t *)ptr = (uint8_t) v;
- break;
- case 16:
- *(uint16_t *)ptr = rbo ? GUINT16_SWAP_LE_BE((uint16_t) v) :
- (uint16_t) v;
- break;
- case 32:
- *(uint32_t *)ptr = rbo ? GUINT32_SWAP_LE_BE((uint32_t) v) :
- (uint32_t) v;
- break;
- case 64:
- *(uint64_t *)ptr = rbo ? GUINT64_SWAP_LE_BE(v) : v;
- break;
- default:
- assert(0);
+ struct definition_integer *integer_definition =
+ container_of(definition, struct definition_integer, p);
+ const struct declaration_integer *integer_declaration =
+ integer_definition->declaration;
+ struct ctf_stream_pos *pos = ctf_pos(ppos);
+
+ ctf_align_pos(pos, integer_declaration->p.alignment);
+ if (!integer_declaration->signedness) {
+ if (integer_declaration->byte_order == LITTLE_ENDIAN)
+ bt_bitfield_read_le(pos->base, unsigned long,
+ pos->offset, integer_declaration->len,
+ &integer_definition->value._unsigned);
+ else
+ bt_bitfield_read_be(pos->base, unsigned long,
+ pos->offset, integer_declaration->len,
+ &integer_definition->value._unsigned);
+ } else {
+ if (integer_declaration->byte_order == LITTLE_ENDIAN)
+ bt_bitfield_read_le(pos->base, unsigned long,
+ pos->offset, integer_declaration->len,
+ &integer_definition->value._signed);
+ else
+ bt_bitfield_read_be(pos->base, unsigned long,
+ pos->offset, integer_declaration->len,
+ &integer_definition->value._signed);
}
-end:
- return len;
+ ctf_move_pos(pos, integer_declaration->len);
}
-size_t ctf_int_write(uint8_t *ptr, size_t len, int byte_order, int64_t v)
+void ctf_integer_write(struct stream_pos *ppos, struct definition *definition)
{
- int rbo = (byte_order != BYTE_ORDER); /* reverse byte order */
-
- if (!ptr)
+ struct definition_integer *integer_definition =
+ container_of(definition, struct definition_integer, p);
+ const struct declaration_integer *integer_declaration =
+ integer_definition->declaration;
+ struct ctf_stream_pos *pos = ctf_pos(ppos);
+
+ ctf_align_pos(pos, integer_declaration->p.alignment);
+ if (pos->dummy)
goto end;
-
- switch (len) {
- case 8: *(int8_t *)ptr = (int8_t) v;
- break;
- case 16:
- *(int16_t *)ptr = rbo ? GUINT16_SWAP_LE_BE((int16_t) v) :
- (int16_t) v;
- break;
- case 32:
- *(int32_t *)ptr = rbo ? GUINT32_SWAP_LE_BE((int32_t) v) :
- (int32_t) v;
- break;
- case 64:
- *(int64_t *)ptr = rbo ? GUINT64_SWAP_LE_BE(v) : v;
- break;
- default:
- assert(0);
+ if (!integer_declaration->signedness) {
+ if (integer_declaration->byte_order == LITTLE_ENDIAN)
+ bt_bitfield_write_le(pos->base, unsigned long,
+ pos->offset, integer_declaration->len,
+ integer_definition->value._unsigned);
+ else
+ bt_bitfield_write_be(pos->base, unsigned long,
+ pos->offset, integer_declaration->len,
+ integer_definition->value._unsigned);
+ } else {
+ if (integer_declaration->byte_order == LITTLE_ENDIAN)
+ bt_bitfield_write_le(pos->base, unsigned long,
+ pos->offset, integer_declaration->len,
+ integer_definition->value._signed);
+ else
+ bt_bitfield_write_be(pos->base, unsigned long,
+ pos->offset, integer_declaration->len,
+ integer_definition->value._signed);
}
end:
- return len;
+ ctf_move_pos(pos, integer_declaration->len);
}