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 <config.h>
  22 #include <stdlib.h>
  23 #include <fcntl.h>
  24 #include <unistd.h>
  25 #include <sys/stat.h>
  26 #include <libsigrok/libsigrok.h>
  27 #include "libsigrok-internal.h"
  28
  29 #define LOG_PREFIX "input/chronovu-la8"
  30
  31 #define DEFAULT_NUM_CHANNELS    8
  32 #define DEFAULT_SAMPLERATE      SR_MHZ(100)
  33 #define MAX_CHUNK_SIZE          (4 * 1024)
  34 #define CHRONOVU_LA8_FILESIZE   ((8 * 1024 * 1024) + 5)
  35
  36 struct context {
  37         gboolean started;
  38         uint64_t samplerate;
  39 };
  40
  41 static int format_match(GHashTable *metadata)
  42 {
  43         int size;
  44
  45         size = GPOINTER_TO_INT(g_hash_table_lookup(metadata,
  46                         GINT_TO_POINTER(SR_INPUT_META_FILESIZE)));
  47         if (size == CHRONOVU_LA8_FILESIZE)
  48                 return SR_OK;
  49
  50         return SR_ERR;
  51 }
  52
  53 static int init(struct sr_input *in, GHashTable *options)
  54 {
  55         struct context *inc;
  56         int num_channels, i;
  57         char name[16];
  58
  59         num_channels = g_variant_get_int32(g_hash_table_lookup(options, "numchannels"));
  60         if (num_channels < 1) {
  61                 sr_err("Invalid value for numchannels: must be at least 1.");
  62                 return SR_ERR_ARG;
  63         }
  64
  65         in->sdi = g_malloc0(sizeof(struct sr_dev_inst));
  66         in->priv = inc = g_malloc0(sizeof(struct context));
  67
  68         inc->samplerate = g_variant_get_uint64(g_hash_table_lookup(options, "samplerate"));
  69
  70         for (i = 0; i < num_channels; i++) {
  71                 snprintf(name, 16, "%d", i);
  72                 sr_channel_new(in->sdi, i, SR_CHANNEL_LOGIC, TRUE, name);
  73         }
  74
  75         return SR_OK;
  76 }
  77
  78 static int process_buffer(struct sr_input *in)
  79 {
  80         struct sr_datafeed_packet packet;
  81         struct sr_datafeed_meta meta;
  82         struct sr_datafeed_logic logic;
  83         struct sr_config *src;
  84         struct context *inc;
  85         gsize chunk_size, i;
  86         int chunk;
  87
  88         inc = in->priv;
  89         if (!inc->started) {
  90                 std_session_send_df_header(in->sdi, LOG_PREFIX);
  91
  92                 if (inc->samplerate) {
  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                         g_slist_free(meta.config);
  99                         sr_config_free(src);
 100                 }
 101
 102                 inc->started = TRUE;
 103         }
 104
 105         packet.type = SR_DF_LOGIC;
 106         packet.payload = &logic;
 107         logic.unitsize = (g_slist_length(in->sdi->channels) + 7) / 8;
 108
 109         /* Cut off at multiple of unitsize. */
 110         chunk_size = in->buf->len / logic.unitsize * logic.unitsize;
 111
 112         for (i = 0; i < chunk_size; i += chunk) {
 113                 logic.data = in->buf->str + i;
 114                 chunk = MIN(MAX_CHUNK_SIZE, chunk_size - i);
 115                 logic.length = chunk;
 116                 sr_session_send(in->sdi, &packet);
 117         }
 118         g_string_erase(in->buf, 0, chunk_size);
 119
 120         return SR_OK;
 121 }
 122
 123 static int receive(struct sr_input *in, GString *buf)
 124 {
 125         int ret;
 126
 127         g_string_append_len(in->buf, buf->str, buf->len);
 128
 129         if (!in->sdi_ready) {
 130                 /* sdi is ready, notify frontend. */
 131                 in->sdi_ready = TRUE;
 132                 return SR_OK;
 133         }
 134
 135         ret = process_buffer(in);
 136
 137         return ret;
 138 }
 139
 140 static int end(struct sr_input *in)
 141 {
 142         struct context *inc;
 143         int ret;
 144
 145         if (in->sdi_ready)
 146                 ret = process_buffer(in);
 147         else
 148                 ret = SR_OK;
 149
 150         inc = in->priv;
 151         if (inc->started)
 152                 std_session_send_df_end(in->sdi, LOG_PREFIX);
 153
 154         return ret;
 155 }
 156
 157 static struct sr_option options[] = {
 158         { "numchannels", "Number of channels", "Number of channels", NULL, NULL },
 159         { "samplerate", "Sample rate", "Sample rate", NULL, NULL },
 160         ALL_ZERO
 161 };
 162
 163 static const struct sr_option *get_options(void)
 164 {
 165         if (!options[0].def) {
 166                 options[0].def = g_variant_ref_sink(g_variant_new_int32(DEFAULT_NUM_CHANNELS));
 167                 options[1].def = g_variant_ref_sink(g_variant_new_uint64(DEFAULT_SAMPLERATE));
 168         }
 169
 170         return options;
 171 }
 172
 173 SR_PRIV struct sr_input_module input_chronovu_la8 = {
 174         .id = "chronovu-la8",
 175         .name = "Chronovu-LA8",
 176         .desc = "ChronoVu LA8",
 177         .exts = (const char*[]){"kdt", NULL},
 178         .metadata = { SR_INPUT_META_FILESIZE | SR_INPUT_META_REQUIRED },
 179         .options = get_options,
 180         .format_match = format_match,
 181         .init = init,
 182         .receive = receive,
 183         .end = end,
 184 };