[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
int _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);

	if (!ctf_pos_access_ok(pos, integer_declaration->len))
		return -EFAULT;

	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);
	return 0;
}

static
int _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);

	if (!ctf_pos_access_ok(pos, integer_declaration->len))
		return -EFAULT;

	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);
	return 0;
}

int 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)) {
		return _aligned_integer_read(ppos, definition);
	}

	ctf_align_pos(pos, integer_declaration->p.alignment);

	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(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);
	return 0;
}

int 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)) {
		return _aligned_integer_write(ppos, definition);
	}

	ctf_align_pos(pos, integer_declaration->p.alignment);

	if (!ctf_pos_access_ok(pos, integer_declaration->len))
		return -EFAULT;

	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);
	return 0;
}
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
c5e74408 MD	32	int _aligned_integer_read(struct stream_pos *ppos,
c5e74408 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);
6dc2ca62	43
c5e74408 MD	44	if (!ctf_pos_access_ok(pos, integer_declaration->len))
	45	return -EFAULT;
	46
670977d3	47	assert(!(pos->offset % CHAR_BIT));
d11e9c49 MD	48	if (!integer_declaration->signedness) {
	49	switch (integer_declaration->len) {
	50	case 8:
	51	{
	52	uint8_t v;
	53
5385cf15	54	v = (const uint8_t ) ctf_get_pos_addr(pos);
d11e9c49 MD	55	integer_definition->value._unsigned = v;
	56	break;
	57	}
	58	case 16:
	59	{
	60	uint16_t v;
	61
5385cf15	62	v = (const uint16_t ) ctf_get_pos_addr(pos);
d11e9c49 MD	63	integer_definition->value._unsigned =
	64	rbo ? GUINT16_SWAP_LE_BE(v) : v;
	65	break;
	66	}
	67	case 32:
	68	{
	69	uint32_t v;
	70
5385cf15	71	v = (const uint32_t ) ctf_get_pos_addr(pos);
d11e9c49 MD	72	integer_definition->value._unsigned =
	73	rbo ? GUINT32_SWAP_LE_BE(v) : v;
	74	break;
	75	}
	76	case 64:
	77	{
	78	uint64_t v;
	79
5385cf15	80	v = (const uint64_t ) ctf_get_pos_addr(pos);
d11e9c49 MD	81	integer_definition->value._unsigned =
	82	rbo ? GUINT64_SWAP_LE_BE(v) : v;
	83	break;
	84	}
	85	default:
	86	assert(0);
	87	}
	88	} else {
	89	switch (integer_declaration->len) {
	90	case 8:
	91	{
	92	int8_t v;
	93
5385cf15	94	v = (const int8_t ) ctf_get_pos_addr(pos);
d11e9c49 MD	95	integer_definition->value._signed = v;
	96	break;
	97	}
	98	case 16:
	99	{
	100	int16_t v;
	101
5385cf15	102	v = (const int16_t ) ctf_get_pos_addr(pos);
d11e9c49 MD	103	integer_definition->value._signed =
	104	rbo ? GUINT16_SWAP_LE_BE(v) : v;
	105	break;
	106	}
	107	case 32:
	108	{
	109	int32_t v;
	110
5385cf15	111	v = (const int32_t ) ctf_get_pos_addr(pos);
d11e9c49 MD	112	integer_definition->value._signed =
	113	rbo ? GUINT32_SWAP_LE_BE(v) : v;
	114	break;
	115	}
	116	case 64:
	117	{
	118	int64_t v;
	119
5385cf15	120	v = (const int64_t ) ctf_get_pos_addr(pos);
d11e9c49 MD	121	integer_definition->value._signed =
	122	rbo ? GUINT64_SWAP_LE_BE(v) : v;
	123	break;
	124	}
	125	default:
	126	assert(0);
	127	}
6dc2ca62	128	}
d11e9c49	129	ctf_move_pos(pos, integer_declaration->len);
c5e74408	130	return 0;
6dc2ca62 MD	131	}
6dc2ca62 MD	132
7fe00194	133	static
c5e74408	134	int _aligned_integer_write(struct stream_pos *ppos,
d11e9c49	135	struct definition *definition)
6dc2ca62	136	{
d11e9c49 MD	137	struct definition_integer *integer_definition =
	138	container_of(definition, struct definition_integer, p);
	139	const struct declaration_integer *integer_declaration =
	140	integer_definition->declaration;
46322b33	141	struct ctf_stream_pos *pos = ctf_pos(ppos);
f6625916	142	int rbo = (integer_declaration->byte_order != BYTE_ORDER); /* reverse byte order */
6dc2ca62	143
46322b33	144	ctf_align_pos(pos, integer_declaration->p.alignment);
6dc2ca62	145
c5e74408 MD	146	if (!ctf_pos_access_ok(pos, integer_declaration->len))
	147	return -EFAULT;
	148
670977d3	149	assert(!(pos->offset % CHAR_BIT));
bed864a7	150	if (pos->dummy)
6dc2ca62	151	goto end;
d11e9c49 MD	152	if (!integer_declaration->signedness) {
	153	uint64_t v = integer_definition->value._unsigned;
	154
	155	switch (integer_declaration->len) {
	156	case 8: (uint8_t ) ctf_get_pos_addr(pos) = (uint8_t) v;
	157	break;
	158	case 16:
	159	(uint16_t ) ctf_get_pos_addr(pos) = rbo ?
	160	GUINT16_SWAP_LE_BE((uint16_t) v) :
	161	(uint16_t) v;
	162	break;
	163	case 32:
	164	(uint32_t ) ctf_get_pos_addr(pos) = rbo ?
	165	GUINT32_SWAP_LE_BE((uint32_t) v) :
	166	(uint32_t) v;
	167	break;
	168	case 64:
	169	(uint64_t ) ctf_get_pos_addr(pos) = rbo ?
	170	GUINT64_SWAP_LE_BE(v) : v;
	171	break;
	172	default:
	173	assert(0);
	174	}
	175	} else {
	176	int64_t v = integer_definition->value._signed;
	177
	178	switch (integer_declaration->len) {
	179	case 8: (int8_t ) ctf_get_pos_addr(pos) = (int8_t) v;
	180	break;
	181	case 16:
	182	(int16_t ) ctf_get_pos_addr(pos) = rbo ?
	183	GUINT16_SWAP_LE_BE((int16_t) v) :
	184	(int16_t) v;
	185	break;
	186	case 32:
	187	(int32_t ) ctf_get_pos_addr(pos) = rbo ?
	188	GUINT32_SWAP_LE_BE((int32_t) v) :
	189	(int32_t) v;
	190	break;
	191	case 64:
	192	(int64_t ) ctf_get_pos_addr(pos) = rbo ?
	193	GUINT64_SWAP_LE_BE(v) : v;
	194	break;
	195	default:
	196	assert(0);
	197	}
6dc2ca62 MD	198	}
6dc2ca62 MD	199	end:
46322b33	200	ctf_move_pos(pos, integer_declaration->len);
c5e74408	201	return 0;
6dc2ca62 MD	202	}
6dc2ca62 MD	203
c5e74408	204	int ctf_integer_read(struct stream_pos ppos, struct definition definition)
6dc2ca62	205	{
d11e9c49 MD	206	struct definition_integer *integer_definition =
	207	container_of(definition, struct definition_integer, p);
	208	const struct declaration_integer *integer_declaration =
	209	integer_definition->declaration;
46322b33	210	struct ctf_stream_pos *pos = ctf_pos(ppos);
6dc2ca62	211
5385cf15 MD	212	if (!(integer_declaration->p.alignment % CHAR_BIT)
5385cf15 MD	213	&& !(integer_declaration->len % CHAR_BIT)) {
c5e74408	214	return _aligned_integer_read(ppos, definition);
5385cf15 MD	215	}
5385cf15 MD	216
46322b33	217	ctf_align_pos(pos, integer_declaration->p.alignment);
c5e74408 MD	218
	219	if (!ctf_pos_access_ok(pos, integer_declaration->len))
	220	return -EFAULT;
	221
d11e9c49 MD	222	if (!integer_declaration->signedness) {
	223	if (integer_declaration->byte_order == LITTLE_ENDIAN)
	224	bt_bitfield_read_le(pos->base, unsigned long,
	225	pos->offset, integer_declaration->len,
	226	&integer_definition->value._unsigned);
	227	else
	228	bt_bitfield_read_be(pos->base, unsigned long,
	229	pos->offset, integer_declaration->len,
	230	&integer_definition->value._unsigned);
	231	} else {
	232	if (integer_declaration->byte_order == LITTLE_ENDIAN)
	233	bt_bitfield_read_le(pos->base, unsigned long,
	234	pos->offset, integer_declaration->len,
	235	&integer_definition->value._signed);
	236	else
	237	bt_bitfield_read_be(pos->base, unsigned long,
	238	pos->offset, integer_declaration->len,
	239	&integer_definition->value._signed);
6dc2ca62	240	}
46322b33	241	ctf_move_pos(pos, integer_declaration->len);
c5e74408	242	return 0;
6dc2ca62	243	}
7fe00194	244
c5e74408	245	int ctf_integer_write(struct stream_pos ppos, struct definition definition)
7fe00194	246	{
d11e9c49 MD	247	struct definition_integer *integer_definition =
	248	container_of(definition, struct definition_integer, p);
	249	const struct declaration_integer *integer_declaration =
	250	integer_definition->declaration;
46322b33 MD	251	struct ctf_stream_pos *pos = ctf_pos(ppos);
46322b33 MD	252
5385cf15 MD	253	if (!(integer_declaration->p.alignment % CHAR_BIT)
5385cf15 MD	254	&& !(integer_declaration->len % CHAR_BIT)) {
c5e74408	255	return _aligned_integer_write(ppos, definition);
5385cf15 MD	256	}
5385cf15 MD	257
46322b33	258	ctf_align_pos(pos, integer_declaration->p.alignment);
c5e74408 MD	259
	260	if (!ctf_pos_access_ok(pos, integer_declaration->len))
	261	return -EFAULT;
	262
7fe00194 MD	263	if (pos->dummy)
7fe00194 MD	264	goto end;
d11e9c49 MD	265	if (!integer_declaration->signedness) {
	266	if (integer_declaration->byte_order == LITTLE_ENDIAN)
	267	bt_bitfield_write_le(pos->base, unsigned long,
	268	pos->offset, integer_declaration->len,
	269	integer_definition->value._unsigned);
	270	else
	271	bt_bitfield_write_be(pos->base, unsigned long,
	272	pos->offset, integer_declaration->len,
	273	integer_definition->value._unsigned);
	274	} else {
	275	if (integer_declaration->byte_order == LITTLE_ENDIAN)
	276	bt_bitfield_write_le(pos->base, unsigned long,
	277	pos->offset, integer_declaration->len,
	278	integer_definition->value._signed);
	279	else
	280	bt_bitfield_write_be(pos->base, unsigned long,
	281	pos->offset, integer_declaration->len,
	282	integer_definition->value._signed);
	283	}
7fe00194	284	end:
46322b33	285	ctf_move_pos(pos, integer_declaration->len);
c5e74408	286	return 0;
7fe00194	287	}