src/input/chronovu_la8.c

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