Linux preempt-rt

Check our new training course

Real-Time Linux with PREEMPT_RT

Check our new training course
with Creative Commons CC-BY-SA
lecture and lab materials

Bootlin logo

Elixir Cross Referencer

/*
 *
 *  oFono - Open Source Telephony
 *
 *  Copyright (C) 2009-2010  Nokia Corporation and/or its subsidiary(-ies).
 *
 *  This program is free software; you can redistribute it and/or modify
 *  it under the terms of the GNU General Public License version 2 as
 *  published by the Free Software Foundation.
 *
 *  This program 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 General Public License for more details.
 *
 *  You should have received a copy of the GNU General Public License
 *  along with this program; if not, write to the Free Software
 *  Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA  02110-1301  USA
 *
 */

#ifdef HAVE_CONFIG_H
#include <config.h>
#endif

#include <stdint.h>
#include <string.h>
#include <errno.h>
#include <arpa/inet.h>
#include <glib.h>

#include "message.h"

int g_isi_msg_version_major(const GIsiMessage *msg)
{
	if (msg == NULL || msg->version == NULL)
		return -1;

	return msg->version->major;
}

int g_isi_msg_version_minor(const GIsiMessage *msg)
{
	if (msg == NULL || msg->version == NULL)
		return -1;

	return msg->version->minor;
}

int g_isi_msg_error(const GIsiMessage *msg)
{
	return msg != NULL ? -msg->error : -EINVAL;
}

const char *g_isi_msg_strerror(const GIsiMessage *msg)
{
	return strerror(-g_isi_msg_error(msg));
}

uint8_t g_isi_msg_resource(const GIsiMessage *msg)
{
	if (msg == NULL || msg->addr == NULL)
		return 0;

	return msg->addr->spn_resource;
}

uint16_t g_isi_msg_object(const GIsiMessage *msg)
{
	if (msg == NULL || msg->addr == NULL)
		return 0;

	return (msg->addr->spn_dev << 8) | msg->addr->spn_obj;
}

uint8_t g_isi_msg_id(const GIsiMessage *msg)
{
	const uint8_t *buf;

	if (msg == NULL || msg->data == NULL || msg->len < 2)
		return 0;

	buf = msg->data;

	return buf[1];
}

uint8_t g_isi_msg_utid(const GIsiMessage *msg)
{
	const uint8_t *buf;

	if (msg == NULL || msg->data == NULL || msg->len < 2)
		return 0;

	buf = msg->data;

	return buf[0];
}

size_t g_isi_msg_data_len(const GIsiMessage *msg)
{
	if (msg == NULL || msg->data == NULL)
		return 0;

	return msg->len - 2;
}

const void *g_isi_msg_data(const GIsiMessage *msg)
{
	if (msg == NULL || msg->data == NULL)
		return NULL;

	return (void *)msg->data + 2;
}

gboolean g_isi_msg_data_get_byte(const GIsiMessage *msg, unsigned offset,
					uint8_t *byte)
{
	const uint8_t *buf = g_isi_msg_data(msg);

	if (buf == NULL || g_isi_msg_data_len(msg) < offset)
		return FALSE;

	if (byte != NULL)
		*byte = buf[offset];

	return TRUE;
}

gboolean g_isi_msg_data_get_word(const GIsiMessage *msg, unsigned offset,
					uint16_t *word)
{
	const uint8_t *buf = g_isi_msg_data(msg);
	uint16_t val;

	if (buf == NULL || g_isi_msg_data_len(msg) < offset + 1)
		return FALSE;

	memcpy(&val, buf + offset, sizeof(uint16_t));

	if (word != NULL)
		*word = ntohs(val);

	return TRUE;
}

gboolean g_isi_msg_data_get_struct(const GIsiMessage *msg, unsigned offset,
					const void **type, size_t len)
{
	if (g_isi_msg_data_len(msg) < offset + len)
		return FALSE;

	if (type != NULL)
		*type = g_isi_msg_data(msg) + offset;

	return TRUE;
}