[libsigrok.git] / src / hardware / beaglelogic / beaglelogic_native.c

/*
 * This file is part of the libsigrok project.
 *
 * Copyright (C) 2014-17 Kumar Abhishek <abhishek@theembeddedkitchen.net>
 *
 * This program is free software: you can redistribute it and/or modify
 * it under the terms of the GNU General Public License as published by
 * the Free Software Foundation, either version 3 of the License, or
 * (at your option) any later version.
 *
 * 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, see <http://www.gnu.org/licenses/>.
 */

#include "protocol.h"
#include "beaglelogic.h"

static int beaglelogic_open_nonblock(struct dev_context *devc) {
	devc->fd = open(BEAGLELOGIC_DEV_NODE, O_RDONLY | O_NONBLOCK);
	return (devc->fd == -1 ? SR_ERR : SR_OK);
}

static int beaglelogic_close(struct dev_context *devc) {
	return close(devc->fd);
}

static int beaglelogic_get_buffersize(struct dev_context *devc) {
	return ioctl(devc->fd, IOCTL_BL_GET_BUFFER_SIZE, &devc->buffersize);
}

static int beaglelogic_set_buffersize(struct dev_context *devc) {
	return ioctl(devc->fd, IOCTL_BL_SET_BUFFER_SIZE, devc->buffersize);
}

/* This is treated differently as it gets a uint64_t while a uint32_t is read */
static int beaglelogic_get_samplerate(struct dev_context *devc) {
	uint32_t arg, err;
	err = ioctl(devc->fd, IOCTL_BL_GET_SAMPLE_RATE, &arg);
	devc->cur_samplerate = arg;
	return err;
}

static int beaglelogic_set_samplerate(struct dev_context *devc) {
	return ioctl(devc->fd, IOCTL_BL_SET_SAMPLE_RATE,
			(uint32_t)devc->cur_samplerate);
}

static int beaglelogic_get_sampleunit(struct dev_context *devc) {
	return ioctl(devc->fd, IOCTL_BL_GET_SAMPLE_UNIT, &devc->sampleunit);
}

static int beaglelogic_set_sampleunit(struct dev_context *devc) {
	return ioctl(devc->fd, IOCTL_BL_SET_SAMPLE_UNIT, devc->sampleunit);
}

static int beaglelogic_get_triggerflags(struct dev_context *devc) {
	return ioctl(devc->fd, IOCTL_BL_GET_TRIGGER_FLAGS, &devc->triggerflags);
}

static int beaglelogic_set_triggerflags(struct dev_context *devc) {
	return ioctl(devc->fd, IOCTL_BL_SET_TRIGGER_FLAGS, devc->triggerflags);
}

static int beaglelogic_get_lasterror(struct dev_context *devc) {
	int fd;
	char buf[16];
	int ret;

	if ((fd = open(BEAGLELOGIC_SYSFS_ATTR(lasterror), O_RDONLY)) == -1)
		return SR_ERR;

	if ((ret = read(fd, buf, 16)) < 0)
		return SR_ERR;

	close(fd);
	devc->last_error = strtoul(buf, NULL, 10);

	return SR_OK;
}

static int beaglelogic_start(struct dev_context *devc) {
	return ioctl(devc->fd, IOCTL_BL_START);
}

static int beaglelogic_stop(struct dev_context *devc) {
	return ioctl(devc->fd, IOCTL_BL_STOP);
}

static int beaglelogic_get_bufunitsize(struct dev_context *devc) {
	return ioctl(devc->fd, IOCTL_BL_GET_BUFUNIT_SIZE, &devc->bufunitsize);
}

static int beaglelogic_set_bufunitsize(struct dev_context *devc) {
	return ioctl(devc->fd, IOCTL_BL_SET_BUFUNIT_SIZE, devc->bufunitsize);
}

static int beaglelogic_mmap(struct dev_context *devc) {
	if (!devc->buffersize)
		beaglelogic_get_buffersize(devc);
	devc->sample_buf = mmap(NULL, devc->buffersize,
			PROT_READ, MAP_SHARED, devc->fd, 0);
	return (devc->sample_buf == MAP_FAILED ? -1 : SR_OK);
}

