[libsigrok.git] / hardware / zeroplus-logic-cube / api.c

/*
 * This file is part of the sigrok project.
 *
 * Copyright (C) 2010-2012 Bert Vermeulen <bert@biot.com>
 *
 * 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"

#define USB_VENDOR			0x0c12

#define VENDOR_NAME			"ZEROPLUS"
#define MODEL_NAME			"Logic Cube LAP-C"
#define MODEL_VERSION			NULL

#define NUM_PROBES			16
#define USB_INTERFACE			0
#define USB_CONFIGURATION		1
#define NUM_TRIGGER_STAGES		4
#define TRIGGER_TYPE 			"01"

#define PACKET_SIZE			2048	/* ?? */

//#define ZP_EXPERIMENTAL

typedef struct {
	unsigned short vid;
	unsigned short pid;
	char *model_name;
	unsigned int channels;
	unsigned int sample_depth;	/* In Ksamples/channel */
	unsigned int max_sampling_freq;
} model_t;

/*
 * Note -- 16032, 16064 and 16128 *usually* -- but not always -- have the
 * same 128K sample depth.
 */
static model_t zeroplus_models[] = {
	{0x0c12, 0x7009, "LAP-C(16064)",  16, 64,   100},
	{0x0c12, 0x700A, "LAP-C(16128)",  16, 128,  200},
	/* TODO: we don't know anything about these
	{0x0c12, 0x700B, "LAP-C(32128)",  32, 128,  200},
	{0x0c12, 0x700C, "LAP-C(321000)", 32, 1024, 200},
	{0x0c12, 0x700D, "LAP-C(322000)", 32, 2048, 200},
	*/
	{0x0c12, 0x700E, "LAP-C(16032)",  16, 32,   100},
	{0x0c12, 0x7016, "LAP-C(162000)", 16, 2048, 200},
	{ 0, 0, 0, 0, 0, 0 }
};

static const int hwcaps[] = {
	SR_CONF_LOGIC_ANALYZER,
	SR_CONF_SAMPLERATE,
	SR_CONF_CAPTURE_RATIO,

	/* These are really implemented in the driver, not the hardware. */
	SR_CONF_LIMIT_SAMPLES,
	0,
};

/*
 * ZEROPLUS LAP-C (16032) numbers the 16 probes A0-A7 and B0-B7.
 * We currently ignore other untested/unsupported devices here.
 */
static const char *probe_names[NUM_PROBES + 1] = {
	"A0", "A1", "A2", "A3", "A4", "A5", "A6", "A7",
	"B0", "B1", "B2", "B3", "B4", "B5", "B6", "B7",
	NULL,
};

/* List of struct sr_dev_inst, maintained by dev_open()/dev_close(). */
SR_PRIV struct sr_dev_driver zeroplus_logic_cube_driver_info;
static struct sr_dev_driver *di = &zeroplus_logic_cube_driver_info;

/*
 * The hardware supports more samplerates than these, but these are the
 * options hardcoded into the vendor's Windows GUI.
 */

/*
 * TODO: We shouldn't support 150MHz and 200MHz on devices that don't go up
 * that high.
 */
const uint64_t zp_supported_samplerates[] = {
	SR_HZ(100),
	SR_HZ(500),
	SR_KHZ(1),
	SR_KHZ(5),
	SR_KHZ(25),
	SR_KHZ(50),
	SR_KHZ(100),
	SR_KHZ(200),
	SR_KHZ(400),
	SR_KHZ(800),
	SR_MHZ(1),
	SR_MHZ(10),
	SR_MHZ(25),
	SR_MHZ(50),
	SR_MHZ(80),
	SR_MHZ(100),
	SR_MHZ(150),
	SR_MHZ(200),
	0,
};

static const struct sr_samplerates samplerates = {
	.low  = 0,
	.high = 0,
	.step = 0,
	.list = zp_supported_samplerates,
};

static int hw_dev_close(struct sr_dev_inst *sdi);

#if 0
static int configure_probes(const struct sr_dev_inst *sdi)
{
	struct dev_context *devc;
	const struct sr_probe *probe;
	const GSList *l;
	int probe_bit, stage, i;
	char *tc;

	/* Note: sdi and sdi->priv are non-NULL, the caller checked this. */
	devc = sdi->priv;

	devc->probe_mask = 0;
	for (i = 0; i < NUM_TRIGGER_STAGES; i++) {
		devc->trigger_mask[i] = 0;
		devc->trigger_value[i] = 0;
	}

	stage = -1;
	for (l = sdi->probes; l; l = l->next) {
		probe = (struct sr_probe *)l->data;
		if (probe->enabled == FALSE)
			continue;
		probe_bit = 1 << (probe->index);
		devc->probe_mask |= probe_bit;

		if (probe->trigger) {
			stage = 0;
			for (tc = probe->trigger; *tc; tc++) {
				devc->trigger_mask[stage] |= probe_bit;
				if (*tc == '1')
					devc->trigger_value[stage] |= probe_bit;
				stage++;
				if (stage > NUM_TRIGGER_STAGES)
					return SR_ERR;
			}
		}
	}

	return SR_OK;
}
#endif

