parser.c

/*
 * libtinyiiod - Tiny IIO Daemon Library
 *
 * Copyright (C) 2016 Analog Devices, Inc.
 * Author: Paul Cercueil <paul.cercueil@analog.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.
 *
 * 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.
 */

#include "tinyiiod-private.h"

#include "compat.h"

static int32_t parse_rw_string(struct tinyiiod *iiod, char *str, bool write)
{
	char *device, *channel, *attr, *ptr;
	bool is_channel = false, output = false;
	enum iio_attr_type type = IIO_ATTR_TYPE_DEVICE;
	long bytes;

	ptr = strchr(str, ' ');
	if (!ptr)
		return -EINVAL;

	*ptr = '\0';
	device = str;
	str = ptr + 1;

	if (!strncmp(str, "INPUT ", sizeof("INPUT ") - 1)) {
		is_channel = true;
		str += sizeof("INPUT ") - 1;
	} else if (!strncmp(str, "OUTPUT ", sizeof("OUTPUT ") - 1)) {
		is_channel = true;
		output = true;
		str += sizeof("OUTPUT ") - 1;
	} else if (!strncmp(str, "DEBUG ", sizeof("DEBUG ") - 1)) {
		type = IIO_ATTR_TYPE_DEBUG;
		str += sizeof("DEBUG ") - 1;
	} else if (!strncmp(str, "BUFFER ", sizeof("BUFFER ") - 1)) {
		type = IIO_ATTR_TYPE_BUFFER;
		str += sizeof("BUFFER ") - 1;
	}

	if (is_channel) {
		ptr = strchr(str, ' ');
		if (!ptr)
			return -EINVAL;

		*ptr = '\0';
		channel = str;
		str = ptr + 1;
	} else {
		channel = NULL;
	}

	ptr = strchr(str, ' ');
	if ((!!ptr) ^ write)
		return -EINVAL;

	attr = str;

	if (write) {
		*ptr = '\0';
		str = ptr + 1;
	} else {
		tinyiiod_do_read_attr(iiod, device, channel,
				      output, attr, type);
		return 0;
	}

	bytes = strtol(str, &ptr, 10);
	if (str == ptr || bytes < 0)
		return -EINVAL;

	tinyiiod_do_write_attr(iiod, device, channel,
			       output, attr, (size_t) bytes, type);

	return 0;
}

static int32_t parse_open_string(struct tinyiiod *iiod, char *str)
{
	char *device, *ptr;
	long samples_count;
	uint32_t mask = 0;
	bool cyclic = false;

	ptr = strchr(str, ' ');
	if (!ptr)
		return -EINVAL;

	*ptr = '\0';
	device = str;
	str = ptr + 1;

	samples_count = strtol(str, &ptr, 10);
	if (str == ptr || *ptr != ' ' || samples_count < 0)
		return -EINVAL;

	str = ptr + 1;

	mask = strtoul(str, &ptr, 16);

	if (*ptr == ' ') {
		str = ptr + 1;
		if (!strncmp(str, "CYCLIC", sizeof("CYCLIC") - 1))
			cyclic = true;
		else
			return -EINVAL;
	}

	tinyiiod_do_open(iiod, device, (size_t) samples_count, mask, cyclic);

	return 0;
}

static int32_t parse_timeout_string(struct tinyiiod *iiod, char *str)
{
	uint32_t timeout = strtoul(str, NULL, 10);

	return tinyiiod_set_timeout(iiod, timeout);
}

static int32_t parse_set_string(struct tinyiiod *iiod, char *str)
{
	char *device, *ptr;
	uint32_t buffers_count;

	ptr = strchr(str, ' ');
	if (!ptr)
		return -EINVAL;

	*ptr = '\0';
	device = str;
	str = ptr + 1;

	if (!strncmp(str, "BUFFERS_COUNT ", sizeof("BUFFERS_COUNT ") - 1))
		str += sizeof("BUFFERS_COUNT ") - 1;
	else
		return -EINVAL;

	buffers_count = strtol(str, NULL, 10);

	return tinyiiod_set_buffers_count(iiod, device, buffers_count);
}