static int beaglelogic_munmap(struct dev_context *devc) {
	return munmap(devc->sample_buf, devc->buffersize);
}

SR_PRIV const struct beaglelogic_ops beaglelogic_native_ops = {
	.open = beaglelogic_open_nonblock,
	.close = beaglelogic_close,
	.get_buffersize = beaglelogic_get_buffersize,
	.set_buffersize = beaglelogic_set_buffersize,
	.get_samplerate = beaglelogic_get_samplerate,
	.set_samplerate = beaglelogic_set_samplerate,
	.get_sampleunit = beaglelogic_get_sampleunit,
	.set_sampleunit = beaglelogic_set_sampleunit,
	.get_triggerflags = beaglelogic_get_triggerflags,
	.set_triggerflags = beaglelogic_set_triggerflags,
	.start = beaglelogic_start,
	.stop = beaglelogic_stop,
	.get_lasterror = beaglelogic_get_lasterror,
	.get_bufunitsize = beaglelogic_get_bufunitsize,
	.set_bufunitsize = beaglelogic_set_bufunitsize,
	.mmap = beaglelogic_mmap,
	.munmap = beaglelogic_munmap,
};
Commit	Line	Data
88d2037b KA	1	/*
	2	* This file is part of the libsigrok project.
	3	*
3124d3bc	4	* Copyright (C) 2014-17 Kumar Abhishek <abhishek@theembeddedkitchen.net>
88d2037b KA	5	*
	6	* This program is free software: you can redistribute it and/or modify
	7	* it under the terms of the GNU General Public License as published by
	8	* the Free Software Foundation, either version 3 of the License, or
	9	* (at your option) any later version.
	10	*
	11	* This program is distributed in the hope that it will be useful,
	12	* but WITHOUT ANY WARRANTY; without even the implied warranty of
	13	* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
	14	* GNU General Public License for more details.
	15	*
	16	* You should have received a copy of the GNU General Public License
	17	* along with this program. If not, see <http://www.gnu.org/licenses/>.
	18	*/
	19
	20	#include "protocol.h"
	21	#include "beaglelogic.h"
	22
0bca2e75	23	static int beaglelogic_open_nonblock(struct dev_context *devc) {
88d2037b KA	24	devc->fd = open(BEAGLELOGIC_DEV_NODE, O_RDONLY \| O_NONBLOCK);
	25	return (devc->fd == -1 ? SR_ERR : SR_OK);
	26	}
	27
0bca2e75	28	static int beaglelogic_close(struct dev_context *devc) {
88d2037b KA	29	return close(devc->fd);
	30	}
	31
0bca2e75	32	static int beaglelogic_get_buffersize(struct dev_context *devc) {
88d2037b KA	33	return ioctl(devc->fd, IOCTL_BL_GET_BUFFER_SIZE, &devc->buffersize);
	34	}
	35
0bca2e75	36	static int beaglelogic_set_buffersize(struct dev_context *devc) {
88d2037b KA	37	return ioctl(devc->fd, IOCTL_BL_SET_BUFFER_SIZE, devc->buffersize);
	38	}
	39
	40	/* This is treated differently as it gets a uint64_t while a uint32_t is read */
0bca2e75	41	static int beaglelogic_get_samplerate(struct dev_context *devc) {
88d2037b KA	42	uint32_t arg, err;
	43	err = ioctl(devc->fd, IOCTL_BL_GET_SAMPLE_RATE, &arg);
	44	devc->cur_samplerate = arg;
	45	return err;
	46	}
	47
0bca2e75	48	static int beaglelogic_set_samplerate(struct dev_context *devc) {
88d2037b KA	49	return ioctl(devc->fd, IOCTL_BL_SET_SAMPLE_RATE,
	50	(uint32_t)devc->cur_samplerate);
	51	}
	52
0bca2e75	53	static int beaglelogic_get_sampleunit(struct dev_context *devc) {
88d2037b KA	54	return ioctl(devc->fd, IOCTL_BL_GET_SAMPLE_UNIT, &devc->sampleunit);
	55	}
	56
