+ if (b < 0) {
+ free(ctx->header);
+ free(ctx);
+ return SR_ERR;
+ }
+
+ return 0;
+}
+
+static int analog_data(struct sr_output *o, char *data_in, uint64_t length_in,
+ char **data_out, uint64_t *length_out)
+{
+ struct context *ctx;
+ unsigned int max_linelen, outsize, p, /* curbit, */ i;
+// uint64_t sample;
+ static uint64_t samplecount = 0;
+ char *outbuf, *c;
+ struct analog_sample *sample;
+
+ ctx = o->internal;
+// max_linelen = 16 + ctx->num_enabled_probes * 2;
+ max_linelen = 16 + ctx->num_enabled_probes * 30;
+ outsize = length_in / ctx->unitsize * max_linelen;
+ if (ctx->header)
+ outsize += strlen(ctx->header);
+
+ if (!(outbuf = calloc(1, outsize)))
+ return SR_ERR_MALLOC;
+
+ outbuf[0] = '\0';
+ if (ctx->header) {
+ /* The header is still here, this must be the first packet. */
+ strncpy(outbuf, ctx->header, outsize);
+ free(ctx->header);
+ ctx->header = NULL;
+ }
+
+ for (i = 0; i <= length_in - ctx->unitsize; i += ctx->unitsize) {
+// memcpy(&sample, data_in + i, ctx->unitsize);
+ sample = (struct analog_sample *) (data_in + i);
+
+ /* The first column is a counter (needed for gnuplot). */
+ c = outbuf + strlen(outbuf);
+ sprintf(c, "%" PRIu64 "\t", samplecount++);
+
+ /* The next columns are the values of all channels. */
+ for (p = 0; p < ctx->num_enabled_probes; p++) {
+// curbit = (sample & ((uint64_t) (1 << p))) >> p;
+ c = outbuf + strlen(outbuf);
+// sprintf(c, "%d ", curbit);
+ /*
+ * FIXME: Should be doing proper raw->voltage conversion
+ * here, casting to int16_t isn't it. Remember that if
+ * res = 1 conversion isn't necessary.
+ */
+ sprintf(c, "%f ", (double) ((int16_t) (sample->probes[p].val &
+ ((1 << sample->probes[p].res) - 1))));
+ }
+
+ c = outbuf + strlen(outbuf);
+ sprintf(c, "\n");