static int32_t parse_writebuf_string(struct tinyiiod *iiod, char *str)
{
	char *device, *ptr;
	long bytes_count;

	ptr = strchr(str, ' ');
	if (!ptr)
		return -EINVAL;

	*ptr = '\0';
	device = str;
	str = ptr + 1;

	bytes_count = strtol(str, &ptr, 10);
	if (str == ptr || *ptr != '\0' || bytes_count < 0)
		return -EINVAL;

	return tinyiiod_do_writebuf(iiod, device, (size_t) bytes_count);
}

static int32_t parse_readbuf_string(struct tinyiiod *iiod, char *str)
{
	char *device, *ptr;
	long bytes_count;

	ptr = strchr(str, ' ');
	if (!ptr)
		return -EINVAL;

	*ptr = '\0';
	device = str;
	str = ptr + 1;

	bytes_count = strtol(str, &ptr, 10);
	if (str == ptr || *ptr != '\0' || bytes_count < 0)
		return -EINVAL;

	return tinyiiod_do_readbuf(iiod, device, (size_t) bytes_count);
}

static int32_t parse_gettrig_string(struct tinyiiod *iiod, char *str)
{
	char *device, token[] = " ";

	device = strtok(str, token);
	if (!device)
		return -EINVAL;

	return tinyiiod_do_gettrig(iiod, device);
}

static int32_t parse_settrig_string(struct tinyiiod *iiod, char *str)
{
	char *device, *trig, token[] = " ";

	device = strtok(str, token);
	if (!device)
		return -EINVAL;

	trig = strtok(NULL, token);
	if (!trig)
		return tinyiiod_do_settrig(iiod, device, "", 0);

	return tinyiiod_do_settrig(iiod, device, trig, strlen(trig));
}

int32_t tinyiiod_parse_string(struct tinyiiod *iiod, char *str)
{
	while (*str == '\n' || *str == '\r')
		str++;

	if (str[0] == '\0')
		return 0;

	if (!strncmp(str, "VERSION", sizeof("VERSION"))) {
		char buf[32];

		snprintf(buf, sizeof(buf), "%"PRIu16".%"PRIu16".%s\n",
			 TINYIIOD_VERSION_MAJOR,
			 TINYIIOD_VERSION_MINOR,
			 TINYIIOD_VERSION_GIT);
		tinyiiod_write_string(iiod, buf);
		return 0;
	}

	if (!strncmp(str, "PRINT", sizeof("PRINT"))) {
		tinyiiod_write_xml(iiod);
		return 0;
	}

	if (!strncmp(str, "READ ", sizeof("READ ") - 1))
		return parse_rw_string(iiod, str + sizeof("READ ") - 1, false);

	if (!strncmp(str, "WRITE ", sizeof("WRITE ") -1))
		return parse_rw_string(iiod, str + sizeof("WRITE ") - 1, true);

	if (!strncmp(str, "OPEN ", sizeof("OPEN ") -1))
		return parse_open_string(iiod, str + sizeof("OPEN ") - 1);

	if (!strncmp(str, "CLOSE ", sizeof("CLOSE ") -1)) {
		tinyiiod_do_close(iiod, str + sizeof("CLOSE ") - 1);
		return 0;
	}

	if (!strncmp(str, "READBUF ", sizeof("READBUF ") -1))
		return parse_readbuf_string(iiod, str + sizeof("READBUF ") - 1);

	if (!strncmp(str, "TIMEOUT ", sizeof("TIMEOUT ") - 1))
		return parse_timeout_string(iiod, str + sizeof("TIMEOUT ") - 1);

	if (!strncmp(str, "WRITEBUF ", sizeof("WRITEBUF ") -1))
		return parse_writebuf_string(iiod, str + sizeof("WRITEBUF ") - 1);

	if (!strncmp(str, "EXIT", sizeof("EXIT") - 1))
		return tinyiiod_do_close_instance(iiod);

	if (!strncmp(str, "GETTRIG", sizeof("GETTRIG") - 1))
		return parse_gettrig_string(iiod, str + sizeof("GETTRIG ") - 1);

	if (!strncmp(str, "SETTRIG", sizeof("SETTRIG") - 1))
		return parse_settrig_string(iiod, str + sizeof("SETTRIG ") - 1);

	if (!strncmp(str, "SET", sizeof("SET") - 1))
		return parse_set_string(iiod, str + sizeof("SET ") - 1);

	return -EINVAL;
}