static int configure_probes(const struct sr_dev_inst *sdi)
{
	struct dev_context *devc;
	const GSList *l;
	const struct sr_probe *probe;
	char *tc;
	int type;

	/* Note: sdi and sdi->priv are non-NULL, the caller checked this. */
	devc = sdi->priv;

	for (l = sdi->probes; l; l = l->next) {
		probe = (struct sr_probe *)l->data;
		if (probe->enabled == FALSE)
			continue;

		if ((tc = probe->trigger)) {
			switch (*tc) {
			case '1':
				type = TRIGGER_HIGH;
				break;
			case '0':
				type = TRIGGER_LOW;
				break;
#if 0
			case 'r':
				type = TRIGGER_POSEDGE;
				break;
			case 'f':
				type = TRIGGER_NEGEDGE;
				break;
			case 'c':
				type = TRIGGER_ANYEDGE;
				break;
#endif
			default:
				return SR_ERR;
			}
			analyzer_add_trigger(probe->index, type);
			devc->trigger = 1;
		}
	}

	return SR_OK;
}

static int clear_instances(void)
{
	GSList *l;
	struct sr_dev_inst *sdi;
	struct drv_context *drvc;
	struct dev_context *devc;

	drvc = di->priv;
	for (l = drvc->instances; l; l = l->next) {
		sdi = l->data;
		if (!(devc = sdi->priv)) {
			/* Log error, but continue cleaning up the rest. */
			sr_err("%s: sdi->priv was NULL, continuing", __func__);
			continue;
		}
		sr_usb_dev_inst_free(devc->usb);
		/* Properly close all devices... */
		hw_dev_close(sdi);
		/* ...and free all their memory. */
		sr_dev_inst_free(sdi);
	}
	g_slist_free(drvc->instances);
	drvc->instances = NULL;

	return SR_OK;
}

static int hw_init(struct sr_context *sr_ctx)
{
	return std_hw_init(sr_ctx, di, "zeroplus: ");
}

static GSList *hw_scan(GSList *options)
{
	struct sr_dev_inst *sdi;
	struct sr_probe *probe;
	struct drv_context *drvc;
	struct dev_context *devc;
	model_t *prof;
	struct libusb_device_descriptor des;
	libusb_device **devlist;
	GSList *devices;
	int ret, devcnt, i, j;

	(void)options;

	drvc = di->priv;

	devices = NULL;

	clear_instances();

	/* Find all ZEROPLUS analyzers and add them to device list. */
	devcnt = 0;
	libusb_get_device_list(drvc->sr_ctx->libusb_ctx, &devlist); /* TODO: Errors. */

	for (i = 0; devlist[i]; i++) {
		ret = libusb_get_device_descriptor(devlist[i], &des);
		if (ret != 0) {
			sr_err("Failed to get device descriptor: %s.",
			       libusb_error_name(ret));
			continue;
		}

		prof = NULL;
		for (j = 0; j < zeroplus_models[j].vid; j++) {
			if (des.idVendor == zeroplus_models[j].vid &&
				des.idProduct == zeroplus_models[j].pid) {
				prof = &zeroplus_models[j];
			}
		}
		/* Skip if the device was not found */
		if (!prof)
			continue;
		sr_info("Found ZEROPLUS model %s.", prof->model_name);

		/* Register the device with libsigrok. */
		if (!(sdi = sr_dev_inst_new(devcnt, SR_ST_INACTIVE,
				VENDOR_NAME, prof->model_name, NULL))) {
			sr_err("%s: sr_dev_inst_new failed", __func__);
			return NULL;
		}
		sdi->driver = di;

		/* Allocate memory for our private driver context. */
		if (!(devc = g_try_malloc0(sizeof(struct dev_context)))) {
			sr_err("Device context malloc failed.");
			return NULL;
		}
		sdi->priv = devc;
		devc->num_channels = prof->channels;
#ifdef ZP_EXPERIMENTAL
		devc->max_memory_size = 128 * 1024;
		devc->max_samplerate = 200;
#else
		devc->max_memory_size = prof->sample_depth * 1024;
		devc->max_samplerate = prof->max_sampling_freq;
#endif
		devc->max_samplerate *= SR_MHZ(1);
		devc->memory_size = MEMORY_SIZE_8K;
		// memset(devc->trigger_buffer, 0, NUM_TRIGGER_STAGES);

		/* Fill in probelist according to this device's profile. */
		for (j = 0; j < devc->num_channels; j++) {
			if (!(probe = sr_probe_new(j, SR_PROBE_LOGIC, TRUE,
					probe_names[j])))
				return NULL;
			sdi->probes = g_slist_append(sdi->probes, probe);
		}

		devices = g_slist_append(devices, sdi);
		drvc->instances = g_slist_append(drvc->instances, sdi);
		devc->usb = sr_usb_dev_inst_new(
			libusb_get_bus_number(devlist[i]),
			libusb_get_device_address(devlist[i]), NULL);
		devcnt++;

	}
	libusb_free_device_list(devlist, 1);

	return devices;
}

static GSList *hw_dev_list(void)
{
	return ((struct drv_context *)(di->priv))->instances;
}

