src/input/binary.c

   1 /*
   2  * This file is part of the libsigrok project.
   3  *
   4  * Copyright (C) 2013 Bert Vermeulen <bert@biot.com>
   5  *
   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.
  10  *
  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.
  15  *
  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/>.
  18  */
  19
  20 #include <stdlib.h>
  21 #include <sys/types.h>
  22 #include <sys/stat.h>
  23 #include <fcntl.h>
  24 #include <unistd.h>
  25 #include <sys/time.h>
  26 #include "libsigrok.h"
  27 #include "libsigrok-internal.h"
  28
  29 #define LOG_PREFIX "input/binary"
  30
  31 #define MAX_CHUNK_SIZE        4096
  32 #define DEFAULT_NUM_CHANNELS  8
  33 #define DEFAULT_SAMPLERATE    "0"
  34
  35 struct context {
  36         gboolean started;
  37         uint64_t samplerate;
  38 };
  39
  40 static int init(struct sr_input *in, GHashTable *options)
  41 {
  42         struct sr_channel *ch;
  43         struct context *inc;
  44         uint64_t samplerate;
  45         int num_channels, i;
  46         const char *s;
  47         char name[16];
  48
  49         num_channels = g_variant_get_int32(g_hash_table_lookup(options, "numchannels"));
  50         if (num_channels < 1) {
  51                 sr_err("Invalid value for numchannels: must be at least 1.");
  52                 return SR_ERR_ARG;
  53         }
  54
  55         s = g_variant_get_string(g_hash_table_lookup(options, "samplerate"), NULL);
  56         if (sr_parse_sizestring(s, &samplerate) != SR_OK) {
  57                 sr_err("Invalid samplerate '%s'.", s);
  58                 return SR_ERR_ARG;
  59         }
  60
  61         in->sdi = sr_dev_inst_new(0, SR_ST_ACTIVE, NULL, NULL, NULL);
  62         in->priv = inc = g_malloc0(sizeof(struct context));
  63         inc->samplerate = samplerate;
  64
  65         for (i = 0; i < num_channels; i++) {
  66                 snprintf(name, 16, "%d", i);
  67                 ch = sr_channel_new(i, SR_CHANNEL_LOGIC, TRUE, name);
  68                 in->sdi->channels = g_slist_append(in->sdi->channels, ch);
  69         }
  70
  71         return SR_OK;
  72 }
  73
  74 static int receive(const struct sr_input *in, GString *buf)
  75 {
  76         struct sr_datafeed_packet packet;
  77         struct sr_datafeed_meta meta;
  78         struct sr_datafeed_logic logic;
  79         struct sr_config *src;
  80         struct context *inc;
  81         gsize chunk_size, i;
  82         int chunk, num_channels;
  83
  84         inc = in->priv;
  85
  86         g_string_append_len(in->buf, buf->str, buf->len);
  87
  88         num_channels = g_slist_length(in->sdi->channels);
  89
  90         std_session_send_df_header(in->sdi, LOG_PREFIX);
  91         inc->started = TRUE;
  92
  93         packet.type = SR_DF_META;
  94         packet.payload = &meta;
  95         src = sr_config_new(SR_CONF_SAMPLERATE, g_variant_new_uint64(inc->samplerate));
  96         meta.config = g_slist_append(NULL, src);
  97         sr_session_send(in->sdi, &packet);
  98         sr_config_free(src);
  99
 100         packet.type = SR_DF_LOGIC;
 101         packet.payload = &logic;
 102         logic.unitsize = (num_channels + 7) / 8;
 103         logic.data = in->buf->str;
 104
 105         /* Cut off at multiple of unitsize. */
 106         chunk_size = in->buf->len / logic.unitsize * logic.unitsize;
 107
 108         chunk = 0;
 109         for (i = 0; i < chunk_size; i += chunk) {
 110                 chunk = MAX(MAX_CHUNK_SIZE, chunk_size - i);
 111                 logic.length = chunk;
 112                 sr_session_send(in->sdi, &packet);
 113         }
 114
 115         if (in->buf->len > chunk_size)
 116                 g_string_erase(in->buf, 0, in->buf->len - chunk_size);
 117
 118         return SR_OK;
 119 }
 120
 121 static int cleanup(struct sr_input *in)
 122 {
 123         struct sr_datafeed_packet packet;
 124         struct context *inc;
 125
 126         inc = in->priv;
 127
 128         if (inc->started) {
 129                 packet.type = SR_DF_END;
 130                 sr_session_send(in->sdi, &packet);
 131         }
 132         g_free(in->priv);
 133         in->priv = NULL;
 134
 135         return SR_OK;
 136 }
 137
 138 static struct sr_option options[] = {
 139         { "numchannels", "Number of channels", "Number of channels", NULL, NULL },
 140         { "samplerate", "Sample rate", "Sample rate", NULL, NULL },
 141         ALL_ZERO
 142 };
 143
 144 static struct sr_option *get_options(void)
 145 {
 146         if (!options[0].def) {
 147                 options[0].def = g_variant_ref_sink(g_variant_new_int32(DEFAULT_NUM_CHANNELS));
 148                 options[1].def = g_variant_ref_sink(g_variant_new_string(DEFAULT_SAMPLERATE));
 149         }
 150
 151         return options;
 152 }
 153
 154 SR_PRIV struct sr_input_module input_binary = {
 155         .id = "binary",
 156         .name = "Binary",
 157         .desc = "Raw binary",
 158         .options = get_options,
 159         .init = init,
 160         .receive = receive,
 161         .cleanup = cleanup,
 162 };