175 lines
3.8 KiB
C
175 lines
3.8 KiB
C
/*
|
|
* This file is part of the libsigrok project.
|
|
*
|
|
* Copyright (C) 2013 Martin Ling <martin-sigrok@earth.li>
|
|
*
|
|
* 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 "libsigrok.h"
|
|
#include "libsigrok-internal.h"
|
|
|
|
#include <visa.h>
|
|
#include <string.h>
|
|
|
|
#define LOG_PREFIX "scpi_visa"
|
|
|
|
struct scpi_visa {
|
|
char *resource;
|
|
ViSession rmgr;
|
|
ViSession vi;
|
|
};
|
|
|
|
static int scpi_visa_dev_inst_new(void *priv, struct drv_context *drvc,
|
|
const char *resource, char **params, const char *serialcomm)
|
|
{
|
|
struct scpi_visa *vscpi = priv;
|
|
|
|
(void)drvc;
|
|
(void)resource;
|
|
(void)serialcomm;
|
|
|
|
if (!params || !params[1]) {
|
|
sr_err("Invalid parameters.");
|
|
return SR_ERR_BUG;
|
|
}
|
|
|
|
vscpi->resource = g_strdup(params[1]);
|
|
|
|
return SR_OK;
|
|
}
|
|
|
|
static int scpi_visa_open(void *priv)
|
|
{
|
|
struct scpi_visa *vscpi = priv;
|
|
|
|
if (viOpenDefaultRM(&vscpi->rmgr) != VI_SUCCESS) {
|
|
sr_err("Cannot open default resource manager.");
|
|
return SR_ERR;
|
|
}
|
|
|
|
if (viOpen(vscpi->rmgr, vscpi->resource, VI_NO_LOCK, 0, &vscpi->vi) != VI_SUCCESS) {
|
|
sr_err("Cannot open resource.");
|
|
return SR_ERR;
|
|
}
|
|
|
|
return SR_OK;
|
|
}
|
|
|
|
static int scpi_visa_source_add(void *priv, int events, int timeout,
|
|
sr_receive_data_callback_t cb, void *cb_data)
|
|
{
|
|
(void) priv;
|
|
|
|
/* Hook up a dummy handler to receive data from the device. */
|
|
return sr_source_add(-1, events, timeout, cb, cb_data);
|
|
}
|
|
|
|
static int scpi_visa_source_remove(void *priv)
|
|
{
|
|
(void) priv;
|
|
|
|
return sr_source_remove(-1);
|
|
}
|
|
|
|
static int scpi_visa_send(void *priv, const char *command)
|
|
{
|
|
struct scpi_visa *vscpi = priv;
|
|
gchar *terminated_command;
|
|
ViUInt32 written;
|
|
int len;
|
|
|
|
terminated_command = g_strconcat(command, "\n", NULL);
|
|
len = strlen(terminated_command);
|
|
if (viWrite(vscpi->vi, (ViBuf) (terminated_command + written), len,
|
|
&written) != VI_SUCCESS) {
|
|
sr_err("Error while sending SCPI command: '%s'.", command);
|
|
g_free(terminated_command);
|
|
return SR_ERR;
|
|
}
|
|
|
|
g_free(terminated_command);
|
|
|
|
sr_spew("Successfully sent SCPI command: '%s'.", command);
|
|
|
|
return SR_OK;
|
|
}
|
|
|
|
static int scpi_visa_read_begin(void *priv)
|
|
{
|
|
(void) priv;
|
|
|
|
return SR_OK;
|
|
}
|
|
|
|
static int scpi_visa_read_data(void *priv, char *buf, int maxlen)
|
|
{
|
|
struct scpi_visa *vscpi = priv;
|
|
ViUInt32 count;
|
|
|
|
if (viRead(vscpi->vi, (ViBuf) buf, maxlen, &count) != VI_SUCCESS) {
|
|
sr_err("Read failed.");
|
|
return SR_ERR;
|
|
}
|
|
|
|
return count;
|
|
}
|
|
|
|
static int scpi_visa_read_complete(void *priv)
|
|
{
|
|
struct scpi_visa *vscpi = priv;
|
|
ViUInt16 status;
|
|
|
|
if (viReadSTB(vscpi->vi, &status) != VI_SUCCESS) {
|
|
sr_err("Failed to read status.");
|
|
return SR_ERR;
|
|
}
|
|
|
|
return !(status & 16);
|
|
}
|
|
|
|
static int scpi_visa_close(void *priv)
|
|
{
|
|
struct scpi_visa *vscpi = priv;
|
|
|
|
viClose(vscpi->vi);
|
|
viClose(vscpi->rmgr);
|
|
|
|
return SR_OK;
|
|
}
|
|
|
|
static void scpi_visa_free(void *priv)
|
|
{
|
|
struct scpi_visa *vscpi = priv;
|
|
|
|
g_free(vscpi->resource);
|
|
g_free(vscpi);
|
|
}
|
|
|
|
SR_PRIV const struct sr_scpi_dev_inst scpi_visa_dev = {
|
|
.name = "VISA",
|
|
.prefix = "visa",
|
|
.priv_size = sizeof(struct scpi_visa),
|
|
.dev_inst_new = scpi_visa_dev_inst_new,
|
|
.open = scpi_visa_open,
|
|
.source_add = scpi_visa_source_add,
|
|
.source_remove = scpi_visa_source_remove,
|
|
.send = scpi_visa_send,
|
|
.read_begin = scpi_visa_read_begin,
|
|
.read_data = scpi_visa_read_data,
|
|
.read_complete = scpi_visa_read_complete,
|
|
.close = scpi_visa_close,
|
|
.free = scpi_visa_free,
|
|
};
|