[babeltrace.git] / formats / ctf / types / integer.c

/*
 * Common Trace Format
 *
 * Integers read/write functions.
 *
 * Copyright 2010 - 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
 * 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:
 *
 * The above copyright notice and this permission notice shall be included in
 * all copies or substantial portions of the Software.
 */

#include <babeltrace/ctf/types.h>
#include <babeltrace/bitfield.h>
#include <stdint.h>
#include <glib.h>
#include <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
void _aligned_integer_read(struct stream_pos *ppos,
			   struct definition *definition)
{
	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 *) ctf_get_pos_addr(pos);
			integer_definition->value._unsigned = v;
			break;
		}
		case 16:
		{
			uint16_t v;

			v = *(const uint16_t *) ctf_get_pos_addr(pos);
			integer_definition->value._unsigned =
				rbo ? GUINT16_SWAP_LE_BE(v) : v;
			break;
		}
		case 32:
		{
			uint32_t v;

			v = *(const uint32_t *) ctf_get_pos_addr(pos);
			integer_definition->value._unsigned =
				rbo ? GUINT32_SWAP_LE_BE(v) : v;
			break;
		}
		case 64:
		{
			uint64_t v;

			v = *(const uint64_t *) ctf_get_pos_addr(pos);
			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 *) ctf_get_pos_addr(pos);
			integer_definition->value._signed = v;
			break;
		}
		case 16:
		{
			int16_t v;

			v = *(const int16_t *) ctf_get_pos_addr(pos);
			integer_definition->value._signed =
				rbo ? GUINT16_SWAP_LE_BE(v) : v;
			break;
		}
		case 32:
		{
			int32_t v;

			v = *(const int32_t *) ctf_get_pos_addr(pos);
			integer_definition->value._signed =
				rbo ? GUINT32_SWAP_LE_BE(v) : v;
			break;
		}
		case 64:
		{
			int64_t v;

			v = *(const int64_t *) ctf_get_pos_addr(pos);
			integer_definition->value._signed =
				rbo ? GUINT64_SWAP_LE_BE(v) : v;
			break;
		}
		default:
			assert(0);
		}
	}
	ctf_move_pos(pos, integer_declaration->len);
}

static
void _aligned_integer_write(struct stream_pos *ppos,
			    struct definition *definition)
{
	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 (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);
}

void ctf_integer_read(struct stream_pos *ppos, struct definition *definition)
{
	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);

	if (!(integer_declaration->p.alignment % CHAR_BIT)
	    && !(integer_declaration->len % CHAR_BIT)) {
		_aligned_integer_read(ppos, definition);
		return;
	}

	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);
	}
	ctf_move_pos(pos, integer_declaration->len);
}

void ctf_integer_write(struct stream_pos *ppos, struct definition *definition)
{
	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);

	if (!(integer_declaration->p.alignment % CHAR_BIT)
	    && !(integer_declaration->len % CHAR_BIT)) {
		_aligned_integer_write(ppos, definition);
		return;
	}

	ctf_align_pos(pos, integer_declaration->p.alignment);
	if (pos->dummy)
		goto end;
	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:
	ctf_move_pos(pos, integer_declaration->len);
}
Commit	Line	Data
6dc2ca62 MD	1	/*
	2	* Common Trace Format
	3	*
	4	* Integers read/write functions.
	5	*
ccd7e1c8	6	* Copyright 2010 - Mathieu Desnoyers <mathieu.desnoyers@efficios.com>
6dc2ca62	7	*
ccd7e1c8 MD	8	* Permission is hereby granted, free of charge, to any person obtaining a copy
	9	* of this software and associated documentation files (the "Software"), to deal
	10	* in the Software without restriction, including without limitation the rights
	11	* to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
	12	* copies of the Software, and to permit persons to whom the Software is
	13	* furnished to do so, subject to the following conditions:
de0ba614	14	*
ccd7e1c8 MD	15	* The above copyright notice and this permission notice shall be included in
ccd7e1c8 MD	16	* all copies or substantial portions of the Software.
6dc2ca62 MD	17	*/
6dc2ca62 MD	18
4c8bfb7e MD	19	#include <babeltrace/ctf/types.h>
4c8bfb7e MD	20	#include <babeltrace/bitfield.h>
6dc2ca62 MD	21	#include <stdint.h>
	22	#include <glib.h>
	23	#include <endian.h>
	24
5385cf15 MD	25	/*
	26	* The aligned read/write functions are expected to be faster than the
	27	* bitfield variants. They will be enabled eventually as an
	28	* optimisation.
	29	*/
	30
