]> sigrok.org Git - pulseview.git/blame - pv/data/decodesignal.cpp
DecodeSignal: Break up annotation storage to allow multiple segments
[pulseview.git] / pv / data / decodesignal.cpp
CommitLineData
ad908057
SA
1/*
2 * This file is part of the PulseView project.
3 *
4 * Copyright (C) 2017 Soeren Apel <soeren@apelpie.net>
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, see <http://www.gnu.org/licenses/>.
18 */
19
0c5fe73e
SA
20#include <limits>
21
47747218
SA
22#include <QDebug>
23
ad908057
SA
24#include "logic.hpp"
25#include "logicsegment.hpp"
26#include "decodesignal.hpp"
27#include "signaldata.hpp"
28
29#include <pv/binding/decoder.hpp>
30#include <pv/data/decode/decoder.hpp>
ecd07c20 31#include <pv/data/decode/row.hpp>
d3feec23 32#include <pv/globalsettings.hpp>
ad908057
SA
33#include <pv/session.hpp>
34
47747218
SA
35using std::lock_guard;
36using std::make_pair;
ad908057 37using std::make_shared;
0c5fe73e 38using std::min;
ad908057 39using std::shared_ptr;
47747218
SA
40using std::unique_lock;
41using pv::data::decode::Annotation;
ad908057 42using pv::data::decode::Decoder;
ecd07c20 43using pv::data::decode::Row;
ad908057
SA
44
45namespace pv {
46namespace data {
47
47747218
SA
48const double DecodeSignal::DecodeMargin = 1.0;
49const double DecodeSignal::DecodeThreshold = 0.2;
3fbddf7f 50const int64_t DecodeSignal::DecodeChunkLength = 256 * 1024;
ad908057 51
ad908057 52
47747218
SA
53DecodeSignal::DecodeSignal(pv::Session &session) :
54 SignalBase(nullptr, SignalBase::DecodeChannel),
55 session_(session),
e91883bb 56 srd_session_(nullptr),
47747218
SA
57 logic_mux_data_invalid_(false),
58 start_time_(0),
59 samplerate_(0),
47747218
SA
60 samples_decoded_(0),
61 frame_complete_(false)
ad908057 62{
47747218
SA
63 connect(&session_, SIGNAL(capture_state_changed(int)),
64 this, SLOT(on_capture_state_changed(int)));
ad908057
SA
65}
66
47747218 67DecodeSignal::~DecodeSignal()
ad908057 68{
1b56c646 69 reset_decode();
ad908057
SA
70}
71
47747218 72const vector< shared_ptr<Decoder> >& DecodeSignal::decoder_stack() const
ecd07c20 73{
47747218 74 return stack_;
ecd07c20
SA
75}
76
c8e60bdf 77void DecodeSignal::stack_decoder(const srd_decoder *decoder)
ad908057
SA
78{
79 assert(decoder);
762ab7a4
SA
80 const shared_ptr<Decoder> dec = make_shared<decode::Decoder>(decoder);
81
82 stack_.push_back(dec);
47747218
SA
83
84 // Set name if this decoder is the first in the list
85 if (stack_.size() == 1)
86 set_name(QString::fromUtf8(decoder->name));
132a5c6d 87
27a3f09b 88 // Include the newly created decode channels in the channel lists
9f97b357 89 update_channel_list();
132a5c6d 90
762ab7a4 91 auto_assign_signals(dec);
27a3f09b 92 commit_decoder_channels();
47747218 93 begin_decode();
ad908057
SA
94}
95
96void DecodeSignal::remove_decoder(int index)
97{
47747218
SA
98 assert(index >= 0);
99 assert(index < (int)stack_.size());
100
101 // Find the decoder in the stack
102 auto iter = stack_.begin();
103 for (int i = 0; i < index; i++, iter++)
104 assert(iter != stack_.end());
105
106 // Delete the element
107 stack_.erase(iter);
108
109 // Update channels and decoded data
9f97b357 110 update_channel_list();
47747218 111 begin_decode();
ad908057
SA
112}
113
114bool DecodeSignal::toggle_decoder_visibility(int index)
115{
47747218 116 auto iter = stack_.cbegin();
ad908057 117 for (int i = 0; i < index; i++, iter++)
47747218 118 assert(iter != stack_.end());
ad908057
SA
119
120 shared_ptr<Decoder> dec = *iter;
121
122 // Toggle decoder visibility
123 bool state = false;
124 if (dec) {
125 state = !dec->shown();
126 dec->show(state);
127 }
128
129 return state;
130}
131
47747218
SA
132void DecodeSignal::reset_decode()
133{
1b56c646
SA
134 if (decode_thread_.joinable()) {
135 decode_interrupt_ = true;
136 decode_input_cond_.notify_one();
137 decode_thread_.join();
138 }
139
140 if (logic_mux_thread_.joinable()) {
141 logic_mux_interrupt_ = true;
142 logic_mux_cond_.notify_one();
143 logic_mux_thread_.join();
144 }
145
e91883bb
SA
146 stop_srd_session();
147
47747218
SA
148 frame_complete_ = false;
149 samples_decoded_ = 0;
150 error_message_ = QString();
1b56c646 151
47747218 152 rows_.clear();
4913560f 153 current_rows_= nullptr;
47747218 154 class_rows_.clear();
1b56c646
SA
155
156 logic_mux_data_.reset();
157 logic_mux_data_invalid_ = true;
47747218
SA
158}
159
946b52e1
SA
160void DecodeSignal::begin_decode()
161{
47747218
SA
162 if (decode_thread_.joinable()) {
163 decode_interrupt_ = true;
164 decode_input_cond_.notify_one();
165 decode_thread_.join();
166 }
167
168 if (logic_mux_thread_.joinable()) {
169 logic_mux_interrupt_ = true;
170 logic_mux_cond_.notify_one();
171 logic_mux_thread_.join();
172 }
173
174 reset_decode();
175
27a3f09b
SA
176 if (stack_.size() == 0) {
177 error_message_ = tr("No decoders");
178 return;
179 }
180
181 assert(channels_.size() > 0);
182
183 if (get_assigned_signal_count() == 0) {
184 error_message_ = tr("There are no channels assigned to this decoder");
185 return;
186 }
187
04627946
SA
188 // Make sure that all assigned channels still provide logic data
189 // (can happen when a converted signal was assigned but the
190 // conversion removed in the meanwhile)
191 for (data::DecodeChannel &ch : channels_)
192 if (ch.assigned_signal && !(ch.assigned_signal->logic_data() != nullptr))
193 ch.assigned_signal = nullptr;
194
47747218
SA
195 // Check that all decoders have the required channels
196 for (const shared_ptr<decode::Decoder> &dec : stack_)
197 if (!dec->have_required_channels()) {
198 error_message_ = tr("One or more required channels "
199 "have not been specified");
200 return;
201 }
202
4913560f 203 // Map out all the annotation classes
47747218
SA
204 for (const shared_ptr<decode::Decoder> &dec : stack_) {
205 assert(dec);
206 const srd_decoder *const decc = dec->decoder();
207 assert(dec->decoder());
208
47747218
SA
209 for (const GSList *l = decc->annotation_rows; l; l = l->next) {
210 const srd_decoder_annotation_row *const ann_row =
211 (srd_decoder_annotation_row *)l->data;
212 assert(ann_row);
213
214 const Row row(decc, ann_row);
215
47747218
SA
216 for (const GSList *ll = ann_row->ann_classes;
217 ll; ll = ll->next)
218 class_rows_[make_pair(decc,
219 GPOINTER_TO_INT(ll->data))] = row;
220 }
221 }
222
4913560f
SA
223 prepare_annotation_segment();
224
27a3f09b
SA
225 // Free the logic data and its segment(s) if it needs to be updated
226 if (logic_mux_data_invalid_)
227 logic_mux_data_.reset();
228
229 if (!logic_mux_data_) {
230 const int64_t ch_count = get_assigned_signal_count();
231 const int64_t unit_size = (ch_count + 7) / 8;
232 logic_mux_data_ = make_shared<Logic>(ch_count);
83b9c07b
SA
233 logic_mux_segment_ = make_shared<LogicSegment>(*logic_mux_data_, unit_size, samplerate_);
234 logic_mux_data_->push_segment(logic_mux_segment_);
27a3f09b 235 }
47747218 236
27a3f09b
SA
237 // Make sure the logic output data is complete and up-to-date
238 logic_mux_interrupt_ = false;
239 logic_mux_thread_ = std::thread(&DecodeSignal::logic_mux_proc, this);
240
241 // Decode the muxed logic data
47747218
SA
242 decode_interrupt_ = false;
243 decode_thread_ = std::thread(&DecodeSignal::decode_proc, this);
a8a9222d
SA
244
245 // Receive notifications when new sample data is available
246 connect_input_notifiers();
946b52e1
SA
247}
248
ecd07c20
SA
249QString DecodeSignal::error_message() const
250{
47747218
SA
251 lock_guard<mutex> lock(output_mutex_);
252 return error_message_;
ecd07c20
SA
253}
254
47747218 255const vector<data::DecodeChannel> DecodeSignal::get_channels() const
9f97b357
SA
256{
257 return channels_;
258}
259
762ab7a4 260void DecodeSignal::auto_assign_signals(const shared_ptr<Decoder> dec)
132a5c6d 261{
47747218
SA
262 bool new_assignment = false;
263
132a5c6d
SA
264 // Try to auto-select channels that don't have signals assigned yet
265 for (data::DecodeChannel &ch : channels_) {
762ab7a4
SA
266 // If a decoder is given, auto-assign only its channels
267 if (dec && (ch.decoder_ != dec))
268 continue;
269
132a5c6d
SA
270 if (ch.assigned_signal)
271 continue;
272
692f6093
SA
273 for (shared_ptr<data::SignalBase> s : session_.signalbases()) {
274 const QString ch_name = ch.name.toLower();
275 const QString s_name = s->name().toLower();
276
277 if (s->logic_data() &&
278 ((ch_name.contains(s_name)) || (s_name.contains(ch_name)))) {
132a5c6d 279 ch.assigned_signal = s.get();
47747218
SA
280 new_assignment = true;
281 }
692f6093 282 }
47747218
SA
283 }
284
285 if (new_assignment) {
286 logic_mux_data_invalid_ = true;
27a3f09b 287 commit_decoder_channels();
47747218 288 channels_updated();
132a5c6d
SA
289 }
290}
291
9f97b357
SA
292void DecodeSignal::assign_signal(const uint16_t channel_id, const SignalBase *signal)
293{
294 for (data::DecodeChannel &ch : channels_)
47747218 295 if (ch.id == channel_id) {
9f97b357 296 ch.assigned_signal = signal;
47747218
SA
297 logic_mux_data_invalid_ = true;
298 }
9f97b357 299
27a3f09b 300 commit_decoder_channels();
9f97b357 301 channels_updated();
47747218 302 begin_decode();
9f97b357
SA
303}
304
27a3f09b
SA
305int DecodeSignal::get_assigned_signal_count() const
306{
307 // Count all channels that have a signal assigned to them
308 return count_if(channels_.begin(), channels_.end(),
309 [](data::DecodeChannel ch) { return ch.assigned_signal; });
310}
311
9f97b357
SA
312void DecodeSignal::set_initial_pin_state(const uint16_t channel_id, const int init_state)
313{
314 for (data::DecodeChannel &ch : channels_)
315 if (ch.id == channel_id)
316 ch.initial_pin_state = init_state;
317
318 channels_updated();
319
47747218 320 begin_decode();
9f97b357
SA
321}
322
ff83d980
SA
323double DecodeSignal::samplerate() const
324{
47747218 325 return samplerate_;
ff83d980
SA
326}
327
328const pv::util::Timestamp& DecodeSignal::start_time() const
329{
47747218 330 return start_time_;
ff83d980
SA
331}
332
0c5fe73e
SA
333int64_t DecodeSignal::get_working_sample_count() const
334{
335 // The working sample count is the highest sample number for
336 // which all used signals have data available, so go through
337 // all channels and use the lowest overall sample count of the
338 // current segment
339
340 // TODO Currently, we assume only a single segment exists
341
342 int64_t count = std::numeric_limits<int64_t>::max();
343 bool no_signals_assigned = true;
344
345 for (const data::DecodeChannel &ch : channels_)
346 if (ch.assigned_signal) {
347 no_signals_assigned = false;
348
349 const shared_ptr<Logic> logic_data = ch.assigned_signal->logic_data();
350 if (!logic_data || logic_data->logic_segments().empty())
351 return 0;
352
353 const shared_ptr<LogicSegment> segment = logic_data->logic_segments().front();
354 count = min(count, (int64_t)segment->get_sample_count());
355 }
356
357 return (no_signals_assigned ? 0 : count);
358}
359
360int64_t DecodeSignal::get_decoded_sample_count() const
ff83d980 361{
47747218
SA
362 lock_guard<mutex> decode_lock(output_mutex_);
363 return samples_decoded_;
ff83d980
SA
364}
365
ecd07c20
SA
366vector<Row> DecodeSignal::visible_rows() const
367{
47747218
SA
368 lock_guard<mutex> lock(output_mutex_);
369
370 vector<Row> rows;
371
372 for (const shared_ptr<decode::Decoder> &dec : stack_) {
373 assert(dec);
374 if (!dec->shown())
375 continue;
376
377 const srd_decoder *const decc = dec->decoder();
378 assert(dec->decoder());
379
380 // Add a row for the decoder if it doesn't have a row list
381 if (!decc->annotation_rows)
382 rows.emplace_back(decc);
383
384 // Add the decoder rows
385 for (const GSList *l = decc->annotation_rows; l; l = l->next) {
386 const srd_decoder_annotation_row *const ann_row =
387 (srd_decoder_annotation_row *)l->data;
388 assert(ann_row);
389 rows.emplace_back(decc, ann_row);
390 }
391 }
392
393 return rows;
ecd07c20
SA
394}
395
396void DecodeSignal::get_annotation_subset(
397 vector<pv::data::decode::Annotation> &dest,
398 const decode::Row &row, uint64_t start_sample,
399 uint64_t end_sample) const
400{
47747218
SA
401 lock_guard<mutex> lock(output_mutex_);
402
4913560f
SA
403 if (!current_rows_)
404 return;
405
406 // TODO Instead of current_rows_, use rows_ and the ID of the segment
407
408 const auto iter = current_rows_->find(row);
409 if (iter != current_rows_->end())
47747218
SA
410 (*iter).second.get_annotation_subset(dest,
411 start_sample, end_sample);
412}
413
414void DecodeSignal::save_settings(QSettings &settings) const
415{
416 SignalBase::save_settings(settings);
417
c8e60bdf
SA
418 settings.setValue("decoders", (int)(stack_.size()));
419
8b5ea5a1 420 // Save decoder stack
c8e60bdf
SA
421 int decoder_idx = 0;
422 for (shared_ptr<decode::Decoder> decoder : stack_) {
423 settings.beginGroup("decoder" + QString::number(decoder_idx++));
424
425 settings.setValue("id", decoder->decoder()->id);
426
d3feec23
SA
427 // Save decoder options
428 const map<string, GVariant*>& options = decoder->options();
429
430 settings.setValue("options", (int)options.size());
431
432 // Note: decode::Decoder::options() returns only the options
433 // that differ from the default. See binding::Decoder::getter()
434 int i = 0;
435 for (auto option : options) {
436 settings.beginGroup("option" + QString::number(i));
437 settings.setValue("name", QString::fromStdString(option.first));
438 GlobalSettings::store_gvariant(settings, option.second);
439 settings.endGroup();
440 i++;
441 }
442
c8e60bdf
SA
443 settings.endGroup();
444 }
445
8b5ea5a1
SA
446 // Save channel mapping
447 settings.setValue("channels", (int)channels_.size());
448
449 for (unsigned int channel_id = 0; channel_id < channels_.size(); channel_id++) {
450 auto channel = find_if(channels_.begin(), channels_.end(),
451 [&](data::DecodeChannel ch) { return ch.id == channel_id; });
452
453 if (channel == channels_.end()) {
454 qDebug() << "ERROR: Gap in channel index:" << channel_id;
455 continue;
456 }
457
458 settings.beginGroup("channel" + QString::number(channel_id));
459
460 settings.setValue("name", channel->name); // Useful for debugging
461 settings.setValue("initial_pin_state", channel->initial_pin_state);
462
463 if (channel->assigned_signal)
464 settings.setValue("assigned_signal_name", channel->assigned_signal->name());
465
466 settings.endGroup();
467 }
47747218
SA
468}
469
470void DecodeSignal::restore_settings(QSettings &settings)
471{
472 SignalBase::restore_settings(settings);
473
8b5ea5a1 474 // Restore decoder stack
c8e60bdf
SA
475 GSList *dec_list = g_slist_copy((GSList*)srd_decoder_list());
476
477 int decoders = settings.value("decoders").toInt();
478
479 for (int decoder_idx = 0; decoder_idx < decoders; decoder_idx++) {
480 settings.beginGroup("decoder" + QString::number(decoder_idx));
481
482 QString id = settings.value("id").toString();
483
484 for (GSList *entry = dec_list; entry; entry = entry->next) {
485 const srd_decoder *dec = (srd_decoder*)entry->data;
486 if (!dec)
487 continue;
488
489 if (QString::fromUtf8(dec->id) == id) {
d3feec23
SA
490 shared_ptr<decode::Decoder> decoder =
491 make_shared<decode::Decoder>(dec);
492
493 stack_.push_back(decoder);
494
495 // Restore decoder options that differ from their default
496 int options = settings.value("options").toInt();
497
498 for (int i = 0; i < options; i++) {
499 settings.beginGroup("option" + QString::number(i));
500 QString name = settings.value("name").toString();
501 GVariant *value = GlobalSettings::restore_gvariant(settings);
502 decoder->set_option(name.toUtf8(), value);
503 settings.endGroup();
504 }
c8e60bdf
SA
505
506 // Include the newly created decode channels in the channel lists
507 update_channel_list();
4ca06ec3 508 commit_decoder_channels();
c8e60bdf
SA
509 break;
510 }
511 }
512
513 settings.endGroup();
4ca06ec3 514 channels_updated();
c8e60bdf
SA
515 }
516
8b5ea5a1
SA
517 // Restore channel mapping
518 unsigned int channels = settings.value("channels").toInt();
519
520 const unordered_set< shared_ptr<data::SignalBase> > signalbases =
521 session_.signalbases();
522
523 for (unsigned int channel_id = 0; channel_id < channels; channel_id++) {
524 auto channel = find_if(channels_.begin(), channels_.end(),
525 [&](data::DecodeChannel ch) { return ch.id == channel_id; });
526
527 if (channel == channels_.end()) {
528 qDebug() << "ERROR: Non-existant channel index:" << channel_id;
529 continue;
530 }
531
532 settings.beginGroup("channel" + QString::number(channel_id));
533
534 QString assigned_signal_name = settings.value("assigned_signal_name").toString();
535
536 for (shared_ptr<data::SignalBase> signal : signalbases)
537 if (signal->name() == assigned_signal_name)
538 channel->assigned_signal = signal.get();
539
540 channel->initial_pin_state = settings.value("initial_pin_state").toInt();
541
542 settings.endGroup();
543 }
544
545 begin_decode();
47747218
SA
546}
547
9f97b357
SA
548void DecodeSignal::update_channel_list()
549{
47747218 550 vector<data::DecodeChannel> prev_channels = channels_;
9f97b357
SA
551 channels_.clear();
552
553 uint16_t id = 0;
554
555 // Copy existing entries, create new as needed
47747218 556 for (shared_ptr<Decoder> decoder : stack_) {
9f97b357
SA
557 const srd_decoder* srd_d = decoder->decoder();
558 const GSList *l;
559
560 // Mandatory channels
561 for (l = srd_d->channels; l; l = l->next) {
562 const struct srd_channel *const pdch = (struct srd_channel *)l->data;
563 bool ch_added = false;
564
565 // Copy but update ID if this channel was in the list before
47747218 566 for (data::DecodeChannel &ch : prev_channels)
9f97b357
SA
567 if (ch.pdch_ == pdch) {
568 ch.id = id++;
569 channels_.push_back(ch);
570 ch_added = true;
571 break;
572 }
573
574 if (!ch_added) {
575 // Create new entry without a mapped signal
6e7a4a00 576 data::DecodeChannel ch = {id++, 0, false, nullptr,
9f97b357
SA
577 QString::fromUtf8(pdch->name), QString::fromUtf8(pdch->desc),
578 SRD_INITIAL_PIN_SAME_AS_SAMPLE0, decoder, pdch};
579 channels_.push_back(ch);
580 }
581 }
582
583 // Optional channels
584 for (l = srd_d->opt_channels; l; l = l->next) {
585 const struct srd_channel *const pdch = (struct srd_channel *)l->data;
586 bool ch_added = false;
587
588 // Copy but update ID if this channel was in the list before
47747218 589 for (data::DecodeChannel &ch : prev_channels)
9f97b357
SA
590 if (ch.pdch_ == pdch) {
591 ch.id = id++;
592 channels_.push_back(ch);
593 ch_added = true;
594 break;
595 }
596
597 if (!ch_added) {
598 // Create new entry without a mapped signal
6e7a4a00 599 data::DecodeChannel ch = {id++, 0, true, nullptr,
9f97b357
SA
600 QString::fromUtf8(pdch->name), QString::fromUtf8(pdch->desc),
601 SRD_INITIAL_PIN_SAME_AS_SAMPLE0, decoder, pdch};
602 channels_.push_back(ch);
603 }
604 }
605 }
606
47747218
SA
607 // Invalidate the logic output data if the channel assignment changed
608 if (prev_channels.size() != channels_.size()) {
609 // The number of channels changed, there's definitely a difference
610 logic_mux_data_invalid_ = true;
611 } else {
612 // Same number but assignment may still differ, so compare all channels
613 for (size_t i = 0; i < channels_.size(); i++) {
614 const data::DecodeChannel &p_ch = prev_channels[i];
615 const data::DecodeChannel &ch = channels_[i];
616
617 if ((p_ch.pdch_ != ch.pdch_) ||
618 (p_ch.assigned_signal != ch.assigned_signal)) {
619 logic_mux_data_invalid_ = true;
620 break;
621 }
622 }
623
624 }
625
9f97b357
SA
626 channels_updated();
627}
628
27a3f09b 629void DecodeSignal::commit_decoder_channels()
ad908057 630{
27a3f09b
SA
631 // Submit channel list to every decoder, containing only the relevant channels
632 for (shared_ptr<decode::Decoder> dec : stack_) {
633 vector<data::DecodeChannel*> channel_list;
634
635 for (data::DecodeChannel &ch : channels_)
636 if (ch.decoder_ == dec)
637 channel_list.push_back(&ch);
47747218 638
27a3f09b
SA
639 dec->set_channels(channel_list);
640 }
47747218
SA
641}
642
27a3f09b 643void DecodeSignal::mux_logic_samples(const int64_t start, const int64_t end)
47747218 644{
27a3f09b
SA
645 // Enforce end to be greater than start
646 if (end <= start)
647 return;
648
649 // Fetch all segments and their data
650 // TODO Currently, we assume only a single segment exists
651 vector<shared_ptr<LogicSegment> > segments;
652 vector<const uint8_t*> signal_data;
653 vector<uint8_t> signal_in_bytepos;
654 vector<uint8_t> signal_in_bitpos;
655
6e7a4a00 656 int id = 0;
27a3f09b
SA
657 for (data::DecodeChannel &ch : channels_)
658 if (ch.assigned_signal) {
6e7a4a00
SA
659 ch.bit_id = id++;
660
27a3f09b
SA
661 const shared_ptr<Logic> logic_data = ch.assigned_signal->logic_data();
662 const shared_ptr<LogicSegment> segment = logic_data->logic_segments().front();
663 segments.push_back(segment);
b82243f7
SA
664
665 uint8_t* data = new uint8_t[(end - start) * segment->unit_size()];
666 segment->get_samples(start, end, data);
667 signal_data.push_back(data);
27a3f09b
SA
668
669 const int bitpos = ch.assigned_signal->logic_bit_index();
670 signal_in_bytepos.push_back(bitpos / 8);
671 signal_in_bitpos.push_back(bitpos % 8);
672 }
673
674 // Perform the muxing of signal data into the output data
83b9c07b 675 uint8_t* output = new uint8_t[(end - start) * logic_mux_segment_->unit_size()];
27a3f09b
SA
676 unsigned int signal_count = signal_data.size();
677
678 for (int64_t sample_cnt = 0; sample_cnt < (end - start); sample_cnt++) {
679 int bitpos = 0;
680 uint8_t bytepos = 0;
681
83b9c07b
SA
682 const int out_sample_pos = sample_cnt * logic_mux_segment_->unit_size();
683 for (unsigned int i = 0; i < logic_mux_segment_->unit_size(); i++)
27a3f09b 684 output[out_sample_pos + i] = 0;
47747218 685
27a3f09b
SA
686 for (unsigned int i = 0; i < signal_count; i++) {
687 const int in_sample_pos = sample_cnt * segments[i]->unit_size();
688 const uint8_t in_sample = 1 &
689 ((signal_data[i][in_sample_pos + signal_in_bytepos[i]]) >> (signal_in_bitpos[i]));
47747218 690
27a3f09b
SA
691 const uint8_t out_sample = output[out_sample_pos + bytepos];
692
693 output[out_sample_pos + bytepos] = out_sample | (in_sample << bitpos);
694
695 bitpos++;
696 if (bitpos > 7) {
697 bitpos = 0;
698 bytepos++;
699 }
700 }
47747218
SA
701 }
702
83b9c07b 703 logic_mux_segment_->append_payload(output, (end - start) * logic_mux_segment_->unit_size());
27a3f09b
SA
704 delete[] output;
705
706 for (const uint8_t* data : signal_data)
707 delete[] data;
708}
709
710void DecodeSignal::logic_mux_proc()
711{
712 do {
27a3f09b 713 const uint64_t input_sample_count = get_working_sample_count();
83b9c07b 714 const uint64_t output_sample_count = logic_mux_segment_->get_sample_count();
27a3f09b
SA
715
716 const uint64_t samples_to_process =
717 (input_sample_count > output_sample_count) ?
718 (input_sample_count - output_sample_count) : 0;
719
720 // Process the samples if necessary...
721 if (samples_to_process > 0) {
83b9c07b 722 const uint64_t unit_size = logic_mux_segment_->unit_size();
27a3f09b
SA
723 const uint64_t chunk_sample_count = DecodeChunkLength / unit_size;
724
725 uint64_t processed_samples = 0;
726 do {
727 const uint64_t start_sample = output_sample_count + processed_samples;
728 const uint64_t sample_count =
729 min(samples_to_process - processed_samples, chunk_sample_count);
730
731 mux_logic_samples(start_sample, start_sample + sample_count);
732 processed_samples += sample_count;
733
734 // ...and process the newly muxed logic data
735 decode_input_cond_.notify_one();
736 } while (processed_samples < samples_to_process);
737 }
738
1ec191ed 739 if (samples_to_process == 0) {
27a3f09b
SA
740 // Wait for more input
741 unique_lock<mutex> logic_mux_lock(logic_mux_mutex_);
742 logic_mux_cond_.wait(logic_mux_lock);
743 }
1ec191ed 744 } while (!logic_mux_interrupt_);
27a3f09b
SA
745
746 // No more input data and session is stopped, let the decode thread
747 // process any pending data, terminate and release the global SRD mutex
748 // in order to let other decoders run
749 decode_input_cond_.notify_one();
47747218
SA
750}
751
a3ebd556
SA
752void DecodeSignal::query_input_metadata()
753{
754 // Update the samplerate and start time because we cannot start
755 // the libsrd session without the current samplerate
756
757 // TODO Currently we assume all channels have the same sample rate
758 // and start time
759 bool samplerate_valid = false;
8ebf8079
SA
760 data::DecodeChannel *any_channel;
761 shared_ptr<Logic> logic_data;
a3ebd556 762
8ebf8079
SA
763 do {
764 any_channel = &(*find_if(channels_.begin(), channels_.end(),
765 [](data::DecodeChannel ch) { return ch.assigned_signal; }));
a3ebd556 766
8ebf8079
SA
767 logic_data = any_channel->assigned_signal->logic_data();
768
769 if (!logic_data) {
770 // Wait until input data is available or an interrupt was requested
771 unique_lock<mutex> input_wait_lock(input_mutex_);
772 decode_input_cond_.wait(input_wait_lock);
773 }
774 } while (!logic_data && !decode_interrupt_);
775
776 if (decode_interrupt_)
777 return;
a3ebd556
SA
778
779 do {
780 if (!logic_data->logic_segments().empty()) {
781 shared_ptr<LogicSegment> first_segment =
782 any_channel->assigned_signal->logic_data()->logic_segments().front();
783 start_time_ = first_segment->start_time();
784 samplerate_ = first_segment->samplerate();
785 if (samplerate_ > 0)
786 samplerate_valid = true;
787 }
788
1ec191ed
SA
789 if (!samplerate_valid) {
790 // Wait until input data is available or an interrupt was requested
791 unique_lock<mutex> input_wait_lock(input_mutex_);
792 decode_input_cond_.wait(input_wait_lock);
793 }
a3ebd556
SA
794 } while (!samplerate_valid && !decode_interrupt_);
795}
796
47747218 797void DecodeSignal::decode_data(
e91883bb 798 const int64_t abs_start_samplenum, const int64_t sample_count)
47747218 799{
83b9c07b 800 const int64_t unit_size = logic_mux_segment_->unit_size();
27a3f09b 801 const int64_t chunk_sample_count = DecodeChunkLength / unit_size;
47747218
SA
802
803 for (int64_t i = abs_start_samplenum;
804 !decode_interrupt_ && (i < (abs_start_samplenum + sample_count));
805 i += chunk_sample_count) {
806
807 const int64_t chunk_end = min(i + chunk_sample_count,
808 abs_start_samplenum + sample_count);
809
b82243f7
SA
810 int64_t data_size = (chunk_end - i) * unit_size;
811 uint8_t* chunk = new uint8_t[data_size];
83b9c07b 812 logic_mux_segment_->get_samples(i, chunk_end, chunk);
47747218 813
e91883bb 814 if (srd_session_send(srd_session_, i, chunk_end, chunk,
b82243f7 815 data_size, unit_size) != SRD_OK) {
47747218
SA
816 error_message_ = tr("Decoder reported an error");
817 delete[] chunk;
818 break;
819 }
a3ebd556 820
47747218
SA
821 delete[] chunk;
822
823 {
824 lock_guard<mutex> lock(output_mutex_);
825 samples_decoded_ = chunk_end;
826 }
1b56c646
SA
827
828 // Notify the frontend that we processed some data and
829 // possibly have new annotations as well
830 new_annotations();
47747218
SA
831 }
832}
833
834void DecodeSignal::decode_proc()
835{
a3ebd556
SA
836 query_input_metadata();
837
838 if (decode_interrupt_)
839 return;
840
e91883bb 841 start_srd_session();
47747218 842
27a3f09b
SA
843 uint64_t sample_count;
844 uint64_t abs_start_samplenum = 0;
47747218 845 do {
27a3f09b
SA
846 // Keep processing new samples until we exhaust the input data
847 do {
767bf4e7 848 lock_guard<mutex> input_lock(input_mutex_);
83b9c07b 849 sample_count = logic_mux_segment_->get_sample_count() - abs_start_samplenum;
27a3f09b
SA
850
851 if (sample_count > 0) {
e91883bb 852 decode_data(abs_start_samplenum, sample_count);
27a3f09b
SA
853 abs_start_samplenum += sample_count;
854 }
1b56c646
SA
855 } while (error_message_.isEmpty() && (sample_count > 0) && !decode_interrupt_);
856
857 if (error_message_.isEmpty() && !decode_interrupt_) {
858 if (sample_count == 0)
859 decode_finished();
27a3f09b 860
a3ebd556 861 // Wait for new input data or an interrupt was requested
27a3f09b
SA
862 unique_lock<mutex> input_wait_lock(input_mutex_);
863 decode_input_cond_.wait(input_wait_lock);
864 }
865 } while (error_message_.isEmpty() && !decode_interrupt_);
e91883bb
SA
866}
867
868void DecodeSignal::start_srd_session()
869{
a3ebd556
SA
870 if (srd_session_)
871 stop_srd_session();
e91883bb 872
a3ebd556
SA
873 // Create the session
874 srd_session_new(&srd_session_);
875 assert(srd_session_);
47747218 876
a3ebd556
SA
877 // Create the decoders
878 srd_decoder_inst *prev_di = nullptr;
879 for (const shared_ptr<decode::Decoder> &dec : stack_) {
880 srd_decoder_inst *const di = dec->create_decoder_inst(srd_session_);
e91883bb 881
a3ebd556
SA
882 if (!di) {
883 error_message_ = tr("Failed to create decoder instance");
884 srd_session_destroy(srd_session_);
885 return;
886 }
e91883bb 887
a3ebd556
SA
888 if (prev_di)
889 srd_inst_stack(srd_session_, prev_di, di);
e91883bb 890
a3ebd556 891 prev_di = di;
e91883bb 892 }
a3ebd556
SA
893
894 // Start the session
895 srd_session_metadata_set(srd_session_, SRD_CONF_SAMPLERATE,
896 g_variant_new_uint64(samplerate_));
897
898 srd_pd_output_callback_add(srd_session_, SRD_OUTPUT_ANN,
899 DecodeSignal::annotation_callback, this);
900
901 srd_session_start(srd_session_);
e91883bb 902}
47747218 903
e91883bb
SA
904void DecodeSignal::stop_srd_session()
905{
906 if (srd_session_) {
907 // Destroy the session
908 srd_session_destroy(srd_session_);
909 srd_session_ = nullptr;
910 }
47747218
SA
911}
912
a8a9222d
SA
913void DecodeSignal::connect_input_notifiers()
914{
915 // Disconnect the notification slot from the previous set of signals
1b56c646 916 disconnect(this, SLOT(on_data_cleared()));
a8a9222d
SA
917 disconnect(this, SLOT(on_data_received()));
918
919 // Connect the currently used signals to our slot
920 for (data::DecodeChannel &ch : channels_) {
921 if (!ch.assigned_signal)
922 continue;
923
1b56c646
SA
924 const data::SignalBase *signal = ch.assigned_signal;
925 connect(signal, SIGNAL(samples_cleared()),
926 this, SLOT(on_data_cleared()));
927 connect(signal, SIGNAL(samples_added(QObject*, uint64_t, uint64_t)),
a8a9222d
SA
928 this, SLOT(on_data_received()));
929 }
930}
931
4913560f
SA
932void DecodeSignal::prepare_annotation_segment()
933{
934 // TODO Won't work for multiple segments
935 rows_.emplace_back(map<const decode::Row, decode::RowData>());
936 current_rows_ = &(rows_.back());
937
938 // Add annotation classes
939 for (const shared_ptr<decode::Decoder> &dec : stack_) {
940 assert(dec);
941 const srd_decoder *const decc = dec->decoder();
942 assert(dec->decoder());
943
944 // Add a row for the decoder if it doesn't have a row list
945 if (!decc->annotation_rows)
946 (*current_rows_)[Row(decc)] = decode::RowData();
947
948 // Add the decoder rows
949 for (const GSList *l = decc->annotation_rows; l; l = l->next) {
950 const srd_decoder_annotation_row *const ann_row =
951 (srd_decoder_annotation_row *)l->data;
952 assert(ann_row);
953
954 const Row row(decc, ann_row);
955
956 // Add a new empty row data object
957 (*current_rows_)[row] = decode::RowData();
958 }
959 }
960}
961
47747218
SA
962void DecodeSignal::annotation_callback(srd_proto_data *pdata, void *decode_signal)
963{
964 assert(pdata);
b21501d6 965 assert(decode_signal);
47747218
SA
966
967 DecodeSignal *const ds = (DecodeSignal*)decode_signal;
968 assert(ds);
969
970 lock_guard<mutex> lock(ds->output_mutex_);
971
47747218
SA
972 // Find the row
973 assert(pdata->pdo);
974 assert(pdata->pdo->di);
975 const srd_decoder *const decc = pdata->pdo->di->decoder;
976 assert(decc);
4913560f 977 assert(ds->current_rows_);
47747218 978
1becee23
UH
979 const srd_proto_data_annotation *const pda =
980 (const srd_proto_data_annotation*)pdata->data;
981 assert(pda);
982
4913560f 983 auto row_iter = ds->current_rows_->end();
47747218
SA
984
985 // Try looking up the sub-row of this class
1becee23
UH
986 const auto format = pda->ann_class;
987 const auto r = ds->class_rows_.find(make_pair(decc, format));
47747218 988 if (r != ds->class_rows_.end())
4913560f 989 row_iter = ds->current_rows_->find((*r).second);
47747218
SA
990 else {
991 // Failing that, use the decoder as a key
4913560f 992 row_iter = ds->current_rows_->find(Row(decc));
47747218
SA
993 }
994
4913560f 995 if (row_iter == ds->current_rows_->end()) {
47747218 996 qDebug() << "Unexpected annotation: decoder = " << decc <<
1becee23 997 ", format = " << format;
47747218
SA
998 assert(false);
999 return;
1000 }
1001
1002 // Add the annotation
1becee23 1003 (*row_iter).second.emplace_annotation(pdata);
47747218
SA
1004}
1005
1006void DecodeSignal::on_capture_state_changed(int state)
1007{
1008 // If a new acquisition was started, we need to start decoding from scratch
1009 if (state == Session::Running)
1010 begin_decode();
1011}
1012
1b56c646
SA
1013void DecodeSignal::on_data_cleared()
1014{
1015 reset_decode();
1016}
1017
47747218
SA
1018void DecodeSignal::on_data_received()
1019{
1b56c646
SA
1020 if (!logic_mux_thread_.joinable())
1021 begin_decode();
1022 else
1023 logic_mux_cond_.notify_one();
47747218
SA
1024}
1025
ad908057
SA
1026} // namespace data
1027} // namespace pv