*
* Integers read/write functions.
*
- * Copyright 2010 - Mathieu Desnoyers <mathieu.desnoyers@efficios.com>
+ * Copyright 2010-2011 EfficiOS Inc. and Linux Foundation
+ *
+ * Author: Mathieu Desnoyers <mathieu.desnoyers@efficios.com>
*
* Permission is hereby granted, free of charge, to any person obtaining a copy
* of this software and associated documentation files (the "Software"), to deal
*
* The above copyright notice and this permission notice shall be included in
* all copies or substantial portions of the Software.
+ *
+ * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
+ * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
+ * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE
+ * AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
+ * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
+ * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE
+ * SOFTWARE.
*/
#include <babeltrace/ctf/types.h>
#include <babeltrace/bitfield.h>
#include <stdint.h>
#include <glib.h>
-#include <endian.h>
+#include <babeltrace/endian.h>
+
+/*
+ * The aligned read/write functions are expected to be faster than the
+ * bitfield variants. They will be enabled eventually as an
+ * optimisation.
+ */
static
-uint64_t _aligned_uint_read(struct stream_pos *pos,
- const struct type_class_integer *int_class)
+int _aligned_integer_read(struct bt_stream_pos *ppos,
+ struct bt_definition *definition)
{
- int rbo = (int_class->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 */
+
+ if (!ctf_align_pos(pos, integer_declaration->p.alignment))
+ return -EFAULT;
+
+ if (!ctf_pos_access_ok(pos, integer_declaration->len))
+ return -EFAULT;
- align_pos(pos, int_class->p.alignment);
assert(!(pos->offset % CHAR_BIT));
- switch (int_class->len) {
- case 8:
- {
- uint8_t v;
-
- v = *(const uint8_t *)pos->base;
- move_pos(pos, int_class->len);
- return v;
- }
- case 16:
- {
- uint16_t v;
+ if (!integer_declaration->signedness) {
+ switch (integer_declaration->len) {
+ case 8:
+ {
+ uint8_t v;
- v = *(const uint16_t *)pos->base;
- move_pos(pos, int_class->len);
- return rbo ? GUINT16_SWAP_LE_BE(v) : v;
- }
- case 32:
- {
- uint32_t v;
+ memcpy(&v, ctf_get_pos_addr(pos), sizeof(v));
+ integer_definition->value._unsigned = v;
+ break;
+ }
+ case 16:
+ {
+ uint16_t v;
- v = *(const uint32_t *)pos->base;
- move_pos(pos, int_class->len);
- return rbo ? GUINT32_SWAP_LE_BE(v) : v;
- }
- case 64:
- {
- uint64_t v;
+ memcpy(&v, ctf_get_pos_addr(pos), sizeof(v));
+ integer_definition->value._unsigned =
+ rbo ? GUINT16_SWAP_LE_BE(v) : v;
+ break;
+ }
+ case 32:
+ {
+ uint32_t v;
- v = *(const uint64_t *)pos->base;
- move_pos(pos, int_class->len);
- return rbo ? GUINT64_SWAP_LE_BE(v) : v;
- }
- default:
- assert(0);
- }
-}
+ memcpy(&v, ctf_get_pos_addr(pos), sizeof(v));
+ integer_definition->value._unsigned =
+ rbo ? GUINT32_SWAP_LE_BE(v) : v;
+ break;
+ }
+ case 64:
+ {
+ uint64_t v;
-static
-int64_t _aligned_int_read(struct stream_pos *pos,
- const struct type_class_integer *int_class)
-{
- int rbo = (int_class->byte_order != BYTE_ORDER); /* reverse byte order */
+ memcpy(&v, ctf_get_pos_addr(pos), sizeof(v));
+ 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;
- align_pos(pos, int_class->p.alignment);
- assert(!(pos->offset % CHAR_BIT));
- switch (int_class->len) {
- case 8:
- {
- int8_t v;
-
- v = *(const int8_t *)pos->base;
- move_pos(pos, int_class->len);
- return v;
- }
- case 16:
- {
- int16_t v;
+ memcpy(&v, ctf_get_pos_addr(pos), sizeof(v));
+ integer_definition->value._signed = v;
+ break;
+ }
+ case 16:
+ {
+ int16_t v;
- v = *(const int16_t *)pos->base;
- move_pos(pos, int_class->len);
- return rbo ? GUINT16_SWAP_LE_BE(v) : v;
- }
- case 32:
- {
- int32_t v;
+ memcpy(&v, ctf_get_pos_addr(pos), sizeof(v));
+ integer_definition->value._signed =
+ rbo ? (int16_t) GUINT16_SWAP_LE_BE(v) : v;
+ break;
+ }
+ case 32:
+ {
+ int32_t v;
- v = *(const int32_t *)pos->base;
- move_pos(pos, int_class->len);
- return rbo ? GUINT32_SWAP_LE_BE(v) : v;
- }
- case 64:
- {
- int64_t v;
+ memcpy(&v, ctf_get_pos_addr(pos), sizeof(v));
+ integer_definition->value._signed =
+ rbo ? (int32_t) GUINT32_SWAP_LE_BE(v) : v;
+ break;
+ }
+ case 64:
+ {
+ int64_t v;
- v = *(const int64_t *)pos->base;
- move_pos(pos, int_class->len);
- return rbo ? GUINT64_SWAP_LE_BE(v) : v;
- }
- default:
- assert(0);
+ memcpy(&v, ctf_get_pos_addr(pos), sizeof(v));
+ integer_definition->value._signed =
+ rbo ? (int64_t) GUINT64_SWAP_LE_BE(v) : v;
+ break;
+ }
+ default:
+ assert(0);
+ }
}
+ if (!ctf_move_pos(pos, integer_declaration->len))
+ return -EFAULT;
+ return 0;
}
static
-void _aligned_uint_write(struct stream_pos *pos,
- const struct type_class_integer *int_class,
- uint64_t v)
+int _aligned_integer_write(struct bt_stream_pos *ppos,
+ struct bt_definition *definition)
{
- int rbo = (int_class->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 */
+
+ if (!ctf_align_pos(pos, integer_declaration->p.alignment))
+ return -EFAULT;
+
+ if (!ctf_pos_access_ok(pos, integer_declaration->len))
+ return -EFAULT;
- align_pos(pos, int_class->p.alignment);
assert(!(pos->offset % CHAR_BIT));
if (pos->dummy)
goto end;
+ if (!integer_declaration->signedness) {
+ switch (integer_declaration->len) {
+ case 8:
+ {
+ uint8_t v = integer_definition->value._unsigned;
+
+ memcpy(ctf_get_pos_addr(pos), &v, sizeof(v));
+ break;
+ }
+ case 16:
+ {
+ uint16_t v = integer_definition->value._unsigned;
+
+ if (rbo)
+ v = GUINT16_SWAP_LE_BE(v);
+ memcpy(ctf_get_pos_addr(pos), &v, sizeof(v));
+ break;
+ }
+ case 32:
+ {
+ uint32_t v = integer_definition->value._unsigned;
+
+ if (rbo)
+ v = GUINT32_SWAP_LE_BE(v);
+ memcpy(ctf_get_pos_addr(pos), &v, sizeof(v));
+ break;
+ }
+ case 64:
+ {
+ uint64_t v = integer_definition->value._unsigned;
- switch (int_class->len) {
- case 8: *(uint8_t *) get_pos_addr(pos) = (uint8_t) v;
- break;
- case 16:
- *(uint16_t *) get_pos_addr(pos) = rbo ?
- GUINT16_SWAP_LE_BE((uint16_t) v) :
- (uint16_t) v;
- break;
- case 32:
- *(uint32_t *) get_pos_addr(pos) = rbo ?
- GUINT32_SWAP_LE_BE((uint32_t) v) :
- (uint32_t) v;
- break;
- case 64:
- *(uint64_t *) get_pos_addr(pos) = rbo ?
- GUINT64_SWAP_LE_BE(v) : v;
- break;
- default:
- assert(0);
+ if (rbo)
+ v = GUINT64_SWAP_LE_BE(v);
+ memcpy(ctf_get_pos_addr(pos), &v, sizeof(v));
+ break;
+ }
+ default:
+ assert(0);
+ }
+ } else {
+ switch (integer_declaration->len) {
+ case 8:
+ {
+ uint8_t v = integer_definition->value._signed;
+
+ memcpy(ctf_get_pos_addr(pos), &v, sizeof(v));
+ break;
+ }
+ case 16:
+ {
+ int16_t v = integer_definition->value._signed;
+
+ if (rbo)
+ v = GUINT16_SWAP_LE_BE(v);
+ memcpy(ctf_get_pos_addr(pos), &v, sizeof(v));
+ break;
+ }
+ case 32:
+ {
+ int32_t v = integer_definition->value._signed;
+
+ if (rbo)
+ v = GUINT32_SWAP_LE_BE(v);
+ memcpy(ctf_get_pos_addr(pos), &v, sizeof(v));
+ break;
+ }
+ case 64:
+ {
+ int64_t v = integer_definition->value._signed;
+
+ if (rbo)
+ v = GUINT64_SWAP_LE_BE(v);
+ memcpy(ctf_get_pos_addr(pos), &v, sizeof(v));
+ break;
+ }
+ default:
+ assert(0);
+ }
}
end:
- move_pos(pos, int_class->len);
+ if (!ctf_move_pos(pos, integer_declaration->len))
+ return -EFAULT;
+ return 0;
}
-static
-void _aligned_int_write(struct stream_pos *pos,
- const struct type_class_integer *int_class,
- int64_t v)
+int ctf_integer_read(struct bt_stream_pos *ppos, struct bt_definition *definition)
{
- int rbo = (int_class->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);
- align_pos(pos, int_class->p.alignment);
- assert(!(pos->offset % CHAR_BIT));
- if (pos->dummy)
- goto end;
+ if (!(integer_declaration->p.alignment % CHAR_BIT)
+ && !(integer_declaration->len % CHAR_BIT)) {
+ return _aligned_integer_read(ppos, definition);
+ }
- switch (int_class->len) {
- case 8: *(int8_t *) get_pos_addr(pos) = (int8_t) v;
- break;
- case 16:
- *(int16_t *) get_pos_addr(pos) = rbo ?
- GUINT16_SWAP_LE_BE((int16_t) v) :
- (int16_t) v;
- break;
- case 32:
- *(int32_t *) get_pos_addr(pos) = rbo ?
- GUINT32_SWAP_LE_BE((int32_t) v) :
- (int32_t) v;
- break;
- case 64:
- *(int64_t *) get_pos_addr(pos) = rbo ?
- GUINT64_SWAP_LE_BE(v) : v;
- break;
- default:
- assert(0);
+ if (!ctf_align_pos(pos, integer_declaration->p.alignment))
+ return -EFAULT;
+
+ if (!ctf_pos_access_ok(pos, integer_declaration->len))
+ return -EFAULT;
+
+ if (!integer_declaration->signedness) {
+ if (integer_declaration->byte_order == LITTLE_ENDIAN)
+ bt_bitfield_read_le(mmap_align_addr(pos->base_mma) +
+ pos->mmap_base_offset, unsigned char,
+ pos->offset, integer_declaration->len,
+ &integer_definition->value._unsigned);
+ else
+ bt_bitfield_read_be(mmap_align_addr(pos->base_mma) +
+ pos->mmap_base_offset, unsigned char,
+ pos->offset, integer_declaration->len,
+ &integer_definition->value._unsigned);
+ } else {
+ if (integer_declaration->byte_order == LITTLE_ENDIAN)
+ bt_bitfield_read_le(mmap_align_addr(pos->base_mma) +
+ pos->mmap_base_offset, unsigned char,
+ pos->offset, integer_declaration->len,
+ &integer_definition->value._signed);
+ else
+ bt_bitfield_read_be(mmap_align_addr(pos->base_mma) +
+ pos->mmap_base_offset, unsigned char,
+ pos->offset, integer_declaration->len,
+ &integer_definition->value._signed);
}
-end:
- move_pos(pos, int_class->len);
- return;
+ if (!ctf_move_pos(pos, integer_declaration->len))
+ return -EFAULT;
+ return 0;
}
-uint64_t ctf_uint_read(struct stream_pos *pos,
- const struct type_class_integer *int_class)
+int ctf_integer_write(struct bt_stream_pos *ppos, struct bt_definition *definition)
{
- uint64_t v;
-
- align_pos(pos, int_class->p.alignment);
- if (int_class->byte_order == LITTLE_ENDIAN)
- ctf_bitfield_read_le(pos->base, pos->offset,
- int_class->len, &v);
- else
- ctf_bitfield_read_be(pos->base, pos->offset,
- int_class->len, &v);
- move_pos(pos, int_class->len);
- return v;
-}
+ 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);
-int64_t ctf_int_read(struct stream_pos *pos,
- const struct type_class_integer *int_class)
-{
- int64_t v;
-
- align_pos(pos, int_class->p.alignment);
- if (int_class->byte_order == LITTLE_ENDIAN)
- ctf_bitfield_read_le(pos->base, pos->offset,
- int_class->len, &v);
- else
- ctf_bitfield_read_be(pos->base, pos->offset,
- int_class->len, &v);
- move_pos(pos, int_class->len);
- return v;
-}
+ if (!(integer_declaration->p.alignment % CHAR_BIT)
+ && !(integer_declaration->len % CHAR_BIT)) {
+ return _aligned_integer_write(ppos, definition);
+ }
-void ctf_uint_write(struct stream_pos *pos,
- const struct type_class_integer *int_class,
- uint64_t v)
-{
- align_pos(pos, int_class->p.alignment);
- if (pos->dummy)
- goto end;
- if (int_class->byte_order == LITTLE_ENDIAN)
- ctf_bitfield_write_le(pos->base, pos->offset,
- int_class->len, v);
- else
- ctf_bitfield_write_be(pos->base, pos->offset,
- int_class->len, v);
-end:
- move_pos(pos, int_class->len);
-}
+ if (!ctf_align_pos(pos, integer_declaration->p.alignment))
+ return -EFAULT;
+
+ if (!ctf_pos_access_ok(pos, integer_declaration->len))
+ return -EFAULT;
-void ctf_int_write(struct stream_pos *pos,
- const struct type_class_integer *int_class,
- int64_t v)
-{
- align_pos(pos, int_class->p.alignment);
if (pos->dummy)
goto end;
- if (int_class->byte_order == LITTLE_ENDIAN)
- ctf_bitfield_write_le(pos->base, pos->offset,
- int_class->len, v);
- else
- ctf_bitfield_write_be(pos->base, pos->offset,
- int_class->len, v);
+ if (!integer_declaration->signedness) {
+ if (integer_declaration->byte_order == LITTLE_ENDIAN)
+ bt_bitfield_write_le(mmap_align_addr(pos->base_mma) +
+ pos->mmap_base_offset, unsigned char,
+ pos->offset, integer_declaration->len,
+ integer_definition->value._unsigned);
+ else
+ bt_bitfield_write_be(mmap_align_addr(pos->base_mma) +
+ pos->mmap_base_offset, unsigned char,
+ pos->offset, integer_declaration->len,
+ integer_definition->value._unsigned);
+ } else {
+ if (integer_declaration->byte_order == LITTLE_ENDIAN)
+ bt_bitfield_write_le(mmap_align_addr(pos->base_mma) +
+ pos->mmap_base_offset, unsigned char,
+ pos->offset, integer_declaration->len,
+ integer_definition->value._signed);
+ else
+ bt_bitfield_write_be(mmap_align_addr(pos->base_mma) +
+ pos->mmap_base_offset, unsigned char,
+ pos->offset, integer_declaration->len,
+ integer_definition->value._signed);
+ }
end:
- move_pos(pos, int_class->len);
+ if (!ctf_move_pos(pos, integer_declaration->len))
+ return -EFAULT;
+ return 0;
}