2 * This file is part of the sigrok project.
4 * Copyright (C) 2010-2012 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 driver-specific prefix string. */
30 #define DRIVER_LOG_DOMAIN "input/binary: "
31 #define sr_log(l, s, args...) sr_log(l, DRIVER_LOG_DOMAIN s, ## args)
32 #define sr_spew(s, args...) sr_spew(DRIVER_LOG_DOMAIN s, ## args)
33 #define sr_dbg(s, args...) sr_dbg(DRIVER_LOG_DOMAIN s, ## args)
34 #define sr_info(s, args...) sr_info(DRIVER_LOG_DOMAIN s, ## args)
35 #define sr_warn(s, args...) sr_warn(DRIVER_LOG_DOMAIN s, ## args)
36 #define sr_err(s, args...) sr_err(DRIVER_LOG_DOMAIN 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)
55 struct sr_probe *probe;
57 char name[SR_MAX_PROBENAME_LEN + 1];
61 if (!(ctx = g_try_malloc0(sizeof(*ctx)))) {
62 sr_err("Input format context malloc failed.");
66 num_probes = DEFAULT_NUM_PROBES;
70 param = g_hash_table_lookup(in->param, "numprobes");
72 num_probes = strtoul(param, NULL, 10);
77 param = g_hash_table_lookup(in->param, "samplerate");
79 if (sr_parse_sizestring(param, &ctx->samplerate) != SR_OK)
84 /* Create a virtual device. */
85 in->sdi = sr_dev_inst_new(0, SR_ST_ACTIVE, NULL, NULL, NULL);
88 for (i = 0; i < num_probes; i++) {
89 snprintf(name, SR_MAX_PROBENAME_LEN, "%d", i);
90 /* TODO: Check return value. */
91 if (!(probe = sr_probe_new(i, SR_PROBE_LOGIC, TRUE, name)))
93 in->sdi->probes = g_slist_append(in->sdi->probes, probe);
99 static int loadfile(struct sr_input *in, const char *filename)
101 struct sr_datafeed_header header;
102 struct sr_datafeed_packet packet;
103 struct sr_datafeed_meta_logic meta;
104 struct sr_datafeed_logic logic;
105 unsigned char buffer[CHUNKSIZE];
106 int fd, size, num_probes;
111 if ((fd = open(filename, O_RDONLY)) == -1)
114 num_probes = g_slist_length(in->sdi->probes);
116 /* Send header packet to the session bus. */
117 header.feed_version = 1;
118 gettimeofday(&header.starttime, NULL);
119 packet.type = SR_DF_HEADER;
120 packet.payload = &header;
121 sr_session_send(in->sdi, &packet);
123 /* Send metadata about the SR_DF_LOGIC packets to come. */
124 packet.type = SR_DF_META_LOGIC;
125 packet.payload = &meta;
126 meta.samplerate = ctx->samplerate;
127 meta.num_probes = num_probes;
128 sr_session_send(in->sdi, &packet);
130 /* Chop up the input file into chunks & send it to the session bus. */
131 packet.type = SR_DF_LOGIC;
132 packet.payload = &logic;
133 logic.unitsize = (num_probes + 7) / 8;
135 while ((size = read(fd, buffer, CHUNKSIZE)) > 0) {
137 sr_session_send(in->sdi, &packet);
141 /* Send end packet to the session bus. */
142 packet.type = SR_DF_END;
143 sr_session_send(in->sdi, &packet);
151 SR_PRIV struct sr_input_format input_binary = {
153 .description = "Raw binary",
154 .format_match = format_match,
156 .loadfile = loadfile,