2 * This file is part of the libsigrok project.
4 * Copyright (C) 2015 Hannu Vuolasaho <vuokkosetae@gmail.com>
5 * Copyright (C) 2018 Frank Stettner <frank-stettner@gmx.net>
7 * This program is free software: you can redistribute it and/or modify
8 * it under the terms of the GNU General Public License as published by
9 * the Free Software Foundation, either version 3 of the License, or
10 * (at your option) any later version.
12 * This program is distributed in the hope that it will be useful,
13 * but WITHOUT ANY WARRANTY; without even the implied warranty of
14 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
15 * GNU General Public License for more details.
17 * You should have received a copy of the GNU General Public License
18 * along with this program. If not, see <http://www.gnu.org/licenses/>.
24 #define REQ_TIMEOUT_MS 500
25 #define DEVICE_PROCESSING_TIME_MS 80
27 SR_PRIV int korad_kaxxxxp_send_cmd(struct sr_serial_dev_inst *serial,
32 sr_dbg("Sending '%s'.", cmd);
33 if ((ret = serial_write_blocking(serial, cmd, strlen(cmd), 0)) < 0) {
34 sr_err("Error sending command: %d.", ret);
41 SR_PRIV int korad_kaxxxxp_read_chars(struct sr_serial_dev_inst *serial,
44 int ret, received, turns;
50 if ((ret = serial_read_blocking(serial, buf + received,
52 serial_timeout(serial, count))) < 0) {
53 sr_err("Error %d reading %d bytes from device.",
59 } while ((received < count) && (turns < 100));
63 sr_spew("Received: '%s'.", buf);
68 static void give_device_time_to_process(struct dev_context *devc)
70 int64_t sleeping_time;
72 sleeping_time = devc->req_sent_at + (DEVICE_PROCESSING_TIME_MS * 1000);
73 sleeping_time -= g_get_monotonic_time();
75 if (sleeping_time > 0) {
76 g_usleep(sleeping_time);
77 sr_spew("Sleeping for processing %" PRIi64 " usec", sleeping_time);
81 SR_PRIV int korad_kaxxxxp_set_value(struct sr_serial_dev_inst *serial,
82 int target, struct dev_context *devc)
89 g_mutex_lock(&devc->rw_mutex);
90 give_device_time_to_process(devc);
96 sr_err("Can't set measurable parameter %d.", target);
97 g_mutex_unlock(&devc->rw_mutex);
99 case KAXXXXP_CURRENT_MAX:
100 cmd = "ISET1:%05.3f";
101 value = devc->current_max;
103 case KAXXXXP_VOLTAGE_MAX:
104 cmd = "VSET1:%05.2f";
105 value = devc->voltage_max;
109 value = (devc->output_enabled) ? 1 : 0;
113 value = (devc->beep_enabled) ? 1 : 0;
117 value = (devc->ocp_enabled) ? 1 : 0;
121 value = (devc->ovp_enabled) ? 1 : 0;
125 if (devc->program < 1 || devc->program > 5) {
126 sr_err("Only programs 1-5 supported and %d isn't "
127 "between them.", devc->program);
128 g_mutex_unlock(&devc->rw_mutex);
131 value = devc->program;
135 if (devc->program < 1 || devc->program > 5) {
136 sr_err("Only programs 1-5 supported and %d isn't "
137 "between them.", devc->program);
138 g_mutex_unlock(&devc->rw_mutex);
141 value = devc->program;
144 sr_err("Don't know how to set %d.", target);
145 g_mutex_unlock(&devc->rw_mutex);
149 msg = g_malloc0(20 + 1);
151 sr_snprintf_ascii(msg, 20, cmd, value);
153 ret = korad_kaxxxxp_send_cmd(serial, msg);
154 devc->req_sent_at = g_get_monotonic_time();
157 g_mutex_unlock(&devc->rw_mutex);
162 SR_PRIV int korad_kaxxxxp_get_value(struct sr_serial_dev_inst *serial,
163 int target, struct dev_context *devc)
170 g_mutex_lock(&devc->rw_mutex);
171 give_device_time_to_process(devc);
177 case KAXXXXP_CURRENT:
178 /* Read current from device. */
179 ret = korad_kaxxxxp_send_cmd(serial, "IOUT1?");
180 value = &(devc->current);
182 case KAXXXXP_CURRENT_MAX:
183 /* Read set current from device. */
184 ret = korad_kaxxxxp_send_cmd(serial, "ISET1?");
185 value = &(devc->current_max);
187 case KAXXXXP_VOLTAGE:
188 /* Read voltage from device. */
189 ret = korad_kaxxxxp_send_cmd(serial, "VOUT1?");
190 value = &(devc->voltage);
192 case KAXXXXP_VOLTAGE_MAX:
193 /* Read set voltage from device. */
194 ret = korad_kaxxxxp_send_cmd(serial, "VSET1?");
195 value = &(devc->voltage_max);
201 /* Read status from device. */
202 ret = korad_kaxxxxp_send_cmd(serial, "STATUS?");
206 sr_err("Don't know how to query %d.", target);
207 g_mutex_unlock(&devc->rw_mutex);
211 devc->req_sent_at = g_get_monotonic_time();
213 if ((ret = korad_kaxxxxp_read_chars(serial, count, reply)) < 0) {
214 g_mutex_unlock(&devc->rw_mutex);
221 sr_atof_ascii((const char *)&reply, value);
222 sr_dbg("value: %f", *value);
224 /* We have status reply. */
225 status_byte = reply[0];
226 /* Constant current */
227 devc->cc_mode[0] = !(status_byte & (1 << 0)); /* Channel one */
228 devc->cc_mode[1] = !(status_byte & (1 << 1)); /* Channel two */
231 * status_byte & ((1 << 2) | (1 << 3))
232 * 00 independent 01 series 11 parallel
234 devc->beep_enabled = (1 << 4);
235 devc->ocp_enabled = (status_byte & (1 << 5));
236 devc->output_enabled = (status_byte & (1 << 6));
237 /* Velleman LABPS3005 quirk */
238 if (devc->output_enabled)
239 devc->ovp_enabled = (status_byte & (1 << 7));
240 sr_dbg("Status: 0x%02x", status_byte);
241 sr_spew("Status: CH1: constant %s CH2: constant %s. "
242 "Tracking would be %s. Device is "
243 "%s and %s. Buttons are %s. Output is %s "
244 "and extra byte is %s.",
245 (status_byte & (1 << 0)) ? "voltage" : "current",
246 (status_byte & (1 << 1)) ? "voltage" : "current",
247 (status_byte & (1 << 2)) ? "parallel" : "series",
248 (status_byte & (1 << 3)) ? "tracking" : "independent",
249 (status_byte & (1 << 4)) ? "beeping" : "silent",
250 (status_byte & (1 << 5)) ? "locked" : "unlocked",
251 (status_byte & (1 << 6)) ? "enabled" : "disabled",
252 (status_byte & (1 << 7)) ? "true" : "false");
255 /* Read the sixth byte from ISET? BUG workaround. */
256 if (target == KAXXXXP_CURRENT_MAX)
257 serial_read_blocking(serial, &status_byte, 1, 10);
259 g_mutex_unlock(&devc->rw_mutex);
264 SR_PRIV int korad_kaxxxxp_get_all_values(struct sr_serial_dev_inst *serial,
265 struct dev_context *devc)
269 for (target = KAXXXXP_CURRENT;
270 target <= KAXXXXP_STATUS; target++) {
271 if ((ret = korad_kaxxxxp_get_value(serial, target, devc)) < 0)
278 static void next_measurement(struct dev_context *devc)
280 switch (devc->acquisition_target) {
281 case KAXXXXP_CURRENT:
282 devc->acquisition_target = KAXXXXP_VOLTAGE;
284 case KAXXXXP_VOLTAGE:
285 devc->acquisition_target = KAXXXXP_STATUS;
288 devc->acquisition_target = KAXXXXP_CURRENT;
291 devc->acquisition_target = KAXXXXP_CURRENT;
292 sr_err("Invalid target for next acquisition.");
296 SR_PRIV int korad_kaxxxxp_receive_data(int fd, int revents, void *cb_data)
298 struct sr_dev_inst *sdi;
299 struct dev_context *devc;
300 struct sr_serial_dev_inst *serial;
301 struct sr_datafeed_packet packet;
302 struct sr_datafeed_analog analog;
303 struct sr_analog_encoding encoding;
304 struct sr_analog_meaning meaning;
305 struct sr_analog_spec spec;
311 if (!(sdi = cb_data))
314 if (!(devc = sdi->priv))
320 korad_kaxxxxp_get_value(serial, devc->acquisition_target, devc);
322 /* Note: digits/spec_digits will be overridden later. */
323 sr_analog_init(&analog, &encoding, &meaning, &spec, 0);
325 /* Send the value forward. */
326 packet.type = SR_DF_ANALOG;
327 packet.payload = &analog;
328 analog.num_samples = 1;
329 l = g_slist_copy(sdi->channels);
330 if (devc->acquisition_target == KAXXXXP_CURRENT) {
331 l = g_slist_remove_link(l, g_slist_nth(l, 0));
332 analog.meaning->channels = l;
333 analog.meaning->mq = SR_MQ_CURRENT;
334 analog.meaning->unit = SR_UNIT_AMPERE;
335 analog.meaning->mqflags = SR_MQFLAG_DC;
336 analog.encoding->digits = 3;
337 analog.spec->spec_digits = 3;
338 analog.data = &devc->current;
339 sr_session_send(sdi, &packet);
340 } else if (devc->acquisition_target == KAXXXXP_VOLTAGE) {
341 l = g_slist_remove_link(l, g_slist_nth(l, 1));
342 analog.meaning->channels = l;
343 analog.meaning->mq = SR_MQ_VOLTAGE;
344 analog.meaning->unit = SR_UNIT_VOLT;
345 analog.meaning->mqflags = SR_MQFLAG_DC;
346 analog.encoding->digits = 2;
347 analog.spec->spec_digits = 2;
348 analog.data = &devc->voltage;
349 sr_session_send(sdi, &packet);
350 sr_sw_limits_update_samples_read(&devc->limits, 1);
352 next_measurement(devc);
354 if (sr_sw_limits_check(&devc->limits))
355 sr_dev_acquisition_stop(sdi);