2 * This file is part of the libsigrok project.
4 * Copyright (C) 2013 Bert Vermeulen <bert@biot.com>
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/>.
21 #include <sys/types.h>
26 #include "libsigrok.h"
27 #include "libsigrok-internal.h"
29 /* Message logging helpers with subsystem-specific prefix string. */
30 #define LOG_PREFIX "input/binary: "
31 #define sr_log(l, s, args...) sr_log(l, LOG_PREFIX s, ## args)
32 #define sr_spew(s, args...) sr_spew(LOG_PREFIX s, ## args)
33 #define sr_dbg(s, args...) sr_dbg(LOG_PREFIX s, ## args)
34 #define sr_info(s, args...) sr_info(LOG_PREFIX s, ## args)
35 #define sr_warn(s, args...) sr_warn(LOG_PREFIX s, ## args)
36 #define sr_err(s, args...) sr_err(LOG_PREFIX s, ## args)
38 #define CHUNKSIZE (512 * 1024)
39 #define DEFAULT_NUM_PROBES 8
45 static int format_match(const char *filename)
49 /* This module will handle anything you throw at it. */
53 static int init(struct sr_input *in, const char *filename)
55 struct sr_probe *probe;
57 char name[SR_MAX_PROBENAME_LEN + 1];
63 if (!(ctx = g_try_malloc0(sizeof(*ctx)))) {
64 sr_err("Input format context malloc failed.");
68 num_probes = DEFAULT_NUM_PROBES;
72 param = g_hash_table_lookup(in->param, "numprobes");
74 num_probes = strtoul(param, NULL, 10);
79 param = g_hash_table_lookup(in->param, "samplerate");
81 if (sr_parse_sizestring(param, &ctx->samplerate) != SR_OK)
86 /* Create a virtual device. */
87 in->sdi = sr_dev_inst_new(0, SR_ST_ACTIVE, NULL, NULL, NULL);
90 for (i = 0; i < num_probes; i++) {
91 snprintf(name, SR_MAX_PROBENAME_LEN, "%d", i);
92 /* TODO: Check return value. */
93 if (!(probe = sr_probe_new(i, SR_PROBE_LOGIC, TRUE, name)))
95 in->sdi->probes = g_slist_append(in->sdi->probes, probe);
101 static int loadfile(struct sr_input *in, const char *filename)
103 struct sr_datafeed_packet packet;
104 struct sr_datafeed_meta meta;
105 struct sr_datafeed_logic logic;
106 struct sr_config *src;
107 unsigned char buffer[CHUNKSIZE];
108 int fd, size, num_probes;
113 if ((fd = open(filename, O_RDONLY)) == -1)
116 num_probes = g_slist_length(in->sdi->probes);
118 /* Send header packet to the session bus. */
119 std_session_send_df_header(in->sdi, LOG_PREFIX);
121 if (ctx->samplerate) {
122 packet.type = SR_DF_META;
123 packet.payload = &meta;
124 src = sr_config_new(SR_CONF_SAMPLERATE,
125 g_variant_new_uint64(ctx->samplerate));
126 meta.config = g_slist_append(NULL, src);
127 sr_session_send(in->sdi, &packet);
131 /* Chop up the input file into chunks & send it to the session bus. */
132 packet.type = SR_DF_LOGIC;
133 packet.payload = &logic;
134 logic.unitsize = (num_probes + 7) / 8;
136 while ((size = read(fd, buffer, CHUNKSIZE)) > 0) {
138 sr_session_send(in->sdi, &packet);
142 /* Send end packet to the session bus. */
143 packet.type = SR_DF_END;
144 sr_session_send(in->sdi, &packet);
152 SR_PRIV struct sr_input_format input_binary = {
154 .description = "Raw binary",
155 .format_match = format_match,
157 .loadfile = loadfile,