2 * This file is part of the libsigrok project.
4 * Copyright (C) 2014 Bert Vermeulen <bert@biot.com>
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.
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.
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/>.
24 SR_PRIV char *scpi_cmd_get(const struct sr_dev_inst *sdi, int command)
26 struct dev_context *devc;
32 for (i = 0; i < devc->device->num_commands; i++) {
33 if (devc->device->commands[i].command == command) {
34 cmd = devc->device->commands[i].string;
42 SR_PRIV int scpi_cmd(const struct sr_dev_inst *sdi, int command, ...)
44 struct sr_scpi_dev_inst *scpi;
49 if (!(cmd = scpi_cmd_get(sdi, command))) {
50 /* Device does not implement this command, that's OK. */
51 return SR_OK_CONTINUE;
55 va_start(args, command);
56 ret = sr_scpi_send_variadic(scpi, cmd, args);
62 SR_PRIV int scpi_cmd_resp(const struct sr_dev_inst *sdi, GVariant **gvar,
63 const GVariantType *gvtype, int command, ...)
65 struct sr_scpi_dev_inst *scpi;
71 if (!(cmd = scpi_cmd_get(sdi, command))) {
72 /* Device does not implement this command, that's OK. */
73 return SR_OK_CONTINUE;
77 va_start(args, command);
78 ret = sr_scpi_send_variadic(scpi, cmd, args);
83 if (g_variant_type_equal(gvtype, G_VARIANT_TYPE_BOOLEAN)) {
84 if ((ret = sr_scpi_get_string(scpi, NULL, &s)) != SR_OK)
86 if (!strcasecmp(s, "ON") || !strcasecmp(s, "1") || !strcasecmp(s, "YES"))
87 *gvar = g_variant_new_boolean(TRUE);
88 else if (!strcasecmp(s, "OFF") || !strcasecmp(s, "0") || !strcasecmp(s, "NO"))
89 *gvar = g_variant_new_boolean(FALSE);
92 } if (g_variant_type_equal(gvtype, G_VARIANT_TYPE_DOUBLE)) {
93 if ((ret = sr_scpi_get_double(scpi, NULL, &d)) == SR_OK)
94 *gvar = g_variant_new_double(d);
95 } if (g_variant_type_equal(gvtype, G_VARIANT_TYPE_STRING)) {
96 if ((ret = sr_scpi_get_string(scpi, NULL, &s)) == SR_OK)
97 *gvar = g_variant_new_string(s);
103 SR_PRIV int select_channel(const struct sr_dev_inst *sdi, struct sr_channel *ch)
105 struct dev_context *devc;
106 struct pps_channel *pch;
109 if (g_slist_length(sdi->channels) == 1)
113 if (ch == devc->cur_channel)
117 if ((ret = scpi_cmd(sdi, SCPI_CMD_SELECT_CHANNEL, pch->hwname)) == SR_OK)
118 devc->cur_channel = ch;
123 SR_PRIV int scpi_pps_receive_data(int fd, int revents, void *cb_data)
125 struct dev_context *devc;
126 struct sr_datafeed_packet packet;
127 struct sr_datafeed_analog analog;
128 const struct sr_dev_inst *sdi;
129 struct sr_channel *next_channel;
130 struct sr_scpi_dev_inst *scpi;
131 struct pps_channel *pch;
139 if (!(sdi = cb_data))
142 if (!(devc = sdi->priv))
147 /* Retrieve requested value for this state. */
148 if (sr_scpi_get_float(scpi, NULL, &f) == SR_OK) {
149 pch = devc->cur_channel->priv;
150 packet.type = SR_DF_ANALOG;
151 packet.payload = &analog;
152 analog.channels = g_slist_append(NULL, devc->cur_channel);
153 analog.num_samples = 1;
155 if (pch->mq == SR_MQ_VOLTAGE)
156 analog.unit = SR_UNIT_VOLT;
157 else if (pch->mq == SR_MQ_CURRENT)
158 analog.unit = SR_UNIT_AMPERE;
159 else if (pch->mq == SR_MQ_POWER)
160 analog.unit = SR_UNIT_WATT;
161 analog.mqflags = SR_MQFLAG_DC;
163 sr_session_send(sdi, &packet);
164 g_slist_free(analog.channels);
167 if (g_slist_length(sdi->channels) > 1) {
168 /* Find next enabled channel. */
169 next_channel = devc->cur_channel;
171 l = g_slist_find(sdi->channels, next_channel);
173 next_channel = l->next->data;
175 next_channel = sdi->channels->data;
176 } while (!next_channel->enabled);
177 select_channel(sdi, next_channel);
178 if (devc->cur_channel != next_channel) {
179 sr_err("Failed to select channel %s", next_channel->name);
184 pch = devc->cur_channel->priv;
185 if (pch->mq == SR_MQ_VOLTAGE)
186 cmd = SCPI_CMD_GET_MEAS_VOLTAGE;
187 else if (pch->mq == SR_MQ_CURRENT)
188 cmd = SCPI_CMD_GET_MEAS_CURRENT;
189 else if (pch->mq == SR_MQ_POWER)
190 cmd = SCPI_CMD_GET_MEAS_POWER;
193 scpi_cmd(sdi, cmd, pch->hwname);