2 * This file is part of the libsigrok project.
4 * Copyright (C) 2017 Kumar Abhishek <abhishek@theembeddedkitchen.net>
5 * Portions of the code are adapted from scpi_tcp.c and scpi.c, their
6 * copyright notices are listed below:
8 * Copyright (C) 2013 Martin Ling <martin-sigrok@earth.li>
9 * Copyright (C) 2013 poljar (Damir Jelić) <poljarinho@gmail.com>
11 * This program is free software: you can redistribute it and/or modify
12 * it under the terms of the GNU General Public License as published by
13 * the Free Software Foundation, either version 3 of the License, or
14 * (at your option) any later version.
16 * This program is distributed in the hope that it will be useful,
17 * but WITHOUT ANY WARRANTY; without even the implied warranty of
18 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
19 * GNU General Public License for more details.
21 * You should have received a copy of the GNU General Public License
22 * along with this program. If not, see <http://www.gnu.org/licenses/>.
27 #define _WIN32_WINNT 0x0501
35 #include <sys/socket.h>
36 #include <netinet/in.h>
37 #include <arpa/inet.h>
43 #include "beaglelogic.h"
45 static int beaglelogic_tcp_open(struct dev_context *devc)
47 struct addrinfo hints;
48 struct addrinfo *results, *res;
51 memset(&hints, 0, sizeof(hints));
52 hints.ai_family = AF_UNSPEC;
53 hints.ai_socktype = SOCK_STREAM;
54 hints.ai_protocol = IPPROTO_TCP;
56 err = getaddrinfo(devc->address, devc->port, &hints, &results);
59 sr_err("Address lookup failed: %s:%s: %s", devc->address,
60 devc->port, gai_strerror(err));
64 for (res = results; res; res = res->ai_next) {
65 if ((devc->socket = socket(res->ai_family, res->ai_socktype,
66 res->ai_protocol)) < 0)
68 if (connect(devc->socket, res->ai_addr, res->ai_addrlen) != 0) {
76 freeaddrinfo(results);
78 if (devc->socket < 0) {
79 sr_err("Failed to connect to %s:%s: %s", devc->address,
80 devc->port, g_strerror(errno));
87 static int beaglelogic_tcp_send_cmd(struct dev_context *devc,
88 const char *format, ...)
91 va_list args, args_copy;
94 va_start(args, format);
95 va_copy(args_copy, args);
96 len = vsnprintf(NULL, 0, format, args_copy);
99 buf = g_malloc0(len + 2);
100 vsprintf(buf, format, args);
103 if (buf[len - 1] != '\n')
106 out = send(devc->socket, buf, strlen(buf), 0);
109 sr_err("Send error: %s", g_strerror(errno));
113 if (out < (int)strlen(buf)) {
114 sr_dbg("Only sent %d/%lu bytes of command: '%s'.", out,
118 sr_spew("Sent command: '%s'.", buf);
125 static int beaglelogic_tcp_read_data(struct dev_context *devc, char *buf,
130 len = recv(devc->socket, buf, maxlen, 0);
133 sr_err("Receive error: %s", g_strerror(errno));
140 SR_PRIV int beaglelogic_tcp_drain(struct dev_context *devc)
142 char *buf = g_malloc(1024);
148 FD_SET(devc->socket, &rset);
152 tv.tv_usec = 25 * 1000;
155 ret = select(devc->socket + 1, &rset, NULL, NULL, &tv);
157 len += beaglelogic_tcp_read_data(devc, buf, 1024);
160 sr_spew("Drained %d bytes of data.", len);
167 static int beaglelogic_tcp_get_string(struct dev_context *devc, const char *cmd,
170 GString *response = g_string_sized_new(1024);
175 if (beaglelogic_tcp_send_cmd(devc, cmd) != SR_OK)
179 timeout = g_get_monotonic_time() + devc->read_timeout;
180 len = beaglelogic_tcp_read_data(devc, response->str,
181 response->allocated_len);
184 g_string_free(response, TRUE);
189 g_string_set_size(response, len);
191 if (g_get_monotonic_time() > timeout) {
192 sr_err("Timed out waiting for response.");
193 g_string_free(response, TRUE);
194 return SR_ERR_TIMEOUT;
197 /* Remove trailing newline if present */
198 if (response->len >= 1 && response->str[response->len - 1] == '\n')
199 g_string_truncate(response, response->len - 1);
201 /* Remove trailing carriage return if present */
202 if (response->len >= 1 && response->str[response->len - 1] == '\r')
203 g_string_truncate(response, response->len - 1);
205 sr_spew("Got response: '%.70s', length %" G_GSIZE_FORMAT ".",
206 response->str, response->len);
208 *tcp_resp = g_string_free(response, FALSE);
213 static int beaglelogic_tcp_get_int(struct dev_context *devc,
214 const char *cmd, int *response)
219 ret = beaglelogic_tcp_get_string(devc, cmd, &resp);
220 if (!resp && ret != SR_OK)
223 if (sr_atoi(resp, response) == SR_OK)
233 SR_PRIV int beaglelogic_tcp_detect(struct dev_context *devc)
238 ret = beaglelogic_tcp_get_string(devc, "version", &resp);
239 if (ret == SR_OK && !g_ascii_strncasecmp(resp, "BeagleLogic", 11))
249 static int beaglelogic_open(struct dev_context *devc)
251 return beaglelogic_tcp_open(devc);
254 static int beaglelogic_close(struct dev_context *devc)
256 if (close(devc->socket) < 0)
262 static int beaglelogic_get_buffersize(struct dev_context *devc)
264 return beaglelogic_tcp_get_int(devc, "memalloc",
265 (int *)&devc->buffersize);
268 static int beaglelogic_set_buffersize(struct dev_context *devc)
273 beaglelogic_tcp_send_cmd(devc, "memalloc %lu", devc->buffersize);
274 ret = beaglelogic_tcp_get_string(devc, NULL, &resp);
275 if (ret == SR_OK && !g_ascii_strncasecmp(resp, "ok", 2))
285 static int beaglelogic_get_samplerate(struct dev_context *devc)
289 err = beaglelogic_tcp_get_int(devc, "samplerate", &arg);
290 devc->cur_samplerate = arg;
295 static int beaglelogic_set_samplerate(struct dev_context *devc)
300 beaglelogic_tcp_send_cmd(devc, "samplerate %lu",
301 (uint32_t)devc->cur_samplerate);
302 ret = beaglelogic_tcp_get_string(devc, NULL, &resp);
303 if (ret == SR_OK && !g_ascii_strncasecmp(resp, "ok", 2))
313 static int beaglelogic_get_sampleunit(struct dev_context *devc)
315 return beaglelogic_tcp_get_int(devc, "sampleunit",
316 (int *)&devc->sampleunit);
319 static int beaglelogic_set_sampleunit(struct dev_context *devc)
324 beaglelogic_tcp_send_cmd(devc, "sampleunit %lu", devc->sampleunit);
325 ret = beaglelogic_tcp_get_string(devc, NULL, &resp);
326 if (ret == SR_OK && !g_ascii_strncasecmp(resp, "ok", 2))
336 static int beaglelogic_get_triggerflags(struct dev_context *devc)
338 return beaglelogic_tcp_get_int(devc, "triggerflags",
339 (int *)&devc->triggerflags);
342 static int beaglelogic_set_triggerflags(struct dev_context *devc)
347 beaglelogic_tcp_send_cmd(devc, "triggerflags %lu", devc->triggerflags);
348 ret = beaglelogic_tcp_get_string(devc, NULL, &resp);
349 if (ret == SR_OK && !g_ascii_strncasecmp(resp, "ok", 2))
359 static int beaglelogic_get_lasterror(struct dev_context *devc)
361 devc->last_error = 0;
366 static int beaglelogic_start(struct dev_context *devc)
368 beaglelogic_tcp_drain(devc);
370 return beaglelogic_tcp_send_cmd(devc, "get");
373 static int beaglelogic_stop(struct dev_context *devc)
375 return beaglelogic_tcp_send_cmd(devc, "close");
378 static int beaglelogic_get_bufunitsize(struct dev_context *devc)
380 return beaglelogic_tcp_get_int(devc, "bufunitsize",
381 (int *)&devc->bufunitsize);
384 static int beaglelogic_set_bufunitsize(struct dev_context *devc)
389 beaglelogic_tcp_send_cmd(devc, "bufunitsize %ld", devc->bufunitsize);
390 ret = beaglelogic_tcp_get_string(devc, NULL, &resp);
391 if (ret == SR_OK && !g_ascii_strncasecmp(resp, "ok", 2))
401 static int dummy(struct dev_context *devc)
408 SR_PRIV const struct beaglelogic_ops beaglelogic_tcp_ops = {
409 .open = beaglelogic_open,
410 .close = beaglelogic_close,
411 .get_buffersize = beaglelogic_get_buffersize,
412 .set_buffersize = beaglelogic_set_buffersize,
413 .get_samplerate = beaglelogic_get_samplerate,
414 .set_samplerate = beaglelogic_set_samplerate,
415 .get_sampleunit = beaglelogic_get_sampleunit,
416 .set_sampleunit = beaglelogic_set_sampleunit,
417 .get_triggerflags = beaglelogic_get_triggerflags,
418 .set_triggerflags = beaglelogic_set_triggerflags,
419 .start = beaglelogic_start,
420 .stop = beaglelogic_stop,
421 .get_lasterror = beaglelogic_get_lasterror,
422 .get_bufunitsize = beaglelogic_get_bufunitsize,
423 .set_bufunitsize = beaglelogic_set_bufunitsize,