7fe00194	31	static
d11e9c49 MD	32	void _aligned_integer_read(struct stream_pos *ppos,
d11e9c49 MD	33	struct definition *definition)
6dc2ca62	34	{
d11e9c49 MD	35	struct definition_integer *integer_definition =
	36	container_of(definition, struct definition_integer, p);
	37	const struct declaration_integer *integer_declaration =
	38	integer_definition->declaration;
46322b33	39	struct ctf_stream_pos *pos = ctf_pos(ppos);
f6625916	40	int rbo = (integer_declaration->byte_order != BYTE_ORDER); /* reverse byte order */
6dc2ca62	41
46322b33	42	ctf_align_pos(pos, integer_declaration->p.alignment);
bed864a7	43	assert(!(pos->offset % CHAR_BIT));
6dc2ca62	44
d11e9c49 MD	45	if (!integer_declaration->signedness) {
	46	switch (integer_declaration->len) {
	47	case 8:
	48	{
	49	uint8_t v;
	50
5385cf15	51	v = (const uint8_t ) ctf_get_pos_addr(pos);
d11e9c49 MD	52	integer_definition->value._unsigned = v;
	53	break;
	54	}
	55	case 16:
	56	{
	57	uint16_t v;
	58
5385cf15	59	v = (const uint16_t ) ctf_get_pos_addr(pos);
d11e9c49 MD	60	integer_definition->value._unsigned =
	61	rbo ? GUINT16_SWAP_LE_BE(v) : v;
	62	break;
	63	}
	64	case 32:
	65	{
	66	uint32_t v;
	67
5385cf15	68	v = (const uint32_t ) ctf_get_pos_addr(pos);
d11e9c49 MD	69	integer_definition->value._unsigned =
	70	rbo ? GUINT32_SWAP_LE_BE(v) : v;
	71	break;
	72	}
	73	case 64:
	74	{
	75	uint64_t v;
	76
5385cf15	77	v = (const uint64_t ) ctf_get_pos_addr(pos);
d11e9c49 MD	78	integer_definition->value._unsigned =
	79	rbo ? GUINT64_SWAP_LE_BE(v) : v;
	80	break;
	81	}
	82	default:
	83	assert(0);
	84	}
	85	} else {
	86	switch (integer_declaration->len) {
	87	case 8:
	88	{
	89	int8_t v;
	90
5385cf15	91	v = (const int8_t ) ctf_get_pos_addr(pos);
d11e9c49 MD	92	integer_definition->value._signed = v;
	93	break;
	94	}
	95	case 16:
	96	{
	97	int16_t v;
	98
5385cf15	99	v = (const int16_t ) ctf_get_pos_addr(pos);
d11e9c49 MD	100	integer_definition->value._signed =
	101	rbo ? GUINT16_SWAP_LE_BE(v) : v;
	102	break;
	103	}
	104	case 32:
	105	{
	106	int32_t v;
	107
5385cf15	108	v = (const int32_t ) ctf_get_pos_addr(pos);
d11e9c49 MD	109	integer_definition->value._signed =
	110	rbo ? GUINT32_SWAP_LE_BE(v) : v;
	111	break;
	112	}
	113	case 64:
	114	{
	115	int64_t v;
	116
5385cf15	117	v = (const int64_t ) ctf_get_pos_addr(pos);
d11e9c49 MD	118	integer_definition->value._signed =
	119	rbo ? GUINT64_SWAP_LE_BE(v) : v;
	120	break;
	121	}
	122	default:
	123	assert(0);
	124	}
6dc2ca62	125	}
d11e9c49	126	ctf_move_pos(pos, integer_declaration->len);
6dc2ca62 MD	127	}
6dc2ca62 MD	128
7fe00194	129	static
d11e9c49 MD	130	void _aligned_integer_write(struct stream_pos *ppos,
d11e9c49 MD	131	struct definition *definition)
6dc2ca62	132	{
d11e9c49 MD	133	struct definition_integer *integer_definition =
	134	container_of(definition, struct definition_integer, p);
	135	const struct declaration_integer *integer_declaration =
	136	integer_definition->declaration;
46322b33	137	struct ctf_stream_pos *pos = ctf_pos(ppos);
f6625916	138	int rbo = (integer_declaration->byte_order != BYTE_ORDER); /* reverse byte order */
6dc2ca62	139
46322b33	140	ctf_align_pos(pos, integer_declaration->p.alignment);
bed864a7	141	assert(!(pos->offset % CHAR_BIT));
6dc2ca62	142
bed864a7	143	if (pos->dummy)
6dc2ca62	144	goto end;
d11e9c49 MD	145	if (!integer_declaration->signedness) {
	146	uint64_t v = integer_definition->value._unsigned;
	147
	148	switch (integer_declaration->len) {
	149	case 8: (uint8_t ) ctf_get_pos_addr(pos) = (uint8_t) v;
	150	break;
	151	case 16:
	152	(uint16_t ) ctf_get_pos_addr(pos) = rbo ?
	153	GUINT16_SWAP_LE_BE((uint16_t) v) :
	154	(uint16_t) v;
	155	break;
	156	case 32:
	157	(uint32_t ) ctf_get_pos_addr(pos) = rbo ?
	158	GUINT32_SWAP_LE_BE((uint32_t) v) :
	159	(uint32_t) v;
	160	break;
	161	case 64:
	162	(uint64_t ) ctf_get_pos_addr(pos) = rbo ?
	163	GUINT64_SWAP_LE_BE(v) : v;
	164	break;
	165	default:
	166	assert(0);
	167	}
	168	} else {
	169	int64_t v = integer_definition->value._signed;
	170
	171	switch (integer_declaration->len) {
	172	case 8: (int8_t ) ctf_get_pos_addr(pos) = (int8_t) v;
	173	break;
	174	case 16:
	175	(int16_t ) ctf_get_pos_addr(pos) = rbo ?
	176	GUINT16_SWAP_LE_BE((int16_t) v) :
	177	(int16_t) v;
	178	break;
	179	case 32:
	180	(int32_t ) ctf_get_pos_addr(pos) = rbo ?
	181	GUINT32_SWAP_LE_BE((int32_t) v) :
	182	(int32_t) v;
	183	break;
	184	case 64:
	185	(int64_t ) ctf_get_pos_addr(pos) = rbo ?
	186	GUINT64_SWAP_LE_BE(v) : v;
	187	break;
	188	default:
	189	assert(0);
	190	}
6dc2ca62 MD	191	}
6dc2ca62 MD	192	end:
46322b33	193	ctf_move_pos(pos, integer_declaration->len);
6dc2ca62 MD	194	}
6dc2ca62 MD	195
d11e9c49	196	void ctf_integer_read(struct stream_pos ppos, struct definition definition)
6dc2ca62	197	{
d11e9c49 MD	198	struct definition_integer *integer_definition =
	199	container_of(definition, struct definition_integer, p);
	200	const struct declaration_integer *integer_declaration =
	201	integer_definition->declaration;
46322b33	202	struct ctf_stream_pos *pos = ctf_pos(ppos);
6dc2ca62	203
5385cf15 MD	204	if (!(integer_declaration->p.alignment % CHAR_BIT)
	205	&& !(integer_declaration->len % CHAR_BIT)) {
	206	_aligned_integer_read(ppos, definition);
	207	return;
	208	}
	209
46322b33	210	ctf_align_pos(pos, integer_declaration->p.alignment);
d11e9c49 MD	211	if (!integer_declaration->signedness) {
	212	if (integer_declaration->byte_order == LITTLE_ENDIAN)
	213	bt_bitfield_read_le(pos->base, unsigned long,
	214	pos->offset, integer_declaration->len,
	215	&integer_definition->value._unsigned);
	216	else
	217	bt_bitfield_read_be(pos->base, unsigned long,
	218	pos->offset, integer_declaration->len,
	219	&integer_definition->value._unsigned);
	220	} else {
	221	if (integer_declaration->byte_order == LITTLE_ENDIAN)
	222	bt_bitfield_read_le(pos->base, unsigned long,
	223	pos->offset, integer_declaration->len,
	224	&integer_definition->value._signed);
	225	else
	226	bt_bitfield_read_be(pos->base, unsigned long,
	227	pos->offset, integer_declaration->len,
	228	&integer_definition->value._signed);
6dc2ca62	229	}
46322b33	230	ctf_move_pos(pos, integer_declaration->len);
6dc2ca62	231	}
7fe00194	232
d11e9c49	233	void ctf_integer_write(struct stream_pos ppos, struct definition definition)
7fe00194	234	{
d11e9c49 MD	235	struct definition_integer *integer_definition =
	236	container_of(definition, struct definition_integer, p);
	237	const struct declaration_integer *integer_declaration =
	238	integer_definition->declaration;
46322b33 MD	239	struct ctf_stream_pos *pos = ctf_pos(ppos);
46322b33 MD	240
5385cf15 MD	241	if (!(integer_declaration->p.alignment % CHAR_BIT)
	242	&& !(integer_declaration->len % CHAR_BIT)) {
	243	_aligned_integer_write(ppos, definition);
	244	return;
	245	}
	246
46322b33	247	ctf_align_pos(pos, integer_declaration->p.alignment);
7fe00194 MD	248	if (pos->dummy)
7fe00194 MD	249	goto end;
d11e9c49 MD	250	if (!integer_declaration->signedness) {
	251	if (integer_declaration->byte_order == LITTLE_ENDIAN)
	252	bt_bitfield_write_le(pos->base, unsigned long,
	253	pos->offset, integer_declaration->len,
	254	integer_definition->value._unsigned);
	255	else
	256	bt_bitfield_write_be(pos->base, unsigned long,
	257	pos->offset, integer_declaration->len,
	258	integer_definition->value._unsigned);
	259	} else {
	260	if (integer_declaration->byte_order == LITTLE_ENDIAN)
	261	bt_bitfield_write_le(pos->base, unsigned long,
	262	pos->offset, integer_declaration->len,
	263	integer_definition->value._signed);
	264	else
	265	bt_bitfield_write_be(pos->base, unsigned long,
	266	pos->offset, integer_declaration->len,
	267	integer_definition->value._signed);
	268	}
7fe00194	269	end:
46322b33	270	ctf_move_pos(pos, integer_declaration->len);
7fe00194	271	}