static int hw_dev_open(struct sr_dev_inst *sdi)
{
	struct dev_context *devc;
	struct drv_context *drvc = di->priv;
	libusb_device **devlist, *dev;
	struct libusb_device_descriptor des;
	int device_count, ret, i;

	if (!(devc = sdi->priv)) {
		sr_err("%s: sdi->priv was NULL", __func__);
		return SR_ERR_ARG;
	}

	device_count = libusb_get_device_list(drvc->sr_ctx->libusb_ctx,
					      &devlist);
	if (device_count < 0) {
		sr_err("Failed to retrieve device list.");
		return SR_ERR;
	}

	dev = NULL;
	for (i = 0; i < device_count; i++) {
		if ((ret = libusb_get_device_descriptor(devlist[i], &des))) {
			sr_err("Failed to get device descriptor: %s.",
			       libusb_error_name(ret));
			continue;
		}
		if (libusb_get_bus_number(devlist[i]) == devc->usb->bus
		    && libusb_get_device_address(devlist[i]) == devc->usb->address) {
			dev = devlist[i];
			break;
		}
	}
	if (!dev) {
		sr_err("Device on bus %d address %d disappeared!",
		       devc->usb->bus, devc->usb->address);
		return SR_ERR;
	}

	if (!(ret = libusb_open(dev, &(devc->usb->devhdl)))) {
		sdi->status = SR_ST_ACTIVE;
		sr_info("Opened device %d on %d.%d interface %d.",
			sdi->index, devc->usb->bus,
			devc->usb->address, USB_INTERFACE);
	} else {
		sr_err("Failed to open device: %s.", libusb_error_name(ret));
		return SR_ERR;
	}

	ret = libusb_set_configuration(devc->usb->devhdl, USB_CONFIGURATION);
	if (ret < 0) {
		sr_err("Unable to set USB configuration %d: %s.",
		       USB_CONFIGURATION, libusb_error_name(ret));
		return SR_ERR;
	}

	ret = libusb_claim_interface(devc->usb->devhdl, USB_INTERFACE);
	if (ret != 0) {
		sr_err("Unable to claim interface: %s.",
		       libusb_error_name(ret));
		return SR_ERR;
	}

	/* Set default configuration after power on */
	if (analyzer_read_status(devc->usb->devhdl) == 0)
		analyzer_configure(devc->usb->devhdl);

	analyzer_reset(devc->usb->devhdl);
	analyzer_initialize(devc->usb->devhdl);

	//analyzer_set_memory_size(MEMORY_SIZE_512K);
	// analyzer_set_freq(g_freq, g_freq_scale);
	analyzer_set_trigger_count(1);
	// analyzer_set_ramsize_trigger_address((((100 - g_pre_trigger)
	// * get_memory_size(g_memory_size)) / 100) >> 2);

#if 0
	if (g_double_mode == 1)
		analyzer_set_compression(COMPRESSION_DOUBLE);
	else if (g_compression == 1)
		analyzer_set_compression(COMPRESSION_ENABLE);
	else
#endif
	analyzer_set_compression(COMPRESSION_NONE);

	if (devc->cur_samplerate == 0) {
		/* Samplerate hasn't been set. Default to 1MHz. */
		analyzer_set_freq(1, FREQ_SCALE_MHZ);
		devc->cur_samplerate = SR_MHZ(1);
	}

	return SR_OK;
}

static int hw_dev_close(struct sr_dev_inst *sdi)
{
	struct dev_context *devc;

	devc = sdi->priv;

	if (!devc->usb->devhdl)
		return SR_ERR;

	sr_info("Closing device %d on %d.%d interface %d.", sdi->index,
		devc->usb->bus, devc->usb->address, USB_INTERFACE);
	libusb_release_interface(devc->usb->devhdl, USB_INTERFACE);
	libusb_reset_device(devc->usb->devhdl);
	libusb_close(devc->usb->devhdl);
	devc->usb->devhdl = NULL;
	sdi->status = SR_ST_INACTIVE;

	return SR_OK;
}

static int hw_cleanup(void)
{
	struct drv_context *drvc;

	if (!(drvc = di->priv))
		return SR_OK;

	clear_instances();

	return SR_OK;
}

static int config_get(int id, const void **data, const struct sr_dev_inst *sdi)
{
	struct dev_context *devc;

	switch (id) {
	case SR_CONF_SAMPLERATE:
		if (sdi) {
			devc = sdi->priv;
			*data = &devc->cur_samplerate;
			sr_spew("Returning samplerate: %" PRIu64 "Hz.",
				devc->cur_samplerate);
		} else
			return SR_ERR;
		break;
	default:
		return SR_ERR_ARG;
	}

	return SR_OK;
}

static int config_set(int id, const void *value, const struct sr_dev_inst *sdi)
{
	struct dev_context *devc;

	if (!sdi) {
		sr_err("%s: sdi was NULL", __func__);
		return SR_ERR_ARG;
	}

	if (!(devc = sdi->priv)) {
		sr_err("%s: sdi->priv was NULL", __func__);
		return SR_ERR_ARG;
	}

	switch (id) {
	case SR_CONF_SAMPLERATE:
		return zp_set_samplerate(devc, *(const uint64_t *)value);
	case SR_CONF_LIMIT_SAMPLES:
		return set_limit_samples(devc, *(const uint64_t *)value);
	case SR_CONF_CAPTURE_RATIO:
		return set_capture_ratio(devc, *(const uint64_t *)value);
	default:
		return SR_ERR;
	}
}

static int config_list(int key, const void **data, const struct sr_dev_inst *sdi)
{
	(void)sdi;

	switch (key) {
	case SR_CONF_DEVICE_OPTIONS:
		*data = hwcaps;
		break;
	case SR_CONF_SAMPLERATE:
		*data = &samplerates;
		break;
	case SR_CONF_TRIGGER_TYPE:
		*data = TRIGGER_TYPE;
		break;
	default:
		return SR_ERR_ARG;
	}

	return SR_OK;
}

