2 * This file is part of the libsigrok project.
4 * Copyright (C) 2013 Marc Schink <sigrok-dev@marcschink.de>
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/>.
23 #include <libsigrok/libsigrok.h>
24 #include "libsigrok-internal.h"
26 #define LOG_PREFIX "input/csv"
29 * The CSV input module has the following options:
31 * single-column: Specifies the column number which stores the sample data for
32 * single column mode and enables single column mode. Multi
33 * column mode is used if this parameter is omitted.
35 * numchannels: Specifies the number of channels to use. In multi column mode
36 * the number of channels are the number of columns and in single
37 * column mode the number of bits (LSB first) beginning at
40 * delimiter: Specifies the delimiter for columns. Must be at least one
41 * character. Comma is used as default delimiter.
43 * format: Specifies the format of the sample data in single column mode.
44 * Available formats are: 'bin', 'hex' and 'oct'. The binary
45 * format is used by default. This option has no effect in multi
48 * comment: Specifies the prefix character(s) for comments. No prefix
49 * characters are used by default which disables removing of
52 * samplerate: Samplerate which the sample data was captured with. Default
55 * first-channel: Column number of the first channel in multi column mode and
56 * position of the bit for the first channel in single column mode.
59 * header: Determines if the first line should be treated as header
60 * and used for channel names in multi column mode. Empty header
61 * names will be replaced by the channel number. If enabled in
62 * single column mode the first line will be skipped. Usage of
63 * header is disabled by default.
65 * startline: Line number to start processing sample data. Must be greater
66 * than 0. The default line number to start processing is 1.
69 /* Single column formats. */
79 /* Current selected samplerate. */
82 /* Number of channels. */
85 /* Column delimiter character(s). */
88 /* Comment prefix character(s). */
91 /* Termination character(s) used in current stream. */
94 /* Determines if sample data is stored in multiple columns. */
95 gboolean multi_column_mode;
97 /* Column number of the sample data in single column mode. */
101 * Number of the first column to parse. Equivalent to the number of the
102 * first channel in multi column mode and the single column number in
103 * single column mode.
108 * Column number of the first channel in multi column mode and position of
109 * the bit for the first channel in single column mode.
113 /* Line number to start processing. */
117 * Determines if the first line should be treated as header and used for
118 * channel names in multi column mode.
122 /* Format sample data is stored in single column mode. */
125 /* Size of the sample buffer. */
126 gsize sample_buffer_size;
128 /* Buffer to store sample data. */
129 uint8_t *sample_buffer;
131 /* Current line number. */
135 static int format_match(GHashTable *metadata)
139 buf = g_hash_table_lookup(metadata, GINT_TO_POINTER(SR_INPUT_META_MIMETYPE));
140 if (!strcmp(buf, "text/csv"))
146 static void strip_comment(char *buf, const GString *prefix)
153 if ((ptr = strstr(buf, prefix->str)))
157 static int parse_binstr(const char *str, struct context *inc)
161 length = strlen(str);
164 sr_err("Column %zu in line %zu is empty.", inc->single_column,
169 /* Clear buffer in order to set bits only. */
170 memset(inc->sample_buffer, 0, (inc->num_channels + 7) >> 3);
172 i = inc->first_channel;
174 for (j = 0; i < length && j < inc->num_channels; i++, j++) {
175 if (str[length - i - 1] == '1') {
176 inc->sample_buffer[j / 8] |= (1 << (j % 8));
177 } else if (str[length - i - 1] != '0') {
178 sr_err("Invalid value '%s' in column %zu in line %zu.",
179 str, inc->single_column, inc->line_number);
187 static int parse_hexstr(const char *str, struct context *inc)
189 gsize i, j, k, length;
193 length = strlen(str);
196 sr_err("Column %zu in line %zu is empty.", inc->single_column,
201 /* Clear buffer in order to set bits only. */
202 memset(inc->sample_buffer, 0, (inc->num_channels + 7) >> 3);
204 /* Calculate the position of the first hexadecimal digit. */
205 i = inc->first_channel / 4;
207 for (j = 0; i < length && j < inc->num_channels; i++) {
208 c = str[length - i - 1];
210 if (!g_ascii_isxdigit(c)) {
211 sr_err("Invalid value '%s' in column %zu in line %zu.",
212 str, inc->single_column, inc->line_number);
216 value = g_ascii_xdigit_value(c);
218 k = (inc->first_channel + j) % 4;
220 for (; j < inc->num_channels && k < 4; k++) {
221 if (value & (1 << k))
222 inc->sample_buffer[j / 8] |= (1 << (j % 8));
231 static int parse_octstr(const char *str, struct context *inc)
233 gsize i, j, k, length;
237 length = strlen(str);
240 sr_err("Column %zu in line %zu is empty.", inc->single_column,
245 /* Clear buffer in order to set bits only. */
246 memset(inc->sample_buffer, 0, (inc->num_channels + 7) >> 3);
248 /* Calculate the position of the first octal digit. */
249 i = inc->first_channel / 3;
251 for (j = 0; i < length && j < inc->num_channels; i++) {
252 c = str[length - i - 1];
254 if (c < '0' || c > '7') {
255 sr_err("Invalid value '%s' in column %zu in line %zu.",
256 str, inc->single_column, inc->line_number);
260 value = g_ascii_xdigit_value(c);
262 k = (inc->first_channel + j) % 3;
264 for (; j < inc->num_channels && k < 3; k++) {
265 if (value & (1 << k))
266 inc->sample_buffer[j / 8] |= (1 << (j % 8));
275 static char **parse_line(char *buf, struct context *inc, int max_columns)
277 const char *str, *remainder;
288 str = strstr(remainder, inc->delimiter->str);
290 while (str && max_columns) {
291 if (n >= inc->first_column) {
292 column = g_strndup(remainder, str - remainder);
293 list = g_slist_prepend(list, g_strstrip(column));
299 remainder = str + inc->delimiter->len;
300 str = strstr(remainder, inc->delimiter->str);
304 if (buf[0] && max_columns && n >= inc->first_column) {
305 column = g_strdup(remainder);
306 list = g_slist_prepend(list, g_strstrip(column));
310 if (!(columns = g_try_new(char *, k + 1)))
315 for (l = list; l; l = l->next)
316 columns[k--] = l->data;
323 static int parse_multi_columns(char **columns, struct context *inc)
327 /* Clear buffer in order to set bits only. */
328 memset(inc->sample_buffer, 0, (inc->num_channels + 7) >> 3);
330 for (i = 0; i < inc->num_channels; i++) {
331 if (columns[i][0] == '1') {
332 inc->sample_buffer[i / 8] |= (1 << (i % 8));
333 } else if (!strlen(columns[i])) {
334 sr_err("Column %zu in line %zu is empty.",
335 inc->first_channel + i, inc->line_number);
337 } else if (columns[i][0] != '0') {
338 sr_err("Invalid value '%s' in column %zu in line %zu.",
339 columns[i], inc->first_channel + i,
348 static int parse_single_column(const char *column, struct context *inc)
354 switch (inc->format) {
356 res = parse_binstr(column, inc);
359 res = parse_hexstr(column, inc);
362 res = parse_octstr(column, inc);
369 static int send_samples(const struct sr_dev_inst *sdi, uint8_t *buffer,
370 gsize buffer_size, gsize count)
372 struct sr_datafeed_packet packet;
373 struct sr_datafeed_logic logic;
377 packet.type = SR_DF_LOGIC;
378 packet.payload = &logic;
379 logic.unitsize = buffer_size;
380 logic.length = buffer_size;
383 for (i = 0; i < count; i++) {
384 if ((res = sr_session_send(sdi, &packet)) != SR_OK)
391 static int init(struct sr_input *in, GHashTable *options)
396 in->sdi = g_malloc0(sizeof(struct sr_dev_inst));
397 in->priv = inc = g_malloc0(sizeof(struct context));
399 inc->single_column = g_variant_get_int32(g_hash_table_lookup(options, "single-column"));
400 inc->multi_column_mode = inc->single_column == 0;
402 inc->num_channels = g_variant_get_int32(g_hash_table_lookup(options, "numchannels"));
404 inc->delimiter = g_string_new(g_variant_get_string(
405 g_hash_table_lookup(options, "delimiter"), NULL));
406 if (inc->delimiter->len == 0) {
407 sr_err("Delimiter must be at least one character.");
411 s = g_variant_get_string(g_hash_table_lookup(options, "format"), NULL);
412 if (!g_ascii_strncasecmp(s, "bin", 3)) {
413 inc->format = FORMAT_BIN;
414 } else if (!g_ascii_strncasecmp(s, "hex", 3)) {
415 inc->format = FORMAT_HEX;
416 } else if (!g_ascii_strncasecmp(s, "oct", 3)) {
417 inc->format = FORMAT_OCT;
419 sr_err("Invalid format: '%s'", s);
423 inc->comment = g_string_new(g_variant_get_string(
424 g_hash_table_lookup(options, "comment"), NULL));
425 if (g_string_equal(inc->comment, inc->delimiter)) {
426 /* That's never going to work. Likely the result of the user
427 * setting the delimiter to ; -- the default comment. Clearing
428 * the comment setting will work in that case. */
429 g_string_truncate(inc->comment, 0);
432 inc->samplerate = g_variant_get_uint64(g_hash_table_lookup(options, "samplerate"));
434 inc->first_channel = g_variant_get_int32(g_hash_table_lookup(options, "first-channel"));
436 inc->header = g_variant_get_boolean(g_hash_table_lookup(options, "header"));
438 inc->start_line = g_variant_get_int32(g_hash_table_lookup(options, "startline"));
439 if (inc->start_line < 1) {
440 sr_err("Invalid start line %d.", inc->start_line);
444 if (inc->multi_column_mode)
445 inc->first_column = inc->first_channel;
447 inc->first_column = inc->single_column;
449 if (!inc->multi_column_mode && !inc->num_channels) {
450 sr_err("Number of channels needs to be specified in single column mode.");
457 static const char *get_line_termination(GString *buf)
462 if (g_strstr_len(buf->str, buf->len, "\r\n"))
464 else if (memchr(buf->str, '\n', buf->len))
466 else if (memchr(buf->str, '\r', buf->len))
472 static int initial_parse(const struct sr_input *in, GString *buf)
475 GString *channel_name;
476 gsize num_columns, l, i;
477 unsigned int line_number;
479 char **lines, **columns;
486 lines = g_strsplit_set(buf->str, "\r\n", 0);
487 for (l = 0; lines[l]; l++) {
489 if (inc->start_line > line_number) {
490 sr_spew("Line %zu skipped.", line_number);
493 if (lines[l][0] == '\0') {
494 sr_spew("Blank line %zu skipped.", line_number);
497 strip_comment(lines[l], inc->comment);
498 if (lines[l][0] == '\0') {
499 sr_spew("Comment-only line %zu skipped.", line_number);
503 /* Reached first proper line. */
507 /* Not enough data for a proper line yet. */
513 * In order to determine the number of columns parse the current line
514 * without limiting the number of columns.
516 if (!(columns = parse_line(lines[l], inc, -1))) {
517 sr_err("Error while parsing line %zu.", line_number);
521 num_columns = g_strv_length(columns);
523 /* Ensure that the first column is not out of bounds. */
525 sr_err("Column %zu in line %zu is out of bounds.",
526 inc->first_column, line_number);
531 if (inc->multi_column_mode) {
533 * Detect the number of channels in multi column mode
534 * automatically if not specified.
536 if (!inc->num_channels) {
537 inc->num_channels = num_columns;
538 sr_dbg("Number of auto-detected channels: %zu.",
543 * Ensure that the number of channels does not exceed the number
544 * of columns in multi column mode.
546 if (num_columns < inc->num_channels) {
547 sr_err("Not enough columns for desired number of channels in line %zu.",
554 channel_name = g_string_sized_new(64);
555 for (i = 0; i < inc->num_channels; i++) {
556 if (inc->header && inc->multi_column_mode && strlen(columns[i]))
557 g_string_assign(channel_name, columns[i]);
559 g_string_printf(channel_name, "%zu", i);
560 sr_channel_new(in->sdi, i, SR_CHANNEL_LOGIC, TRUE, channel_name->str);
562 g_string_free(channel_name, TRUE);
565 * Calculate the minimum buffer size to store the sample data of the
568 inc->sample_buffer_size = (inc->num_channels + 7) >> 3;
569 inc->sample_buffer = g_malloc(inc->sample_buffer_size);
579 static int initial_receive(const struct sr_input *in)
585 const char *termination;
589 if (!(termination = get_line_termination(in->buf)))
590 /* Don't have a full line yet. */
593 if (!(p = g_strrstr_len(in->buf->str, in->buf->len, termination)))
594 /* Don't have a full line yet. */
596 len = p - in->buf->str - 1;
597 new_buf = g_string_new_len(in->buf->str, len);
598 g_string_append_c(new_buf, '\0');
600 inc->termination = g_strdup(termination);
602 if (in->buf->str[0] != '\0')
603 ret = initial_parse(in, new_buf);
607 g_string_free(new_buf, TRUE);
612 static int process_buffer(struct sr_input *in)
614 struct sr_datafeed_packet packet;
615 struct sr_datafeed_meta meta;
616 struct sr_config *src;
620 int max_columns, ret, l;
621 char *p, **lines, **columns;
625 std_session_send_df_header(in->sdi, LOG_PREFIX);
627 if (inc->samplerate) {
628 packet.type = SR_DF_META;
629 packet.payload = &meta;
630 samplerate = inc->samplerate;
631 src = sr_config_new(SR_CONF_SAMPLERATE, g_variant_new_uint64(samplerate));
632 meta.config = g_slist_append(NULL, src);
633 sr_session_send(in->sdi, &packet);
640 if (!(p = g_strrstr_len(in->buf->str, in->buf->len, inc->termination)))
641 /* Don't have a full line. */
645 g_strstrip(in->buf->str);
647 /* Limit the number of columns to parse. */
648 if (inc->multi_column_mode)
649 max_columns = inc->num_channels;
654 lines = g_strsplit_set(in->buf->str, "\r\n", 0);
655 for (l = 0; lines[l]; l++) {
657 if (lines[l][0] == '\0') {
658 sr_spew("Blank line %zu skipped.", inc->line_number);
662 /* Remove trailing comment. */
663 strip_comment(lines[l], inc->comment);
664 if (lines[l][0] == '\0') {
665 sr_spew("Comment-only line %zu skipped.", inc->line_number);
669 /* Skip the header line, its content was used as the channel names. */
671 sr_spew("Header line %zu skipped.", inc->line_number);
676 if (!(columns = parse_line(lines[l], inc, max_columns))) {
677 sr_err("Error while parsing line %zu.", inc->line_number);
680 num_columns = g_strv_length(columns);
682 sr_err("Column %zu in line %zu is out of bounds.",
683 inc->first_column, inc->line_number);
688 * Ensure that the number of channels does not exceed the number
689 * of columns in multi column mode.
691 if (inc->multi_column_mode && num_columns < inc->num_channels) {
692 sr_err("Not enough columns for desired number of channels in line %zu.",
698 if (inc->multi_column_mode)
699 ret = parse_multi_columns(columns, inc);
701 ret = parse_single_column(columns[0], inc);
707 /* Send sample data to the session bus. */
708 ret = send_samples(in->sdi, inc->sample_buffer,
709 inc->sample_buffer_size, 1);
711 sr_err("Sending samples failed.");
717 g_string_erase(in->buf, 0, p - in->buf->str + 1);
722 static int receive(struct sr_input *in, GString *buf)
727 g_string_append_len(in->buf, buf->str, buf->len);
730 if (!inc->termination) {
731 if ((ret = initial_receive(in)) == SR_ERR_NA)
732 /* Not enough data yet. */
734 else if (ret != SR_OK)
737 /* sdi is ready, notify frontend. */
738 in->sdi_ready = TRUE;
742 ret = process_buffer(in);
747 static int end(struct sr_input *in)
750 struct sr_datafeed_packet packet;
754 ret = process_buffer(in);
761 packet.type = SR_DF_END;
762 sr_session_send(in->sdi, &packet);
768 static void cleanup(struct sr_input *in)
775 g_string_free(inc->delimiter, TRUE);
778 g_string_free(inc->comment, TRUE);
780 g_free(inc->termination);
781 g_free(inc->sample_buffer);
784 static struct sr_option options[] = {
785 { "single-column", "Single column", "Enable/specify single column", NULL, NULL },
786 { "numchannels", "Max channels", "Number of channels", NULL, NULL },
787 { "delimiter", "Delimiter", "Column delimiter", NULL, NULL },
788 { "format", "Format", "Numeric format", NULL, NULL },
789 { "comment", "Comment", "Comment prefix character", NULL, NULL },
790 { "samplerate", "Samplerate", "Samplerate used during capture", NULL, NULL },
791 { "first-channel", "First channel", "Column number of first channel", NULL, NULL },
792 { "header", "Header", "Treat first line as header with channel names", NULL, NULL },
793 { "startline", "Start line", "Line number at which to start processing samples", NULL, NULL },
797 static struct sr_option *get_options(void)
799 if (!options[0].def) {
800 options[0].def = g_variant_ref_sink(g_variant_new_int32(0));
801 options[1].def = g_variant_ref_sink(g_variant_new_int32(0));
802 options[2].def = g_variant_ref_sink(g_variant_new_string(","));
803 options[3].def = g_variant_ref_sink(g_variant_new_string("bin"));
804 options[4].def = g_variant_ref_sink(g_variant_new_string(";"));
805 options[5].def = g_variant_ref_sink(g_variant_new_uint64(0));
806 options[6].def = g_variant_ref_sink(g_variant_new_int32(0));
807 options[7].def = g_variant_ref_sink(g_variant_new_boolean(FALSE));
808 options[8].def = g_variant_ref_sink(g_variant_new_int32(1));
814 SR_PRIV struct sr_input_module input_csv = {
817 .desc = "Comma-separated values",
818 .exts = (const char*[]){"csv", NULL},
819 .metadata = { SR_INPUT_META_MIMETYPE },
820 .options = get_options,
821 .format_match = format_match,