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/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 context *inc;
  43         int num_channels, i;
  44         char name[16];
  45
  46         num_channels = g_variant_get_int32(g_hash_table_lookup(options, "numchannels"));
  47         if (num_channels < 1) {
  48                 sr_err("Invalid value for numchannels: must be at least 1.");
  49                 return SR_ERR_ARG;
  50         }
  51
  52         in->sdi = g_malloc0(sizeof(struct sr_dev_inst));
  53         in->priv = inc = g_malloc0(sizeof(struct context));
  54
  55         inc->samplerate = g_variant_get_uint64(g_hash_table_lookup(options, "samplerate"));
  56
  57         for (i = 0; i < num_channels; i++) {
  58                 snprintf(name, 16, "%d", i);
  59                 sr_channel_new(in->sdi, i, SR_CHANNEL_LOGIC, TRUE, name);
  60         }
  61
  62         return SR_OK;
  63 }
  64
  65 static int process_buffer(struct sr_input *in)
  66 {
  67         struct sr_datafeed_packet packet;
  68         struct sr_datafeed_meta meta;
  69         struct sr_datafeed_logic logic;
  70         struct sr_config *src;
  71         struct context *inc;
  72         gsize chunk_size, i;
  73         int chunk;
  74
  75         inc = in->priv;
  76         if (!inc->started) {
  77                 std_session_send_df_header(in->sdi, LOG_PREFIX);
  78
  79                 if (inc->samplerate) {
  80                         packet.type = SR_DF_META;
  81                         packet.payload = &meta;
  82                         src = sr_config_new(SR_CONF_SAMPLERATE, g_variant_new_uint64(inc->samplerate));
  83                         meta.config = g_slist_append(NULL, src);
  84                         sr_session_send(in->sdi, &packet);
  85                         sr_config_free(src);
  86                 }
  87
  88                 inc->started = TRUE;
  89         }
  90
  91         packet.type = SR_DF_LOGIC;
  92         packet.payload = &logic;
  93         logic.unitsize = (g_slist_length(in->sdi->channels) + 7) / 8;
  94
  95         /* Cut off at multiple of unitsize. */
  96         chunk_size = in->buf->len / logic.unitsize * logic.unitsize;
  97
  98         for (i = 0; i < chunk_size; i += chunk) {
  99                 logic.data = in->buf->str + i;
 100                 chunk = MIN(MAX_CHUNK_SIZE, chunk_size - i);
 101                 logic.length = chunk;
 102                 sr_session_send(in->sdi, &packet);
 103         }
 104         g_string_erase(in->buf, 0, chunk_size);
 105
 106         return SR_OK;
 107 }
 108
 109 static int receive(struct sr_input *in, GString *buf)
 110 {
 111         int ret;
 112
 113         g_string_append_len(in->buf, buf->str, buf->len);
 114
 115         if (!in->sdi_ready) {
 116                 /* sdi is ready, notify frontend. */
 117                 in->sdi_ready = TRUE;
 118                 return SR_OK;
 119         }
 120
 121         ret = process_buffer(in);
 122
 123         return ret;
 124 }
 125
 126 static int end(struct sr_input *in)
 127 {
 128         struct context *inc;
 129         struct sr_datafeed_packet packet;
 130         int ret;
 131
 132         if (in->sdi_ready)
 133                 ret = process_buffer(in);
 134         else
 135                 ret = SR_OK;
 136
 137         inc = in->priv;
 138         if (inc->started) {
 139                 packet.type = SR_DF_END;
 140                 sr_session_send(in->sdi, &packet);
 141         }
 142
 143         return ret;
 144 }
 145
 146 static struct sr_option options[] = {
 147         { "numchannels", "Number of channels", "Number of channels", NULL, NULL },
 148         { "samplerate", "Sample rate", "Sample rate", NULL, NULL },
 149         ALL_ZERO
 150 };
 151
 152 static struct sr_option *get_options(void)
 153 {
 154         if (!options[0].def) {
 155                 options[0].def = g_variant_ref_sink(g_variant_new_int32(DEFAULT_NUM_CHANNELS));
 156                 options[1].def = g_variant_ref_sink(g_variant_new_uint64(DEFAULT_SAMPLERATE));
 157         }
 158
 159         return options;
 160 }
 161
 162 SR_PRIV struct sr_input_module input_binary = {
 163         .id = "binary",
 164         .name = "Binary",
 165         .desc = "Raw binary",
 166         .exts = NULL,
 167         .options = get_options,
 168         .init = init,
 169         .receive = receive,
 170         .end = end,
 171 };