static int hw_dev_acquisition_start(const struct sr_dev_inst *sdi,
		void *cb_data)
{
	struct sr_datafeed_packet packet;
	struct sr_datafeed_logic logic;
	//uint64_t samples_read;
	int res;
	unsigned int packet_num;
	unsigned int n;
	unsigned char *buf;
	struct dev_context *devc;

	if (!(devc = sdi->priv)) {
		sr_err("%s: sdi->priv was NULL", __func__);
		return SR_ERR_ARG;
	}

	if (configure_probes(sdi) != SR_OK) {
		sr_err("Failed to configure probes.");
		return SR_ERR;
	}

	set_triggerbar(devc);

	/* push configured settings to device */
	analyzer_configure(devc->usb->devhdl);

	analyzer_start(devc->usb->devhdl);
	sr_info("Waiting for data.");
	analyzer_wait_data(devc->usb->devhdl);

	sr_info("Stop address    = 0x%x.",
		analyzer_get_stop_address(devc->usb->devhdl));
	sr_info("Now address     = 0x%x.",
		analyzer_get_now_address(devc->usb->devhdl));
	sr_info("Trigger address = 0x%x.",
		analyzer_get_trigger_address(devc->usb->devhdl));

	/* Send header packet to the session bus. */
	std_session_send_df_header(cb_data, DRIVER_LOG_DOMAIN);

	if (!(buf = g_try_malloc(PACKET_SIZE))) {
		sr_err("Packet buffer malloc failed.");
		return SR_ERR_MALLOC;
	}

	//samples_read = 0;
	analyzer_read_start(devc->usb->devhdl);
	/* Send the incoming transfer to the session bus. */
	n = get_memory_size(devc->memory_size);
	if (devc->max_memory_size * 4 < n)
		n = devc->max_memory_size * 4;
	for (packet_num = 0; packet_num < n / PACKET_SIZE; packet_num++) {
		res = analyzer_read_data(devc->usb->devhdl, buf, PACKET_SIZE);
		sr_info("Tried to read %d bytes, actually read %d bytes.",
			PACKET_SIZE, res);

		packet.type = SR_DF_LOGIC;
		packet.payload = &logic;
		logic.length = PACKET_SIZE;
		logic.unitsize = 4;
		logic.data = buf;
		sr_session_send(cb_data, &packet);
		//samples_read += res / 4;
	}
	analyzer_read_stop(devc->usb->devhdl);
	g_free(buf);

	packet.type = SR_DF_END;
	sr_session_send(cb_data, &packet);

	return SR_OK;
}

/* TODO: This stops acquisition on ALL devices, ignoring dev_index. */
static int hw_dev_acquisition_stop(struct sr_dev_inst *sdi, void *cb_data)
{
	struct sr_datafeed_packet packet;
	struct dev_context *devc;

	packet.type = SR_DF_END;
	sr_session_send(cb_data, &packet);

	if (!(devc = sdi->priv)) {
		sr_err("%s: sdi->priv was NULL", __func__);
		return SR_ERR_BUG;
	}

	analyzer_reset(devc->usb->devhdl);
	/* TODO: Need to cancel and free any queued up transfers. */

	return SR_OK;
}