0bca2e75	57	static int beaglelogic_set_sampleunit(struct dev_context *devc) {
88d2037b KA	58	return ioctl(devc->fd, IOCTL_BL_SET_SAMPLE_UNIT, devc->sampleunit);
	59	}
	60
0bca2e75	61	static int beaglelogic_get_triggerflags(struct dev_context *devc) {
88d2037b KA	62	return ioctl(devc->fd, IOCTL_BL_GET_TRIGGER_FLAGS, &devc->triggerflags);
	63	}
	64
0bca2e75	65	static int beaglelogic_set_triggerflags(struct dev_context *devc) {
88d2037b KA	66	return ioctl(devc->fd, IOCTL_BL_SET_TRIGGER_FLAGS, devc->triggerflags);
	67	}
	68
0bca2e75	69	static int beaglelogic_get_lasterror(struct dev_context *devc) {
88d2037b KA	70	int fd;
	71	char buf[16];
	72	int ret;
	73
	74	if ((fd = open(BEAGLELOGIC_SYSFS_ATTR(lasterror), O_RDONLY)) == -1)
	75	return SR_ERR;
	76
	77	if ((ret = read(fd, buf, 16)) < 0)
	78	return SR_ERR;
	79
	80	close(fd);
	81	devc->last_error = strtoul(buf, NULL, 10);
	82
	83	return SR_OK;
	84	}
	85
0bca2e75	86	static int beaglelogic_start(struct dev_context *devc) {
88d2037b KA	87	return ioctl(devc->fd, IOCTL_BL_START);
	88	}
	89
0bca2e75	90	static int beaglelogic_stop(struct dev_context *devc) {
88d2037b KA	91	return ioctl(devc->fd, IOCTL_BL_STOP);
	92	}
	93
0bca2e75	94	static int beaglelogic_get_bufunitsize(struct dev_context *devc) {
88d2037b KA	95	return ioctl(devc->fd, IOCTL_BL_GET_BUFUNIT_SIZE, &devc->bufunitsize);
	96	}
	97
0bca2e75 KA	98	static int beaglelogic_set_bufunitsize(struct dev_context *devc) {
	99	return ioctl(devc->fd, IOCTL_BL_SET_BUFUNIT_SIZE, devc->bufunitsize);
	100	}
	101
	102	static int beaglelogic_mmap(struct dev_context *devc) {
88d2037b KA	103	if (!devc->buffersize)
	104	beaglelogic_get_buffersize(devc);
	105	devc->sample_buf = mmap(NULL, devc->buffersize,
	106	PROT_READ, MAP_SHARED, devc->fd, 0);
	107	return (devc->sample_buf == MAP_FAILED ? -1 : SR_OK);
	108	}
	109
0bca2e75	110	static int beaglelogic_munmap(struct dev_context *devc) {
88d2037b KA	111	return munmap(devc->sample_buf, devc->buffersize);
88d2037b KA	112	}
0bca2e75 KA	113
	114	SR_PRIV const struct beaglelogic_ops beaglelogic_native_ops = {
	115	.open = beaglelogic_open_nonblock,
	116	.close = beaglelogic_close,
	117	.get_buffersize = beaglelogic_get_buffersize,
	118	.set_buffersize = beaglelogic_set_buffersize,
	119	.get_samplerate = beaglelogic_get_samplerate,
	120	.set_samplerate = beaglelogic_set_samplerate,
	121	.get_sampleunit = beaglelogic_get_sampleunit,
	122	.set_sampleunit = beaglelogic_set_sampleunit,
	123	.get_triggerflags = beaglelogic_get_triggerflags,
	124	.set_triggerflags = beaglelogic_set_triggerflags,
	125	.start = beaglelogic_start,
	126	.stop = beaglelogic_stop,
	127	.get_lasterror = beaglelogic_get_lasterror,
	128	.get_bufunitsize = beaglelogic_get_bufunitsize,
	129	.set_bufunitsize = beaglelogic_set_bufunitsize,
	130	.mmap = beaglelogic_mmap,
	131	.munmap = beaglelogic_munmap,
	132	};