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 *cur_pch, *new_pch;
109 if (g_slist_length(sdi->channels) == 1)
113 if (ch == devc->cur_channel)
117 if (devc->cur_channel) {
118 cur_pch = devc->cur_channel->priv;
119 if (cur_pch->hw_output_idx == new_pch->hw_output_idx) {
120 /* Same underlying output channel. */
121 devc->cur_channel = ch;
126 if ((ret = scpi_cmd(sdi, SCPI_CMD_SELECT_CHANNEL, new_pch->hwname)) == SR_OK)
127 devc->cur_channel = ch;
132 SR_PRIV struct sr_channel *next_enabled_channel(const struct sr_dev_inst *sdi,
133 struct sr_channel *cur_channel)
135 struct sr_channel *next_channel;
138 next_channel = cur_channel;
140 l = g_slist_find(sdi->channels, next_channel);
142 next_channel = l->next->data;
144 next_channel = sdi->channels->data;
145 } while (!next_channel->enabled);
150 SR_PRIV int scpi_pps_receive_data(int fd, int revents, void *cb_data)
152 struct dev_context *devc;
153 struct sr_datafeed_packet packet;
154 struct sr_datafeed_analog analog;
155 const struct sr_dev_inst *sdi;
156 struct sr_channel *next_channel;
157 struct sr_scpi_dev_inst *scpi;
158 struct pps_channel *pch;
165 if (!(sdi = cb_data))
168 if (!(devc = sdi->priv))
173 /* Retrieve requested value for this state. */
174 if (sr_scpi_get_float(scpi, NULL, &f) == SR_OK) {
175 pch = devc->cur_channel->priv;
176 packet.type = SR_DF_ANALOG;
177 packet.payload = &analog;
178 analog.channels = g_slist_append(NULL, devc->cur_channel);
179 analog.num_samples = 1;
181 if (pch->mq == SR_MQ_VOLTAGE)
182 analog.unit = SR_UNIT_VOLT;
183 else if (pch->mq == SR_MQ_CURRENT)
184 analog.unit = SR_UNIT_AMPERE;
185 else if (pch->mq == SR_MQ_POWER)
186 analog.unit = SR_UNIT_WATT;
187 analog.mqflags = SR_MQFLAG_DC;
189 sr_session_send(sdi, &packet);
190 g_slist_free(analog.channels);
193 if (g_slist_length(sdi->channels) > 1) {
194 next_channel = next_enabled_channel(sdi, devc->cur_channel);
195 if (select_channel(sdi, next_channel) != SR_OK) {
196 sr_err("Failed to select channel %s", next_channel->name);
201 pch = devc->cur_channel->priv;
202 if (pch->mq == SR_MQ_VOLTAGE)
203 cmd = SCPI_CMD_GET_MEAS_VOLTAGE;
204 else if (pch->mq == SR_MQ_CURRENT)
205 cmd = SCPI_CMD_GET_MEAS_CURRENT;
206 else if (pch->mq == SR_MQ_POWER)
207 cmd = SCPI_CMD_GET_MEAS_POWER;