SR_PRIV struct sr_dev_driver zeroplus_logic_cube_driver_info = {
	.name = "zeroplus-logic-cube",
	.longname = "ZEROPLUS Logic Cube LAP-C series",
	.api_version = 1,
	.init = hw_init,
	.cleanup = hw_cleanup,
	.scan = hw_scan,
	.dev_list = hw_dev_list,
	.dev_clear = hw_cleanup,
	.config_get = config_get,
	.config_set = config_set,
	.config_list = config_list,
	.dev_open = hw_dev_open,
	.dev_close = hw_dev_close,
	.dev_acquisition_start = hw_dev_acquisition_start,
	.dev_acquisition_stop = hw_dev_acquisition_stop,
	.priv = NULL,
};
Commit	Line	Data
	1	/*
	2	* This file is part of the sigrok project.
	3	*
	4	* Copyright (C) 2010-2012 Bert Vermeulen <bert@biot.com>
	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
	22	#define USB_VENDOR 0x0c12
	23
	24	#define VENDOR_NAME "ZEROPLUS"
	25	#define MODEL_NAME "Logic Cube LAP-C"
	26	#define MODEL_VERSION NULL
	27
	28	#define NUM_PROBES 16
	29	#define USB_INTERFACE 0
	30	#define USB_CONFIGURATION 1
	31	#define NUM_TRIGGER_STAGES 4
	32	#define TRIGGER_TYPE "01"
	33
	34	#define PACKET_SIZE 2048 /* ?? */
	35
	36	//#define ZP_EXPERIMENTAL
	37
	38	typedef struct {
	39	unsigned short vid;
	40	unsigned short pid;
	41	char *model_name;
	42	unsigned int channels;
	43	unsigned int sample_depth; /* In Ksamples/channel */
	44	unsigned int max_sampling_freq;
	45	} model_t;
	46
	47	/*
	48	* Note -- 16032, 16064 and 16128 usually -- but not always -- have the
	49	* same 128K sample depth.
	50	*/
	51	static model_t zeroplus_models[] = {
	52	{0x0c12, 0x7009, "LAP-C(16064)", 16, 64, 100},
	53	{0x0c12, 0x700A, "LAP-C(16128)", 16, 128, 200},
	54	/* TODO: we don't know anything about these
	55	{0x0c12, 0x700B, "LAP-C(32128)", 32, 128, 200},
	56	{0x0c12, 0x700C, "LAP-C(321000)", 32, 1024, 200},
	57	{0x0c12, 0x700D, "LAP-C(322000)", 32, 2048, 200},
	58	*/
	59	{0x0c12, 0x700E, "LAP-C(16032)", 16, 32, 100},
	60	{0x0c12, 0x7016, "LAP-C(162000)", 16, 2048, 200},
	61	{ 0, 0, 0, 0, 0, 0 }
	62	};
	63
	64	static const int hwcaps[] = {
	65	SR_CONF_LOGIC_ANALYZER,
	66	SR_CONF_SAMPLERATE,
	67	SR_CONF_CAPTURE_RATIO,
	68
	69	/* These are really implemented in the driver, not the hardware. */
	70	SR_CONF_LIMIT_SAMPLES,
	71	0,
	72	};
	73
	74	/*
	75	* ZEROPLUS LAP-C (16032) numbers the 16 probes A0-A7 and B0-B7.
	76	* We currently ignore other untested/unsupported devices here.
	77	*/
	78	static const char *probe_names[NUM_PROBES + 1] = {
	79	"A0", "A1", "A2", "A3", "A4", "A5", "A6", "A7",
	80	"B0", "B1", "B2", "B3", "B4", "B5", "B6", "B7",
	81	NULL,
	82	};
	83
	84	/* List of struct sr_dev_inst, maintained by dev_open()/dev_close(). */
	85	SR_PRIV struct sr_dev_driver zeroplus_logic_cube_driver_info;
	86	static struct sr_dev_driver *di = &zeroplus_logic_cube_driver_info;
	87
	88	/*
	89	* The hardware supports more samplerates than these, but these are the
	90	* options hardcoded into the vendor's Windows GUI.
	91	*/
	92
	93	/*
	94	* TODO: We shouldn't support 150MHz and 200MHz on devices that don't go up
	95	* that high.
	96	*/
	97	const uint64_t zp_supported_samplerates[] = {
	98	SR_HZ(100),
	99	SR_HZ(500),
	100	SR_KHZ(1),
	101	SR_KHZ(5),
	102	SR_KHZ(25),
	103	SR_KHZ(50),
	104	SR_KHZ(100),
	105	SR_KHZ(200),
	106	SR_KHZ(400),
	107	SR_KHZ(800),
	108	SR_MHZ(1),
	109	SR_MHZ(10),
	110	SR_MHZ(25),
	111	SR_MHZ(50),
	112	SR_MHZ(80),
	113	SR_MHZ(100),
	114	SR_MHZ(150),
	115	SR_MHZ(200),
	116	0,
	117	};
	118
	119	static const struct sr_samplerates samplerates = {
	120	.low = 0,
	121	.high = 0,
	122	.step = 0,
	123	.list = zp_supported_samplerates,
	124	};
	125
	126	static int hw_dev_close(struct sr_dev_inst *sdi);
	127
	128	#if 0
	129	static int configure_probes(const struct sr_dev_inst *sdi)
	130	{
	131	struct dev_context *devc;
	132	const struct sr_probe *probe;
	133	const GSList *l;
	134	int probe_bit, stage, i;
	135	char *tc;
	136
	137	/* Note: sdi and sdi->priv are non-NULL, the caller checked this. */
	138	devc = sdi->priv;
	139
	140	devc->probe_mask = 0;
	141	for (i = 0; i < NUM_TRIGGER_STAGES; i++) {
	142	devc->trigger_mask[i] = 0;
	143	devc->trigger_value[i] = 0;
	144	}
	145
	146	stage = -1;
	147	for (l = sdi->probes; l; l = l->next) {
	148	probe = (struct sr_probe *)l->data;
	149	if (probe->enabled == FALSE)
	150	continue;
	151	probe_bit = 1 << (probe->index);
	152	devc->probe_mask \|= probe_bit;
	153
	154	if (probe->trigger) {
	155	stage = 0;
	156	for (tc = probe->trigger; *tc; tc++) {
	157	devc->trigger_mask[stage] \|= probe_bit;
	158	if (*tc == '1')
	159	devc->trigger_value[stage] \|= probe_bit;
	160	stage++;
	161	if (stage > NUM_TRIGGER_STAGES)
	162	return SR_ERR;
	163	}
	164	}
	165	}
	166
	167	return SR_OK;
	168	}
	169	#endif
	170
	171	static int configure_probes(const struct sr_dev_inst *sdi)
	172	{
	173	struct dev_context *devc;
	174	const GSList *l;
	175	const struct sr_probe *probe;
	176	char *tc;
	177	int type;
	178
	179	/* Note: sdi and sdi->priv are non-NULL, the caller checked this. */
	180	devc = sdi->priv;
	181
	182	for (l = sdi->probes; l; l = l->next) {
	183	probe = (struct sr_probe *)l->data;
	184	if (probe->enabled == FALSE)
	185	continue;
	186
	187	if ((tc = probe->trigger)) {
	188	switch (*tc) {
	189	case '1':
	190	type = TRIGGER_HIGH;
	191	break;
	192	case '0':
	193	type = TRIGGER_LOW;
	194	break;
	195	#if 0
	196	case 'r':
	197	type = TRIGGER_POSEDGE;
	198	break;
	199	case 'f':
	200	type = TRIGGER_NEGEDGE;
	201	break;
	202	case 'c':
	203	type = TRIGGER_ANYEDGE;
	204	break;
	205	#endif
	206	default:
	207	return SR_ERR;
	208	}
	209	analyzer_add_trigger(probe->index, type);
	210	devc->trigger = 1;
	211	}
	212	}
	213
	214	return SR_OK;
	215	}
	216
	217	static int clear_instances(void)
	218	{
	219	GSList *l;
	220	struct sr_dev_inst *sdi;
	221	struct drv_context *drvc;
	222	struct dev_context *devc;
	223
	224	drvc = di->priv;
	225	for (l = drvc->instances; l; l = l->next) {
	226	sdi = l->data;
	227	if (!(devc = sdi->priv)) {
	228	/* Log error, but continue cleaning up the rest. */
	229	sr_err("%s: sdi->priv was NULL, continuing", __func__);
	230	continue;
	231	}
	232	sr_usb_dev_inst_free(devc->usb);
	233	/* Properly close all devices... */
	234	hw_dev_close(sdi);
	235	/* ...and free all their memory. */
	236	sr_dev_inst_free(sdi);
	237	}
	238	g_slist_free(drvc->instances);
	239	drvc->instances = NULL;
	240
	241	return SR_OK;
	242	}
	243
	244	static int hw_init(struct sr_context *sr_ctx)
	245	{
	246	return std_hw_init(sr_ctx, di, "zeroplus: ");
	247	}
	248
	249	static GSList hw_scan(GSList options)
	250	{
	251	struct sr_dev_inst *sdi;
	252	struct sr_probe *probe;
	253	struct drv_context *drvc;
	254	struct dev_context *devc;
	255	model_t *prof;
	256	struct libusb_device_descriptor des;
	257	libusb_device **devlist;
	258	GSList *devices;
	259	int ret, devcnt, i, j;
	260
	261	(void)options;
	262
	263	drvc = di->priv;
	264
	265	devices = NULL;
	266
	267	clear_instances();
	268
	269	/* Find all ZEROPLUS analyzers and add them to device list. */
	270	devcnt = 0;
	271	libusb_get_device_list(drvc->sr_ctx->libusb_ctx, &devlist); /* TODO: Errors. */
	272
	273	for (i = 0; devlist[i]; i++) {
	274	ret = libusb_get_device_descriptor(devlist[i], &des);
	275	if (ret != 0) {
	276	sr_err("Failed to get device descriptor: %s.",
	277	libusb_error_name(ret));
	278	continue;
	279	}
	280
	281	prof = NULL;
	282	for (j = 0; j < zeroplus_models[j].vid; j++) {
	283	if (des.idVendor == zeroplus_models[j].vid &&
	284	des.idProduct == zeroplus_models[j].pid) {
	285	prof = &zeroplus_models[j];
	286	}
	287	}
	288	/* Skip if the device was not found */
	289	if (!prof)
	290	continue;
	291	sr_info("Found ZEROPLUS model %s.", prof->model_name);
	292
	293	/* Register the device with libsigrok. */
	294	if (!(sdi = sr_dev_inst_new(devcnt, SR_ST_INACTIVE,
	295	VENDOR_NAME, prof->model_name, NULL))) {
	296	sr_err("%s: sr_dev_inst_new failed", __func__);
	297	return NULL;
	298	}
	299	sdi->driver = di;
	300
	301	/* Allocate memory for our private driver context. */
	302	if (!(devc = g_try_malloc0(sizeof(struct dev_context)))) {
	303	sr_err("Device context malloc failed.");
	304	return NULL;
	305	}
	306	sdi->priv = devc;
	307	devc->num_channels = prof->channels;
	308	#ifdef ZP_EXPERIMENTAL
	309	devc->max_memory_size = 128 * 1024;
	310	devc->max_samplerate = 200;
	311	#else
	312	devc->max_memory_size = prof->sample_depth * 1024;
	313	devc->max_samplerate = prof->max_sampling_freq;
	314	#endif
	315	devc->max_samplerate *= SR_MHZ(1);
	316	devc->memory_size = MEMORY_SIZE_8K;
	317	// memset(devc->trigger_buffer, 0, NUM_TRIGGER_STAGES);
	318
	319	/* Fill in probelist according to this device's profile. */
	320	for (j = 0; j < devc->num_channels; j++) {
	321	if (!(probe = sr_probe_new(j, SR_PROBE_LOGIC, TRUE,
	322	probe_names[j])))
	323	return NULL;
	324	sdi->probes = g_slist_append(sdi->probes, probe);
	325	}
	326
	327	devices = g_slist_append(devices, sdi);
	328	drvc->instances = g_slist_append(drvc->instances, sdi);
	329	devc->usb = sr_usb_dev_inst_new(
	330	libusb_get_bus_number(devlist[i]),
	331	libusb_get_device_address(devlist[i]), NULL);
	332	devcnt++;
	333
	334	}
	335	libusb_free_device_list(devlist, 1);
	336
	337	return devices;
	338	}
	339
	340	static GSList *hw_dev_list(void)
	341	{
	342	return ((struct drv_context *)(di->priv))->instances;
	343	}
	344
	345	static int hw_dev_open(struct sr_dev_inst *sdi)
	346	{
	347	struct dev_context *devc;
	348	struct drv_context *drvc = di->priv;
	349	libusb_device *devlist, dev;
	350	struct libusb_device_descriptor des;
	351	int device_count, ret, i;
	352
	353	if (!(devc = sdi->priv)) {
	354	sr_err("%s: sdi->priv was NULL", __func__);
	355	return SR_ERR_ARG;
	356	}
	357
	358	device_count = libusb_get_device_list(drvc->sr_ctx->libusb_ctx,
	359	&devlist);
	360	if (device_count < 0) {
	361	sr_err("Failed to retrieve device list.");
	362	return SR_ERR;
	363	}
	364
	365	dev = NULL;
	366	for (i = 0; i < device_count; i++) {
	367	if ((ret = libusb_get_device_descriptor(devlist[i], &des))) {
	368	sr_err("Failed to get device descriptor: %s.",
	369	libusb_error_name(ret));
	370	continue;
	371	}
	372	if (libusb_get_bus_number(devlist[i]) == devc->usb->bus
	373	&& libusb_get_device_address(devlist[i]) == devc->usb->address) {
	374	dev = devlist[i];
	375	break;
	376	}
	377	}
	378	if (!dev) {
	379	sr_err("Device on bus %d address %d disappeared!",
	380	devc->usb->bus, devc->usb->address);
	381	return SR_ERR;
	382	}
	383
	384	if (!(ret = libusb_open(dev, &(devc->usb->devhdl)))) {
	385	sdi->status = SR_ST_ACTIVE;
	386	sr_info("Opened device %d on %d.%d interface %d.",
	387	sdi->index, devc->usb->bus,
	388	devc->usb->address, USB_INTERFACE);
	389	} else {
	390	sr_err("Failed to open device: %s.", libusb_error_name(ret));
	391	return SR_ERR;
	392	}
	393
	394	ret = libusb_set_configuration(devc->usb->devhdl, USB_CONFIGURATION);
	395	if (ret < 0) {
	396	sr_err("Unable to set USB configuration %d: %s.",
	397	USB_CONFIGURATION, libusb_error_name(ret));
	398	return SR_ERR;
	399	}
	400
	401	ret = libusb_claim_interface(devc->usb->devhdl, USB_INTERFACE);
	402	if (ret != 0) {
	403	sr_err("Unable to claim interface: %s.",
	404	libusb_error_name(ret));
	405	return SR_ERR;
	406	}
	407
	408	/* Set default configuration after power on */
	409	if (analyzer_read_status(devc->usb->devhdl) == 0)
	410	analyzer_configure(devc->usb->devhdl);
	411
	412	analyzer_reset(devc->usb->devhdl);
	413	analyzer_initialize(devc->usb->devhdl);
	414
	415	//analyzer_set_memory_size(MEMORY_SIZE_512K);
	416	// analyzer_set_freq(g_freq, g_freq_scale);
	417	analyzer_set_trigger_count(1);
	418	// analyzer_set_ramsize_trigger_address((((100 - g_pre_trigger)
	419	// * get_memory_size(g_memory_size)) / 100) >> 2);
	420
	421	#if 0
	422	if (g_double_mode == 1)
	423	analyzer_set_compression(COMPRESSION_DOUBLE);
	424	else if (g_compression == 1)
	425	analyzer_set_compression(COMPRESSION_ENABLE);
	426	else
	427	#endif
	428	analyzer_set_compression(COMPRESSION_NONE);
	429
	430	if (devc->cur_samplerate == 0) {
	431	/* Samplerate hasn't been set. Default to 1MHz. */
	432	analyzer_set_freq(1, FREQ_SCALE_MHZ);
	433	devc->cur_samplerate = SR_MHZ(1);
	434	}
	435
	436	return SR_OK;
	437	}
	438
	439	static int hw_dev_close(struct sr_dev_inst *sdi)
	440	{
	441	struct dev_context *devc;
	442
	443	devc = sdi->priv;
	444
	445	if (!devc->usb->devhdl)
	446	return SR_ERR;
	447
	448	sr_info("Closing device %d on %d.%d interface %d.", sdi->index,
	449	devc->usb->bus, devc->usb->address, USB_INTERFACE);
	450	libusb_release_interface(devc->usb->devhdl, USB_INTERFACE);
	451	libusb_reset_device(devc->usb->devhdl);
	452	libusb_close(devc->usb->devhdl);
	453	devc->usb->devhdl = NULL;
	454	sdi->status = SR_ST_INACTIVE;
	455
	456	return SR_OK;
	457	}
	458
	459	static int hw_cleanup(void)
	460	{
	461	struct drv_context *drvc;
	462
	463	if (!(drvc = di->priv))
	464	return SR_OK;
	465
	466	clear_instances();
	467
	468	return SR_OK;
	469	}
	470
	471	static int config_get(int id, const void *data, const struct sr_dev_inst sdi)
	472	{
	473	struct dev_context *devc;
	474
	475	switch (id) {
	476	case SR_CONF_SAMPLERATE:
	477	if (sdi) {
	478	devc = sdi->priv;
	479	*data = &devc->cur_samplerate;
	480	sr_spew("Returning samplerate: %" PRIu64 "Hz.",
	481	devc->cur_samplerate);
	482	} else
	483	return SR_ERR;
	484	break;
	485	default:
	486	return SR_ERR_ARG;
	487	}
	488
	489	return SR_OK;
	490	}
	491
	492	static int config_set(int id, const void value, const struct sr_dev_inst sdi)
	493	{
	494	struct dev_context *devc;
	495
	496	if (!sdi) {
	497	sr_err("%s: sdi was NULL", __func__);
	498	return SR_ERR_ARG;
	499	}
	500
	501	if (!(devc = sdi->priv)) {
	502	sr_err("%s: sdi->priv was NULL", __func__);
	503	return SR_ERR_ARG;
	504	}
	505
	506	switch (id) {
	507	case SR_CONF_SAMPLERATE:
	508	return zp_set_samplerate(devc, (const uint64_t )value);
	509	case SR_CONF_LIMIT_SAMPLES:
	510	return set_limit_samples(devc, (const uint64_t )value);
	511	case SR_CONF_CAPTURE_RATIO:
	512	return set_capture_ratio(devc, (const uint64_t )value);
	513	default:
	514	return SR_ERR;
	515	}
	516	}
	517
	518	static int config_list(int key, const void *data, const struct sr_dev_inst sdi)
	519	{
	520	(void)sdi;
	521
	522	switch (key) {
	523	case SR_CONF_DEVICE_OPTIONS:
	524	*data = hwcaps;
	525	break;
	526	case SR_CONF_SAMPLERATE:
	527	*data = &samplerates;
	528	break;
	529	case SR_CONF_TRIGGER_TYPE:
	530	*data = TRIGGER_TYPE;
	531	break;
	532	default:
	533	return SR_ERR_ARG;
	534	}
	535
	536	return SR_OK;
	537	}
	538
	539	static int hw_dev_acquisition_start(const struct sr_dev_inst *sdi,
	540	void *cb_data)
	541	{
	542	struct sr_datafeed_packet packet;
	543	struct sr_datafeed_logic logic;
	544	//uint64_t samples_read;
	545	int res;
	546	unsigned int packet_num;
	547	unsigned int n;
	548	unsigned char *buf;
	549	struct dev_context *devc;
	550
	551	if (!(devc = sdi->priv)) {
	552	sr_err("%s: sdi->priv was NULL", __func__);
	553	return SR_ERR_ARG;
	554	}
	555
	556	if (configure_probes(sdi) != SR_OK) {
	557	sr_err("Failed to configure probes.");
	558	return SR_ERR;
	559	}
	560
	561	set_triggerbar(devc);
	562
	563	/* push configured settings to device */
	564	analyzer_configure(devc->usb->devhdl);
	565
	566	analyzer_start(devc->usb->devhdl);
	567	sr_info("Waiting for data.");
	568	analyzer_wait_data(devc->usb->devhdl);
	569
	570	sr_info("Stop address = 0x%x.",
	571	analyzer_get_stop_address(devc->usb->devhdl));
	572	sr_info("Now address = 0x%x.",
	573	analyzer_get_now_address(devc->usb->devhdl));
	574	sr_info("Trigger address = 0x%x.",
	575	analyzer_get_trigger_address(devc->usb->devhdl));
	576
	577	/* Send header packet to the session bus. */
	578	std_session_send_df_header(cb_data, DRIVER_LOG_DOMAIN);
	579
	580	if (!(buf = g_try_malloc(PACKET_SIZE))) {
	581	sr_err("Packet buffer malloc failed.");
	582	return SR_ERR_MALLOC;
	583	}
	584
	585	//samples_read = 0;
	586	analyzer_read_start(devc->usb->devhdl);
	587	/* Send the incoming transfer to the session bus. */
	588	n = get_memory_size(devc->memory_size);
	589	if (devc->max_memory_size * 4 < n)
	590	n = devc->max_memory_size * 4;
	591	for (packet_num = 0; packet_num < n / PACKET_SIZE; packet_num++) {
	592	res = analyzer_read_data(devc->usb->devhdl, buf, PACKET_SIZE);
	593	sr_info("Tried to read %d bytes, actually read %d bytes.",
	594	PACKET_SIZE, res);
	595
	596	packet.type = SR_DF_LOGIC;
	597	packet.payload = &logic;
	598	logic.length = PACKET_SIZE;
	599	logic.unitsize = 4;
	600	logic.data = buf;
	601	sr_session_send(cb_data, &packet);
	602	//samples_read += res / 4;
	603	}
	604	analyzer_read_stop(devc->usb->devhdl);
	605	g_free(buf);
	606
	607	packet.type = SR_DF_END;
	608	sr_session_send(cb_data, &packet);
	609
	610	return SR_OK;
	611	}
	612
	613	/* TODO: This stops acquisition on ALL devices, ignoring dev_index. */
	614	static int hw_dev_acquisition_stop(struct sr_dev_inst sdi, void cb_data)
	615	{
	616	struct sr_datafeed_packet packet;
	617	struct dev_context *devc;
	618
	619	packet.type = SR_DF_END;
	620	sr_session_send(cb_data, &packet);
	621
	622	if (!(devc = sdi->priv)) {
	623	sr_err("%s: sdi->priv was NULL", __func__);
	624	return SR_ERR_BUG;
	625	}
	626
	627	analyzer_reset(devc->usb->devhdl);
	628	/* TODO: Need to cancel and free any queued up transfers. */
	629
	630	return SR_OK;
	631	}
	632
	633	SR_PRIV struct sr_dev_driver zeroplus_logic_cube_driver_info = {
	634	.name = "zeroplus-logic-cube",
	635	.longname = "ZEROPLUS Logic Cube LAP-C series",
	636	.api_version = 1,
	637	.init = hw_init,
	638	.cleanup = hw_cleanup,
	639	.scan = hw_scan,
	640	.dev_list = hw_dev_list,
	641	.dev_clear = hw_cleanup,
	642	.config_get = config_get,
	643	.config_set = config_set,
	644	.config_list = config_list,
	645	.dev_open = hw_dev_open,
	646	.dev_close = hw_dev_close,
	647	.dev_acquisition_start = hw_dev_acquisition_start,
	648	.dev_acquisition_stop = hw_dev_acquisition_stop,
	649	.priv = NULL,
	650	};