]> sigrok.org Git - pulseview.git/blame - pv/data/decodesignal.cpp
Fix malformed declaration in MathSignal and add missing signal call
[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
c0c3e62a 20#include <cstring>
5a914348 21#include <forward_list>
0c5fe73e
SA
22#include <limits>
23
47747218
SA
24#include <QDebug>
25
ad908057
SA
26#include "logic.hpp"
27#include "logicsegment.hpp"
28#include "decodesignal.hpp"
29#include "signaldata.hpp"
30
ad908057 31#include <pv/data/decode/decoder.hpp>
ecd07c20 32#include <pv/data/decode/row.hpp>
d3feec23 33#include <pv/globalsettings.hpp>
ad908057
SA
34#include <pv/session.hpp>
35
47747218 36using std::lock_guard;
ad908057 37using std::make_shared;
0c5fe73e 38using std::min;
5ecf957f 39using std::out_of_range;
ad908057 40using std::shared_ptr;
47747218 41using std::unique_lock;
6a26fc44 42using pv::data::decode::AnnotationClass;
a82325d1 43using pv::data::decode::DecodeChannel;
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 57 logic_mux_data_invalid_(false),
e3202557 58 stack_config_changed_(true),
f6a93932 59 current_segment_id_(0)
ad908057 60{
47747218
SA
61 connect(&session_, SIGNAL(capture_state_changed(int)),
62 this, SLOT(on_capture_state_changed(int)));
ad908057
SA
63}
64
47747218 65DecodeSignal::~DecodeSignal()
ad908057 66{
8ce0e732 67 reset_decode(true);
ad908057
SA
68}
69
47747218 70const vector< shared_ptr<Decoder> >& DecodeSignal::decoder_stack() const
ecd07c20 71{
47747218 72 return stack_;
ecd07c20
SA
73}
74
ed75426f 75void DecodeSignal::stack_decoder(const srd_decoder *decoder, bool restart_decode)
ad908057
SA
76{
77 assert(decoder);
762ab7a4 78
b9591f3a 79 // Set name if this decoder is the first in the list or the name is unchanged
6a26fc44
SA
80 const srd_decoder* prev_dec = stack_.empty() ? nullptr : stack_.back()->get_srd_decoder();
81 const QString prev_dec_name = prev_dec ? QString::fromUtf8(prev_dec->name) : QString();
47747218 82
b9591f3a 83 if ((stack_.empty()) || ((stack_.size() > 0) && (name() == prev_dec_name)))
47747218 84 set_name(QString::fromUtf8(decoder->name));
132a5c6d 85
f54e68b0 86 const shared_ptr<Decoder> dec = make_shared<Decoder>(decoder, stack_.size());
b9591f3a
SA
87 stack_.push_back(dec);
88
02078aa1
SA
89 connect(dec.get(), SIGNAL(annotation_visibility_changed()),
90 this, SLOT(on_annotation_visibility_changed()));
91
27a3f09b 92 // Include the newly created decode channels in the channel lists
9f97b357 93 update_channel_list();
132a5c6d 94
e3202557 95 stack_config_changed_ = true;
762ab7a4 96 auto_assign_signals(dec);
27a3f09b 97 commit_decoder_channels();
e77de61f
SA
98
99 decoder_stacked((void*)dec.get());
100
ed75426f
SA
101 if (restart_decode)
102 begin_decode();
ad908057
SA
103}
104
105void DecodeSignal::remove_decoder(int index)
106{
47747218
SA
107 assert(index >= 0);
108 assert(index < (int)stack_.size());
109
110 // Find the decoder in the stack
f9a0fd83
SA
111 auto iter = stack_.begin() + index;
112 assert(iter != stack_.end());
47747218 113
f9a0fd83
SA
114 shared_ptr<Decoder> dec = *iter;
115
116 decoder_removed(dec.get());
e77de61f 117
47747218
SA
118 // Delete the element
119 stack_.erase(iter);
120
121 // Update channels and decoded data
e3202557 122 stack_config_changed_ = true;
9f97b357 123 update_channel_list();
47747218 124 begin_decode();
ad908057
SA
125}
126
127bool DecodeSignal::toggle_decoder_visibility(int index)
128{
47747218 129 auto iter = stack_.cbegin();
ad908057 130 for (int i = 0; i < index; i++, iter++)
47747218 131 assert(iter != stack_.end());
ad908057
SA
132
133 shared_ptr<Decoder> dec = *iter;
134
135 // Toggle decoder visibility
136 bool state = false;
137 if (dec) {
5d3ca591
SA
138 state = !dec->visible();
139 dec->set_visible(state);
ad908057
SA
140 }
141
142 return state;
143}
144
8ce0e732 145void DecodeSignal::reset_decode(bool shutting_down)
47747218 146{
8b24af15
SA
147 resume_decode(); // Make sure the decode thread isn't blocked by pausing
148
8ce0e732 149 if (stack_config_changed_ || shutting_down)
e3202557
SA
150 stop_srd_session();
151 else
152 terminate_srd_session();
ce0b6a40 153
1b56c646
SA
154 if (decode_thread_.joinable()) {
155 decode_interrupt_ = true;
156 decode_input_cond_.notify_one();
157 decode_thread_.join();
158 }
159
160 if (logic_mux_thread_.joinable()) {
161 logic_mux_interrupt_ = true;
162 logic_mux_cond_.notify_one();
163 logic_mux_thread_.join();
164 }
165
8a603e13 166 current_segment_id_ = 0;
72435789 167 segments_.clear();
1b56c646
SA
168
169 logic_mux_data_.reset();
170 logic_mux_data_invalid_ = true;
eee3eab9 171
403c3e87 172 if (!error_message_.isEmpty()) {
66b6f41b 173 error_message_.clear();
fe060a48
SA
174 // TODO Emulate noquote()
175 qDebug().nospace() << name() << ": Error cleared";
403c3e87 176 }
72435789 177
eee3eab9 178 decode_reset();
47747218
SA
179}
180
946b52e1
SA
181void DecodeSignal::begin_decode()
182{
47747218
SA
183 if (decode_thread_.joinable()) {
184 decode_interrupt_ = true;
185 decode_input_cond_.notify_one();
186 decode_thread_.join();
187 }
188
189 if (logic_mux_thread_.joinable()) {
190 logic_mux_interrupt_ = true;
191 logic_mux_cond_.notify_one();
192 logic_mux_thread_.join();
193 }
194
195 reset_decode();
196
27a3f09b 197 if (stack_.size() == 0) {
403c3e87 198 set_error_message(tr("No decoders"));
27a3f09b
SA
199 return;
200 }
201
202 assert(channels_.size() > 0);
203
204 if (get_assigned_signal_count() == 0) {
403c3e87 205 set_error_message(tr("There are no channels assigned to this decoder"));
27a3f09b
SA
206 return;
207 }
208
04627946
SA
209 // Make sure that all assigned channels still provide logic data
210 // (can happen when a converted signal was assigned but the
211 // conversion removed in the meanwhile)
a82325d1 212 for (decode::DecodeChannel& ch : channels_)
04627946
SA
213 if (ch.assigned_signal && !(ch.assigned_signal->logic_data() != nullptr))
214 ch.assigned_signal = nullptr;
215
47747218 216 // Check that all decoders have the required channels
6a26fc44 217 for (const shared_ptr<Decoder>& dec : stack_)
47747218 218 if (!dec->have_required_channels()) {
403c3e87
SA
219 set_error_message(tr("One or more required channels "
220 "have not been specified"));
47747218
SA
221 return;
222 }
223
27a3f09b
SA
224 // Free the logic data and its segment(s) if it needs to be updated
225 if (logic_mux_data_invalid_)
226 logic_mux_data_.reset();
227
228 if (!logic_mux_data_) {
72435789 229 const uint32_t ch_count = get_assigned_signal_count();
ed535cd7 230 logic_mux_unit_size_ = (ch_count + 7) / 8;
27a3f09b 231 logic_mux_data_ = make_shared<Logic>(ch_count);
27a3f09b 232 }
47747218 233
144e72c9 234 if (get_input_segment_count() == 0)
403c3e87 235 set_error_message(tr("No input data"));
ed535cd7 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);
946b52e1
SA
244}
245
556259d2
SA
246void DecodeSignal::pause_decode()
247{
248 decode_paused_ = true;
249}
250
251void DecodeSignal::resume_decode()
252{
253 // Manual unlocking is done before notifying, to avoid waking up the
254 // waiting thread only to block again (see notify_one for details)
255 decode_pause_mutex_.unlock();
256 decode_pause_cond_.notify_one();
257 decode_paused_ = false;
258}
259
260bool DecodeSignal::is_paused() const
261{
262 return decode_paused_;
263}
264
a82325d1 265const vector<decode::DecodeChannel> DecodeSignal::get_channels() const
9f97b357
SA
266{
267 return channels_;
268}
269
762ab7a4 270void DecodeSignal::auto_assign_signals(const shared_ptr<Decoder> dec)
132a5c6d 271{
47747218
SA
272 bool new_assignment = false;
273
db51130d
SA
274 // Disconnect all input signal notifications so we don't have duplicate connections
275 disconnect_input_notifiers();
276
132a5c6d 277 // Try to auto-select channels that don't have signals assigned yet
a82325d1 278 for (decode::DecodeChannel& ch : channels_) {
762ab7a4
SA
279 // If a decoder is given, auto-assign only its channels
280 if (dec && (ch.decoder_ != dec))
281 continue;
282
132a5c6d
SA
283 if (ch.assigned_signal)
284 continue;
285
c526a8fd
SA
286 QString ch_name = ch.name.toLower();
287 ch_name = ch_name.replace(QRegExp("[-_.]"), " ");
a8030bb0
SA
288
289 shared_ptr<data::SignalBase> match;
f4ab4b5c 290 for (const shared_ptr<data::SignalBase>& s : session_.signalbases()) {
f9ebf303
SA
291 if (!s->enabled())
292 continue;
293
c526a8fd
SA
294 QString s_name = s->name().toLower();
295 s_name = s_name.replace(QRegExp("[-_.]"), " ");
692f6093
SA
296
297 if (s->logic_data() &&
298 ((ch_name.contains(s_name)) || (s_name.contains(ch_name)))) {
a8030bb0
SA
299 if (!match)
300 match = s;
301 else {
302 // Only replace an existing match if it matches more characters
303 int old_unmatched = ch_name.length() - match->name().length();
304 int new_unmatched = ch_name.length() - s->name().length();
305 if (abs(new_unmatched) < abs(old_unmatched))
306 match = s;
307 }
47747218 308 }
692f6093 309 }
a8030bb0 310
8ff61402
SA
311 // Prevent using a signal more than once as D1 would match e.g. D1 and D10
312 bool signal_not_already_used = true;
313 for (decode::DecodeChannel& ch : channels_)
314 if (ch.assigned_signal && (ch.assigned_signal == match))
315 signal_not_already_used = false;
316
317 if (match && signal_not_already_used) {
cf1541a1 318 ch.assigned_signal = match;
a8030bb0
SA
319 new_assignment = true;
320 }
47747218
SA
321 }
322
323 if (new_assignment) {
db51130d
SA
324 // Receive notifications when new sample data is available
325 connect_input_notifiers();
326
47747218 327 logic_mux_data_invalid_ = true;
e3202557 328 stack_config_changed_ = true;
27a3f09b 329 commit_decoder_channels();
47747218 330 channels_updated();
132a5c6d
SA
331 }
332}
333
cf1541a1 334void DecodeSignal::assign_signal(const uint16_t channel_id, shared_ptr<const SignalBase> signal)
9f97b357 335{
db51130d
SA
336 // Disconnect all input signal notifications so we don't have duplicate connections
337 disconnect_input_notifiers();
338
a82325d1 339 for (decode::DecodeChannel& ch : channels_)
47747218 340 if (ch.id == channel_id) {
9f97b357 341 ch.assigned_signal = signal;
47747218
SA
342 logic_mux_data_invalid_ = true;
343 }
9f97b357 344
db51130d
SA
345 // Receive notifications when new sample data is available
346 connect_input_notifiers();
347
e3202557 348 stack_config_changed_ = true;
27a3f09b 349 commit_decoder_channels();
9f97b357 350 channels_updated();
47747218 351 begin_decode();
9f97b357
SA
352}
353
27a3f09b
SA
354int DecodeSignal::get_assigned_signal_count() const
355{
356 // Count all channels that have a signal assigned to them
357 return count_if(channels_.begin(), channels_.end(),
cf1541a1 358 [](decode::DecodeChannel ch) { return ch.assigned_signal.get(); });
27a3f09b
SA
359}
360
9f97b357
SA
361void DecodeSignal::set_initial_pin_state(const uint16_t channel_id, const int init_state)
362{
a82325d1 363 for (decode::DecodeChannel& ch : channels_)
9f97b357
SA
364 if (ch.id == channel_id)
365 ch.initial_pin_state = init_state;
366
e3202557 367 stack_config_changed_ = true;
9f97b357 368 channels_updated();
47747218 369 begin_decode();
9f97b357
SA
370}
371
85125b0f 372double DecodeSignal::get_samplerate() const
ff83d980 373{
72435789
SA
374 double result = 0;
375
376 // TODO For now, we simply return the first samplerate that we have
8a603e13
SA
377 if (segments_.size() > 0)
378 result = segments_.front().samplerate;
72435789
SA
379
380 return result;
ff83d980
SA
381}
382
72435789 383const pv::util::Timestamp DecodeSignal::start_time() const
ff83d980 384{
72435789
SA
385 pv::util::Timestamp result;
386
387 // TODO For now, we simply return the first start time that we have
8a603e13
SA
388 if (segments_.size() > 0)
389 result = segments_.front().start_time;
72435789
SA
390
391 return result;
ff83d980
SA
392}
393
5ecf957f 394int64_t DecodeSignal::get_working_sample_count(uint32_t segment_id) const
0c5fe73e
SA
395{
396 // The working sample count is the highest sample number for
ed535cd7
SA
397 // which all used signals have data available, so go through all
398 // channels and use the lowest overall sample count of the segment
0c5fe73e 399
0c5fe73e
SA
400 int64_t count = std::numeric_limits<int64_t>::max();
401 bool no_signals_assigned = true;
402
a82325d1 403 for (const decode::DecodeChannel& ch : channels_)
0c5fe73e 404 if (ch.assigned_signal) {
1774d669
SA
405 if (!ch.assigned_signal->logic_data())
406 return 0;
407
0c5fe73e
SA
408 no_signals_assigned = false;
409
410 const shared_ptr<Logic> logic_data = ch.assigned_signal->logic_data();
1774d669 411 if (logic_data->logic_segments().empty())
0c5fe73e
SA
412 return 0;
413
1774d669 414 if (segment_id >= logic_data->logic_segments().size())
5ecf957f 415 return 0;
1774d669 416
cf1541a1
SA
417 const shared_ptr<const LogicSegment> segment = logic_data->logic_segments()[segment_id]->get_shared_ptr();
418 if (segment)
419 count = min(count, (int64_t)segment->get_sample_count());
0c5fe73e
SA
420 }
421
422 return (no_signals_assigned ? 0 : count);
423}
424
b82908ab
SA
425int64_t DecodeSignal::get_decoded_sample_count(uint32_t segment_id,
426 bool include_processing) const
ff83d980 427{
47747218 428 lock_guard<mutex> decode_lock(output_mutex_);
5ecf957f
SA
429
430 int64_t result = 0;
431
c8a6db0e
SA
432 if (segment_id >= segments_.size())
433 return result;
434
435 if (include_processing)
436 result = segments_[segment_id].samples_decoded_incl;
437 else
438 result = segments_[segment_id].samples_decoded_excl;
5ecf957f
SA
439
440 return result;
ff83d980
SA
441}
442
6a26fc44 443vector<Row*> DecodeSignal::get_rows(bool visible_only)
ecd07c20 444{
6a26fc44 445 vector<Row*> rows;
47747218 446
6a26fc44 447 for (const shared_ptr<Decoder>& dec : stack_) {
47747218 448 assert(dec);
5d3ca591 449 if (visible_only && !dec->visible())
cbb2e4da
SA
450 continue;
451
6a26fc44
SA
452 for (Row* row : dec->get_rows())
453 rows.push_back(row);
454 }
47747218 455
6a26fc44
SA
456 return rows;
457}
47747218 458
6a26fc44
SA
459vector<const Row*> DecodeSignal::get_rows(bool visible_only) const
460{
461 vector<const Row*> rows;
462
463 for (const shared_ptr<Decoder>& dec : stack_) {
464 assert(dec);
5d3ca591 465 if (visible_only && !dec->visible())
6a26fc44
SA
466 continue;
467
468 for (const Row* row : dec->get_rows())
469 rows.push_back(row);
47747218
SA
470 }
471
472 return rows;
ecd07c20
SA
473}
474
6a26fc44 475uint64_t DecodeSignal::get_annotation_count(const Row* row, uint32_t segment_id) const
f994f496
SA
476{
477 if (segment_id >= segments_.size())
478 return 0;
479
6a26fc44 480 const DecodeSegment* segment = &(segments_.at(segment_id));
f994f496 481
6a26fc44 482 auto row_it = segment->annotation_rows.find(row);
f994f496 483
6a26fc44 484 const RowData* rd;
5a9146ac 485 if (row_it == segment->annotation_rows.end())
6a26fc44 486 return 0;
5a9146ac 487 else
6a26fc44
SA
488 rd = &(row_it->second);
489
490 return rd->get_annotation_count();
f994f496
SA
491}
492
462941e2 493void DecodeSignal::get_annotation_subset(deque<const Annotation*> &dest,
6a26fc44 494 const Row* row, uint32_t segment_id, uint64_t start_sample,
ecd07c20
SA
495 uint64_t end_sample) const
496{
47747218
SA
497 lock_guard<mutex> lock(output_mutex_);
498
c8a6db0e
SA
499 if (segment_id >= segments_.size())
500 return;
72435789 501
6a26fc44
SA
502 const DecodeSegment* segment = &(segments_.at(segment_id));
503
504 auto row_it = segment->annotation_rows.find(row);
c8a6db0e 505
6a26fc44 506 const RowData* rd;
5a9146ac 507 if (row_it == segment->annotation_rows.end())
6a26fc44 508 return;
5a9146ac 509 else
6a26fc44
SA
510 rd = &(row_it->second);
511
512 rd->get_annotation_subset(dest, start_sample, end_sample);
47747218
SA
513}
514
462941e2 515void DecodeSignal::get_annotation_subset(deque<const Annotation*> &dest,
5a914348
SA
516 uint32_t segment_id, uint64_t start_sample, uint64_t end_sample) const
517{
462941e2
SA
518 for (const Row* row : get_rows())
519 get_annotation_subset(dest, row, segment_id, start_sample, end_sample);
5a914348
SA
520}
521
e77de61f 522uint32_t DecodeSignal::get_binary_data_chunk_count(uint32_t segment_id,
ac9494ef 523 const Decoder* dec, uint32_t bin_class_id) const
c0c3e62a 524{
1774d669 525 if ((segments_.size() == 0) || (segment_id >= segments_.size()))
c8a6db0e
SA
526 return 0;
527
1774d669 528 const DecodeSegment *segment = &(segments_[segment_id]);
e77de61f 529
1774d669
SA
530 for (const DecodeBinaryClass& bc : segment->binary_classes)
531 if ((bc.decoder == dec) && (bc.info->bin_class_id == bin_class_id))
532 return bc.chunks.size();
c0c3e62a 533
e77de61f 534 return 0;
c0c3e62a
SA
535}
536
e77de61f 537void DecodeSignal::get_binary_data_chunk(uint32_t segment_id,
ac9494ef 538 const Decoder* dec, uint32_t bin_class_id, uint32_t chunk_id,
c0c3e62a
SA
539 const vector<uint8_t> **dest, uint64_t *size)
540{
1774d669
SA
541 if (segment_id >= segments_.size())
542 return;
e77de61f 543
1774d669
SA
544 const DecodeSegment *segment = &(segments_[segment_id]);
545
546 for (const DecodeBinaryClass& bc : segment->binary_classes)
547 if ((bc.decoder == dec) && (bc.info->bin_class_id == bin_class_id)) {
548 if (dest) *dest = &(bc.chunks.at(chunk_id).data);
549 if (size) *size = bc.chunks.at(chunk_id).data.size();
550 return;
551 }
c0c3e62a
SA
552}
553
13b726cd 554void DecodeSignal::get_merged_binary_data_chunks_by_sample(uint32_t segment_id,
ac9494ef 555 const Decoder* dec, uint32_t bin_class_id, uint64_t start_sample,
e77de61f 556 uint64_t end_sample, vector<uint8_t> *dest) const
c0c3e62a
SA
557{
558 assert(dest != nullptr);
559
1774d669
SA
560 if (segment_id >= segments_.size())
561 return;
562
563 const DecodeSegment *segment = &(segments_[segment_id]);
564
565 const DecodeBinaryClass* bin_class = nullptr;
566 for (const DecodeBinaryClass& bc : segment->binary_classes)
567 if ((bc.decoder == dec) && (bc.info->bin_class_id == bin_class_id))
568 bin_class = &bc;
569
570 // Determine overall size before copying to resize dest vector only once
571 uint64_t size = 0;
572 uint64_t matches = 0;
573 for (const DecodeBinaryDataChunk& chunk : bin_class->chunks)
574 if ((chunk.sample >= start_sample) && (chunk.sample < end_sample)) {
575 size += chunk.data.size();
576 matches++;
577 }
578 dest->resize(size);
579
580 uint64_t offset = 0;
581 uint64_t matches2 = 0;
582 for (const DecodeBinaryDataChunk& chunk : bin_class->chunks)
583 if ((chunk.sample >= start_sample) && (chunk.sample < end_sample)) {
584 memcpy(dest->data() + offset, chunk.data.data(), chunk.data.size());
585 offset += chunk.data.size();
586 matches2++;
587
588 // Make sure we don't overwrite memory if the array grew in the meanwhile
589 if (matches2 == matches)
590 break;
591 }
c0c3e62a
SA
592}
593
13b726cd 594void DecodeSignal::get_merged_binary_data_chunks_by_offset(uint32_t segment_id,
6a26fc44
SA
595 const Decoder* dec, uint32_t bin_class_id, uint64_t start, uint64_t end,
596 vector<uint8_t> *dest) const
13b726cd
SA
597{
598 assert(dest != nullptr);
599
1774d669
SA
600 if (segment_id >= segments_.size())
601 return;
13b726cd 602
1774d669
SA
603 const DecodeSegment *segment = &(segments_[segment_id]);
604
605 const DecodeBinaryClass* bin_class = nullptr;
606 for (const DecodeBinaryClass& bc : segment->binary_classes)
607 if ((bc.decoder == dec) && (bc.info->bin_class_id == bin_class_id))
608 bin_class = &bc;
609
610 // Determine overall size before copying to resize dest vector only once
611 uint64_t size = 0;
612 uint64_t offset = 0;
613 for (const DecodeBinaryDataChunk& chunk : bin_class->chunks) {
614 if (offset >= start)
615 size += chunk.data.size();
616 offset += chunk.data.size();
617 if (offset >= end)
618 break;
619 }
620 dest->resize(size);
621
622 offset = 0;
623 uint64_t dest_offset = 0;
624 for (const DecodeBinaryDataChunk& chunk : bin_class->chunks) {
625 if (offset >= start) {
626 memcpy(dest->data() + dest_offset, chunk.data.data(), chunk.data.size());
627 dest_offset += chunk.data.size();
13b726cd 628 }
1774d669
SA
629 offset += chunk.data.size();
630 if (offset >= end)
631 break;
13b726cd
SA
632 }
633}
634
628b45cc 635const DecodeBinaryClass* DecodeSignal::get_binary_data_class(uint32_t segment_id,
6a26fc44 636 const Decoder* dec, uint32_t bin_class_id) const
628b45cc 637{
1774d669
SA
638 if (segment_id >= segments_.size())
639 return nullptr;
628b45cc 640
1774d669
SA
641 const DecodeSegment *segment = &(segments_[segment_id]);
642
643 for (const DecodeBinaryClass& bc : segment->binary_classes)
644 if ((bc.decoder == dec) && (bc.info->bin_class_id == bin_class_id))
645 return &bc;
628b45cc
SA
646
647 return nullptr;
648}
c0c3e62a 649
f54e68b0
SA
650const deque<const Annotation*>* DecodeSignal::get_all_annotations_by_segment(
651 uint32_t segment_id) const
652{
1774d669
SA
653 if (segment_id >= segments_.size())
654 return nullptr;
f54e68b0 655
1774d669
SA
656 const DecodeSegment *segment = &(segments_[segment_id]);
657
658 return &(segment->all_annotations);
f54e68b0
SA
659}
660
47747218
SA
661void DecodeSignal::save_settings(QSettings &settings) const
662{
663 SignalBase::save_settings(settings);
664
c8e60bdf
SA
665 settings.setValue("decoders", (int)(stack_.size()));
666
8b5ea5a1 667 // Save decoder stack
c8e60bdf 668 int decoder_idx = 0;
6a26fc44 669 for (const shared_ptr<Decoder>& decoder : stack_) {
c8e60bdf
SA
670 settings.beginGroup("decoder" + QString::number(decoder_idx++));
671
6a26fc44 672 settings.setValue("id", decoder->get_srd_decoder()->id);
5d3ca591 673 settings.setValue("visible", decoder->visible());
c8e60bdf 674
d3feec23
SA
675 // Save decoder options
676 const map<string, GVariant*>& options = decoder->options();
677
678 settings.setValue("options", (int)options.size());
679
6a26fc44 680 // Note: Decoder::options() returns only the options
d3feec23
SA
681 // that differ from the default. See binding::Decoder::getter()
682 int i = 0;
f4ab4b5c 683 for (auto& option : options) {
d3feec23
SA
684 settings.beginGroup("option" + QString::number(i));
685 settings.setValue("name", QString::fromStdString(option.first));
686 GlobalSettings::store_gvariant(settings, option.second);
687 settings.endGroup();
688 i++;
689 }
690
e4cb8bcf
SA
691 // Save row properties
692 i = 0;
693 for (const Row* row : decoder->get_rows()) {
694 settings.beginGroup("row" + QString::number(i));
695 settings.setValue("visible", row->visible());
696 settings.endGroup();
697 i++;
698 }
699
700 // Save class properties
701 i = 0;
702 for (const AnnotationClass* ann_class : decoder->ann_classes()) {
703 settings.beginGroup("ann_class" + QString::number(i));
02078aa1 704 settings.setValue("visible", ann_class->visible());
e4cb8bcf
SA
705 settings.endGroup();
706 i++;
707 }
708
c8e60bdf
SA
709 settings.endGroup();
710 }
711
8b5ea5a1
SA
712 // Save channel mapping
713 settings.setValue("channels", (int)channels_.size());
714
715 for (unsigned int channel_id = 0; channel_id < channels_.size(); channel_id++) {
716 auto channel = find_if(channels_.begin(), channels_.end(),
a82325d1 717 [&](decode::DecodeChannel ch) { return ch.id == channel_id; });
8b5ea5a1
SA
718
719 if (channel == channels_.end()) {
720 qDebug() << "ERROR: Gap in channel index:" << channel_id;
721 continue;
722 }
723
724 settings.beginGroup("channel" + QString::number(channel_id));
725
726 settings.setValue("name", channel->name); // Useful for debugging
727 settings.setValue("initial_pin_state", channel->initial_pin_state);
728
729 if (channel->assigned_signal)
730 settings.setValue("assigned_signal_name", channel->assigned_signal->name());
731
732 settings.endGroup();
733 }
47747218
SA
734}
735
736void DecodeSignal::restore_settings(QSettings &settings)
737{
738 SignalBase::restore_settings(settings);
739
8b5ea5a1 740 // Restore decoder stack
c8e60bdf
SA
741 GSList *dec_list = g_slist_copy((GSList*)srd_decoder_list());
742
743 int decoders = settings.value("decoders").toInt();
744
745 for (int decoder_idx = 0; decoder_idx < decoders; decoder_idx++) {
746 settings.beginGroup("decoder" + QString::number(decoder_idx));
747
748 QString id = settings.value("id").toString();
749
750 for (GSList *entry = dec_list; entry; entry = entry->next) {
751 const srd_decoder *dec = (srd_decoder*)entry->data;
752 if (!dec)
753 continue;
754
755 if (QString::fromUtf8(dec->id) == id) {
f54e68b0 756 shared_ptr<Decoder> decoder = make_shared<Decoder>(dec, stack_.size());
d3feec23 757
02078aa1
SA
758 connect(decoder.get(), SIGNAL(annotation_visibility_changed()),
759 this, SLOT(on_annotation_visibility_changed()));
760
d3feec23 761 stack_.push_back(decoder);
5d3ca591 762 decoder->set_visible(settings.value("visible", true).toBool());
d3feec23
SA
763
764 // Restore decoder options that differ from their default
765 int options = settings.value("options").toInt();
766
767 for (int i = 0; i < options; i++) {
768 settings.beginGroup("option" + QString::number(i));
769 QString name = settings.value("name").toString();
770 GVariant *value = GlobalSettings::restore_gvariant(settings);
771 decoder->set_option(name.toUtf8(), value);
772 settings.endGroup();
773 }
c8e60bdf
SA
774
775 // Include the newly created decode channels in the channel lists
776 update_channel_list();
e4cb8bcf
SA
777
778 // Restore row properties
779 int i = 0;
780 for (Row* row : decoder->get_rows()) {
781 settings.beginGroup("row" + QString::number(i));
782 row->set_visible(settings.value("visible", true).toBool());
783 settings.endGroup();
784 i++;
785 }
786
787 // Restore class properties
788 i = 0;
789 for (AnnotationClass* ann_class : decoder->ann_classes()) {
790 settings.beginGroup("ann_class" + QString::number(i));
02078aa1 791 ann_class->set_visible(settings.value("visible", true).toBool());
e4cb8bcf
SA
792 settings.endGroup();
793 i++;
794 }
795
c8e60bdf
SA
796 break;
797 }
798 }
799
800 settings.endGroup();
4ca06ec3 801 channels_updated();
c8e60bdf
SA
802 }
803
8b5ea5a1
SA
804 // Restore channel mapping
805 unsigned int channels = settings.value("channels").toInt();
806
56c4de9a 807 const vector< shared_ptr<data::SignalBase> > signalbases =
8b5ea5a1
SA
808 session_.signalbases();
809
810 for (unsigned int channel_id = 0; channel_id < channels; channel_id++) {
811 auto channel = find_if(channels_.begin(), channels_.end(),
a82325d1 812 [&](decode::DecodeChannel ch) { return ch.id == channel_id; });
8b5ea5a1
SA
813
814 if (channel == channels_.end()) {
815 qDebug() << "ERROR: Non-existant channel index:" << channel_id;
816 continue;
817 }
818
819 settings.beginGroup("channel" + QString::number(channel_id));
820
821 QString assigned_signal_name = settings.value("assigned_signal_name").toString();
822
f4ab4b5c 823 for (const shared_ptr<data::SignalBase>& signal : signalbases)
2cc02460 824 if ((signal->name() == assigned_signal_name) && (signal->type() != SignalBase::DecodeChannel))
cf1541a1 825 channel->assigned_signal = signal;
8b5ea5a1
SA
826
827 channel->initial_pin_state = settings.value("initial_pin_state").toInt();
828
829 settings.endGroup();
830 }
831
aa71890d 832 // Update the internal structures
e3202557 833 stack_config_changed_ = true;
aa71890d
SA
834 update_channel_list();
835 commit_decoder_channels();
836
8b5ea5a1 837 begin_decode();
47747218
SA
838}
839
144e72c9
SA
840bool DecodeSignal::all_input_segments_complete(uint32_t segment_id) const
841{
842 bool all_complete = true;
843
844 for (const decode::DecodeChannel& ch : channels_)
845 if (ch.assigned_signal) {
846 if (!ch.assigned_signal->logic_data())
847 continue;
848
849 const shared_ptr<Logic> logic_data = ch.assigned_signal->logic_data();
850 if (logic_data->logic_segments().empty())
851 return false;
852
853 if (segment_id >= logic_data->logic_segments().size())
854 return false;
855
cf1541a1
SA
856 const shared_ptr<const LogicSegment> segment = logic_data->logic_segments()[segment_id]->get_shared_ptr();
857 if (segment && !segment->is_complete())
144e72c9
SA
858 all_complete = false;
859 }
860
861 return all_complete;
862}
863
8a603e13
SA
864uint32_t DecodeSignal::get_input_segment_count() const
865{
866 uint64_t count = std::numeric_limits<uint64_t>::max();
867 bool no_signals_assigned = true;
868
a82325d1 869 for (const decode::DecodeChannel& ch : channels_)
8a603e13
SA
870 if (ch.assigned_signal) {
871 no_signals_assigned = false;
872
873 const shared_ptr<Logic> logic_data = ch.assigned_signal->logic_data();
874 if (!logic_data || logic_data->logic_segments().empty())
875 return 0;
876
877 // Find the min value of all segment counts
878 if ((uint64_t)(logic_data->logic_segments().size()) < count)
879 count = logic_data->logic_segments().size();
880 }
881
882 return (no_signals_assigned ? 0 : count);
883}
884
2a12830c 885double DecodeSignal::get_input_samplerate(uint32_t segment_id) const
8a603e13
SA
886{
887 double samplerate = 0;
888
a82325d1 889 for (const decode::DecodeChannel& ch : channels_)
8a603e13
SA
890 if (ch.assigned_signal) {
891 const shared_ptr<Logic> logic_data = ch.assigned_signal->logic_data();
892 if (!logic_data || logic_data->logic_segments().empty())
893 continue;
894
895 try {
cf1541a1
SA
896 const shared_ptr<const LogicSegment> segment =
897 logic_data->logic_segments().at(segment_id)->get_shared_ptr();
898 if (segment)
899 samplerate = segment->samplerate();
30677c13 900 } catch (out_of_range&) {
8a603e13
SA
901 // Do nothing
902 }
903 break;
904 }
905
906 return samplerate;
907}
908
6a26fc44
SA
909Decoder* DecodeSignal::get_decoder_by_instance(const srd_decoder *const srd_dec)
910{
911 for (shared_ptr<Decoder>& d : stack_)
912 if (d->get_srd_decoder() == srd_dec)
913 return d.get();
914
915 return nullptr;
916}
917
9f97b357
SA
918void DecodeSignal::update_channel_list()
919{
a82325d1 920 vector<decode::DecodeChannel> prev_channels = channels_;
9f97b357
SA
921 channels_.clear();
922
923 uint16_t id = 0;
924
925 // Copy existing entries, create new as needed
f4ab4b5c 926 for (shared_ptr<Decoder>& decoder : stack_) {
6a26fc44 927 const srd_decoder* srd_dec = decoder->get_srd_decoder();
9f97b357
SA
928 const GSList *l;
929
930 // Mandatory channels
6a26fc44 931 for (l = srd_dec->channels; l; l = l->next) {
9f97b357
SA
932 const struct srd_channel *const pdch = (struct srd_channel *)l->data;
933 bool ch_added = false;
934
935 // Copy but update ID if this channel was in the list before
a82325d1 936 for (decode::DecodeChannel& ch : prev_channels)
9f97b357
SA
937 if (ch.pdch_ == pdch) {
938 ch.id = id++;
939 channels_.push_back(ch);
940 ch_added = true;
941 break;
942 }
943
944 if (!ch_added) {
945 // Create new entry without a mapped signal
a82325d1 946 decode::DecodeChannel ch = {id++, 0, false, nullptr,
9f97b357
SA
947 QString::fromUtf8(pdch->name), QString::fromUtf8(pdch->desc),
948 SRD_INITIAL_PIN_SAME_AS_SAMPLE0, decoder, pdch};
949 channels_.push_back(ch);
950 }
951 }
952
953 // Optional channels
6a26fc44 954 for (l = srd_dec->opt_channels; l; l = l->next) {
9f97b357
SA
955 const struct srd_channel *const pdch = (struct srd_channel *)l->data;
956 bool ch_added = false;
957
958 // Copy but update ID if this channel was in the list before
a82325d1 959 for (decode::DecodeChannel& ch : prev_channels)
9f97b357
SA
960 if (ch.pdch_ == pdch) {
961 ch.id = id++;
962 channels_.push_back(ch);
963 ch_added = true;
964 break;
965 }
966
967 if (!ch_added) {
968 // Create new entry without a mapped signal
a82325d1 969 decode::DecodeChannel ch = {id++, 0, true, nullptr,
9f97b357
SA
970 QString::fromUtf8(pdch->name), QString::fromUtf8(pdch->desc),
971 SRD_INITIAL_PIN_SAME_AS_SAMPLE0, decoder, pdch};
972 channels_.push_back(ch);
973 }
974 }
975 }
976
47747218
SA
977 // Invalidate the logic output data if the channel assignment changed
978 if (prev_channels.size() != channels_.size()) {
979 // The number of channels changed, there's definitely a difference
980 logic_mux_data_invalid_ = true;
981 } else {
982 // Same number but assignment may still differ, so compare all channels
983 for (size_t i = 0; i < channels_.size(); i++) {
a82325d1
SA
984 const decode::DecodeChannel& p_ch = prev_channels[i];
985 const decode::DecodeChannel& ch = channels_[i];
47747218
SA
986
987 if ((p_ch.pdch_ != ch.pdch_) ||
988 (p_ch.assigned_signal != ch.assigned_signal)) {
989 logic_mux_data_invalid_ = true;
990 break;
991 }
992 }
993
994 }
995
9f97b357
SA
996 channels_updated();
997}
998
27a3f09b 999void DecodeSignal::commit_decoder_channels()
ad908057 1000{
27a3f09b 1001 // Submit channel list to every decoder, containing only the relevant channels
6a26fc44 1002 for (shared_ptr<Decoder> dec : stack_) {
a82325d1 1003 vector<decode::DecodeChannel*> channel_list;
27a3f09b 1004
a82325d1 1005 for (decode::DecodeChannel& ch : channels_)
27a3f09b
SA
1006 if (ch.decoder_ == dec)
1007 channel_list.push_back(&ch);
47747218 1008
27a3f09b
SA
1009 dec->set_channels(channel_list);
1010 }
aa71890d
SA
1011
1012 // Channel bit IDs must be in sync with the channel's apperance in channels_
1013 int id = 0;
a82325d1 1014 for (decode::DecodeChannel& ch : channels_)
aa71890d
SA
1015 if (ch.assigned_signal)
1016 ch.bit_id = id++;
47747218
SA
1017}
1018
ed535cd7 1019void DecodeSignal::mux_logic_samples(uint32_t segment_id, const int64_t start, const int64_t end)
47747218 1020{
27a3f09b
SA
1021 // Enforce end to be greater than start
1022 if (end <= start)
1023 return;
1024
ed535cd7 1025 // Fetch the channel segments and their data
cf1541a1 1026 vector<shared_ptr<const LogicSegment> > segments;
27a3f09b
SA
1027 vector<const uint8_t*> signal_data;
1028 vector<uint8_t> signal_in_bytepos;
1029 vector<uint8_t> signal_in_bitpos;
1030
a82325d1 1031 for (decode::DecodeChannel& ch : channels_)
27a3f09b
SA
1032 if (ch.assigned_signal) {
1033 const shared_ptr<Logic> logic_data = ch.assigned_signal->logic_data();
ed535cd7 1034
cf1541a1 1035 shared_ptr<const LogicSegment> segment;
f5a26d5e 1036 if (segment_id < logic_data->logic_segments().size()) {
cf1541a1 1037 segment = logic_data->logic_segments().at(segment_id)->get_shared_ptr();
f5a26d5e 1038 } else {
ed535cd7
SA
1039 qDebug() << "Muxer error for" << name() << ":" << ch.assigned_signal->name() \
1040 << "has no logic segment" << segment_id;
cf1541a1 1041 logic_mux_interrupt_ = true;
ed535cd7
SA
1042 return;
1043 }
cf1541a1 1044
f5a26d5e
SA
1045 if (!segment)
1046 return;
cf1541a1 1047
27a3f09b 1048 segments.push_back(segment);
b82243f7
SA
1049
1050 uint8_t* data = new uint8_t[(end - start) * segment->unit_size()];
1051 segment->get_samples(start, end, data);
1052 signal_data.push_back(data);
27a3f09b
SA
1053
1054 const int bitpos = ch.assigned_signal->logic_bit_index();
1055 signal_in_bytepos.push_back(bitpos / 8);
1056 signal_in_bitpos.push_back(bitpos % 8);
1057 }
1058
ed535cd7
SA
1059 shared_ptr<LogicSegment> output_segment;
1060 try {
1061 output_segment = logic_mux_data_->logic_segments().at(segment_id);
30677c13 1062 } catch (out_of_range&) {
ed535cd7
SA
1063 qDebug() << "Muxer error for" << name() << ": no logic mux segment" \
1064 << segment_id << "in mux_logic_samples(), mux segments size is" \
1065 << logic_mux_data_->logic_segments().size();
cf1541a1 1066 logic_mux_interrupt_ = true;
ed535cd7
SA
1067 return;
1068 }
1069
27a3f09b 1070 // Perform the muxing of signal data into the output data
8a603e13 1071 uint8_t* output = new uint8_t[(end - start) * output_segment->unit_size()];
27a3f09b
SA
1072 unsigned int signal_count = signal_data.size();
1073
3b5282a2
SA
1074 for (int64_t sample_cnt = 0; !logic_mux_interrupt_ && (sample_cnt < (end - start));
1075 sample_cnt++) {
1076
27a3f09b
SA
1077 int bitpos = 0;
1078 uint8_t bytepos = 0;
1079
8a603e13
SA
1080 const int out_sample_pos = sample_cnt * output_segment->unit_size();
1081 for (unsigned int i = 0; i < output_segment->unit_size(); i++)
27a3f09b 1082 output[out_sample_pos + i] = 0;
47747218 1083
27a3f09b
SA
1084 for (unsigned int i = 0; i < signal_count; i++) {
1085 const int in_sample_pos = sample_cnt * segments[i]->unit_size();
1086 const uint8_t in_sample = 1 &
1087 ((signal_data[i][in_sample_pos + signal_in_bytepos[i]]) >> (signal_in_bitpos[i]));
47747218 1088
27a3f09b
SA
1089 const uint8_t out_sample = output[out_sample_pos + bytepos];
1090
1091 output[out_sample_pos + bytepos] = out_sample | (in_sample << bitpos);
1092
1093 bitpos++;
1094 if (bitpos > 7) {
1095 bitpos = 0;
1096 bytepos++;
1097 }
1098 }
47747218
SA
1099 }
1100
8a603e13 1101 output_segment->append_payload(output, (end - start) * output_segment->unit_size());
27a3f09b
SA
1102 delete[] output;
1103
1104 for (const uint8_t* data : signal_data)
1105 delete[] data;
1106}
1107
1108void DecodeSignal::logic_mux_proc()
1109{
144e72c9
SA
1110 uint32_t input_segment_count;
1111 do {
1112 input_segment_count = get_input_segment_count();
1113 if (input_segment_count == 0) {
1114 // Wait for input data
1115 unique_lock<mutex> logic_mux_lock(logic_mux_mutex_);
1116 logic_mux_cond_.wait(logic_mux_lock);
1117 }
1118 } while ((!logic_mux_interrupt_) && (input_segment_count == 0));
1119
1120 if (logic_mux_interrupt_)
1121 return;
ed535cd7 1122
8a603e13
SA
1123 assert(logic_mux_data_);
1124
144e72c9
SA
1125 uint32_t segment_id = 0;
1126
65efd025
SA
1127 // Create initial logic mux segment
1128 shared_ptr<LogicSegment> output_segment =
cf1541a1 1129 make_shared<LogicSegment>(*logic_mux_data_, segment_id, logic_mux_unit_size_, 0);
65efd025 1130 logic_mux_data_->push_segment(output_segment);
8a603e13
SA
1131
1132 output_segment->set_samplerate(get_input_samplerate(0));
ed535cd7 1133
144e72c9
SA
1134 // Logic mux data is being updated
1135 logic_mux_data_invalid_ = false;
1136
db51130d
SA
1137 connect_input_segment_notifiers(segment_id);
1138
144e72c9 1139 uint64_t samples_to_process;
27a3f09b 1140 do {
144e72c9
SA
1141 do {
1142 const uint64_t input_sample_count = get_working_sample_count(segment_id);
1143 const uint64_t output_sample_count = output_segment->get_sample_count();
27a3f09b 1144
144e72c9
SA
1145 samples_to_process =
1146 (input_sample_count > output_sample_count) ?
1147 (input_sample_count - output_sample_count) : 0;
ed535cd7 1148
144e72c9
SA
1149 if (samples_to_process > 0) {
1150 const uint64_t unit_size = output_segment->unit_size();
1151 const uint64_t chunk_sample_count = DecodeChunkLength / unit_size;
ba5f2186 1152
144e72c9
SA
1153 uint64_t processed_samples = 0;
1154 do {
1155 const uint64_t start_sample = output_sample_count + processed_samples;
1156 const uint64_t sample_count =
1157 min(samples_to_process - processed_samples, chunk_sample_count);
1158
1159 mux_logic_samples(segment_id, start_sample, start_sample + sample_count);
1160 processed_samples += sample_count;
1161
1162 // ...and process the newly muxed logic data
1163 decode_input_cond_.notify_one();
1164 } while (!logic_mux_interrupt_ && (processed_samples < samples_to_process));
1165 }
1166 } while (!logic_mux_interrupt_ && (samples_to_process > 0));
1167
1168 if (!logic_mux_interrupt_) {
1169 // samples_to_process is now 0, we've exhausted the currently available input data
1170
1171 // If the input segments are complete, we've completed this segment
1172 if (all_input_segments_complete(segment_id)) {
1173 if (!output_segment->is_complete())
1174 output_segment->set_complete();
1175
1176 if (segment_id < get_input_segment_count() - 1) {
db51130d
SA
1177
1178 disconnect_input_segment_notifiers(segment_id);
1179
144e72c9
SA
1180 // Process next segment
1181 segment_id++;
ed535cd7 1182
144e72c9
SA
1183 output_segment =
1184 make_shared<LogicSegment>(*logic_mux_data_, segment_id,
1185 logic_mux_unit_size_, 0);
1186 logic_mux_data_->push_segment(output_segment);
1187
1188 output_segment->set_samplerate(get_input_samplerate(segment_id));
db51130d
SA
1189
1190 connect_input_segment_notifiers(segment_id);
9431e2d3
SA
1191 } else {
1192 // Wait for more input data if we're processing the currently last segment
1193 unique_lock<mutex> logic_mux_lock(logic_mux_mutex_);
1194 logic_mux_cond_.wait(logic_mux_lock);
144e72c9 1195 }
db51130d
SA
1196 } else {
1197 // Input segments aren't all complete yet but samples_to_process is 0, wait for more input data
1198 unique_lock<mutex> logic_mux_lock(logic_mux_mutex_);
1199 logic_mux_cond_.wait(logic_mux_lock);
69e95096 1200 }
27a3f09b 1201 }
1ec191ed 1202 } while (!logic_mux_interrupt_);
db51130d
SA
1203
1204 disconnect_input_segment_notifiers(segment_id);
47747218
SA
1205}
1206
1207void DecodeSignal::decode_data(
8a603e13 1208 const int64_t abs_start_samplenum, const int64_t sample_count,
cf1541a1 1209 const shared_ptr<const LogicSegment> input_segment)
47747218 1210{
8a603e13 1211 const int64_t unit_size = input_segment->unit_size();
27a3f09b 1212 const int64_t chunk_sample_count = DecodeChunkLength / unit_size;
47747218
SA
1213
1214 for (int64_t i = abs_start_samplenum;
69e95096 1215 !decode_interrupt_ && (i < (abs_start_samplenum + sample_count));
47747218
SA
1216 i += chunk_sample_count) {
1217
1218 const int64_t chunk_end = min(i + chunk_sample_count,
1219 abs_start_samplenum + sample_count);
1220
e06cf18d
SA
1221 {
1222 lock_guard<mutex> lock(output_mutex_);
b82908ab
SA
1223 // Update the sample count showing the samples including currently processed ones
1224 segments_.at(current_segment_id_).samples_decoded_incl = chunk_end;
e06cf18d
SA
1225 }
1226
b82243f7
SA
1227 int64_t data_size = (chunk_end - i) * unit_size;
1228 uint8_t* chunk = new uint8_t[data_size];
8a603e13 1229 input_segment->get_samples(i, chunk_end, chunk);
47747218 1230
e91883bb 1231 if (srd_session_send(srd_session_, i, chunk_end, chunk,
144e72c9 1232 data_size, unit_size) != SRD_OK) {
403c3e87 1233 set_error_message(tr("Decoder reported an error"));
144e72c9
SA
1234 decode_interrupt_ = true;
1235 }
a3ebd556 1236
47747218
SA
1237 delete[] chunk;
1238
b82908ab
SA
1239 {
1240 lock_guard<mutex> lock(output_mutex_);
1241 // Now that all samples are processed, the exclusive sample count catches up
1242 segments_.at(current_segment_id_).samples_decoded_excl = chunk_end;
1243 }
1244
1b56c646
SA
1245 // Notify the frontend that we processed some data and
1246 // possibly have new annotations as well
1247 new_annotations();
556259d2
SA
1248
1249 if (decode_paused_) {
1250 unique_lock<mutex> pause_wait_lock(decode_pause_mutex_);
1251 decode_pause_cond_.wait(pause_wait_lock);
1252 }
47747218
SA
1253 }
1254}
1255
1256void DecodeSignal::decode_proc()
1257{
65efd025
SA
1258 current_segment_id_ = 0;
1259
1260 // If there is no input data available yet, wait until it is or we're interrupted
144e72c9
SA
1261 do {
1262 if (logic_mux_data_->logic_segments().size() == 0) {
1263 // Wait for input data
1264 unique_lock<mutex> input_wait_lock(input_mutex_);
1265 decode_input_cond_.wait(input_wait_lock);
1266 }
1267 } while ((!decode_interrupt_) && (logic_mux_data_->logic_segments().size() == 0));
a3ebd556
SA
1268
1269 if (decode_interrupt_)
1270 return;
1271
cf1541a1
SA
1272 shared_ptr<const LogicSegment> input_segment = logic_mux_data_->logic_segments().front()->get_shared_ptr();
1273 if (!input_segment)
1274 return;
65efd025
SA
1275
1276 // Create the initial segment and set its sample rate so that we can pass it to SRD
1277 create_decode_segment();
8a603e13 1278 segments_.at(current_segment_id_).samplerate = input_segment->samplerate();
65efd025 1279 segments_.at(current_segment_id_).start_time = input_segment->start_time();
8a603e13 1280
65efd025
SA
1281 start_srd_session();
1282
144e72c9 1283 uint64_t samples_to_process = 0;
27a3f09b 1284 uint64_t abs_start_samplenum = 0;
47747218 1285 do {
27a3f09b
SA
1286 // Keep processing new samples until we exhaust the input data
1287 do {
144e72c9 1288 samples_to_process = input_segment->get_sample_count() - abs_start_samplenum;
27a3f09b 1289
144e72c9
SA
1290 if (samples_to_process > 0) {
1291 decode_data(abs_start_samplenum, samples_to_process, input_segment);
1292 abs_start_samplenum += samples_to_process;
27a3f09b 1293 }
144e72c9
SA
1294 } while (!decode_interrupt_ && (samples_to_process > 0));
1295
1296 if (!decode_interrupt_) {
1297 // samples_to_process is now 0, we've exhausted the currently available input data
1298
1299 // If the input segment is complete, we've exhausted this segment
1300 if (input_segment->is_complete()) {
69e95096 1301 if (current_segment_id_ < (logic_mux_data_->logic_segments().size() - 1)) {
144e72c9
SA
1302 // Process next segment
1303 current_segment_id_++;
1304
1305 try {
1306 input_segment = logic_mux_data_->logic_segments().at(current_segment_id_);
1307 } catch (out_of_range&) {
1308 qDebug() << "Decode error for" << name() << ": no logic mux segment" \
1309 << current_segment_id_ << "in decode_proc(), mux segments size is" \
1310 << logic_mux_data_->logic_segments().size();
1311 decode_interrupt_ = true;
1312 return;
1313 }
1314 abs_start_samplenum = 0;
1315
1316 // Create the next segment and set its metadata
1317 create_decode_segment();
1318 segments_.at(current_segment_id_).samplerate = input_segment->samplerate();
1319 segments_.at(current_segment_id_).start_time = input_segment->start_time();
1320
1321 // Reset decoder state but keep the decoder stack intact
1322 terminate_srd_session();
1323 } else {
1324 // All segments have been processed
f5a26d5e
SA
1325 if (!decode_interrupt_)
1326 decode_finished();
9431e2d3
SA
1327
1328 // Wait for more input data
1329 unique_lock<mutex> input_wait_lock(input_mutex_);
1330 decode_input_cond_.wait(input_wait_lock);
8a603e13 1331 }
db51130d
SA
1332 } else {
1333 // Input segment isn't complete yet but samples_to_process is 0, wait for more input data
1334 unique_lock<mutex> input_wait_lock(input_mutex_);
1335 decode_input_cond_.wait(input_wait_lock);
69e95096
SA
1336 }
1337
27a3f09b 1338 }
144e72c9 1339 } while (!decode_interrupt_);
e91883bb
SA
1340}
1341
1342void DecodeSignal::start_srd_session()
1343{
8ce0e732
SA
1344 // If there were stack changes, the session has been destroyed by now, so if
1345 // it hasn't been destroyed, we can just reset and re-use it
ce0b6a40
GS
1346 if (srd_session_) {
1347 // When a decoder stack was created before, re-use it
1348 // for the next stream of input data, after terminating
1349 // potentially still executing operations, and resetting
1350 // internal state. Skip the rather expensive (teardown
1351 // and) construction of another decoder stack.
1352
1353 // TODO Reduce redundancy, use a common code path for
72486b78 1354 // the meta/start sequence?
ce0b6a40 1355 terminate_srd_session();
72486b78
SA
1356
1357 // Metadata is cleared also, so re-set it
ba5b52e1 1358 uint64_t samplerate = 0;
7dd518b8 1359 if (segments_.size() > 0)
ba5b52e1
GS
1360 samplerate = segments_.at(current_segment_id_).samplerate;
1361 if (samplerate)
7dd518b8 1362 srd_session_metadata_set(srd_session_, SRD_CONF_SAMPLERATE,
ba5b52e1 1363 g_variant_new_uint64(samplerate));
6a26fc44 1364 for (const shared_ptr<Decoder>& dec : stack_)
72486b78 1365 dec->apply_all_options();
ce0b6a40 1366 srd_session_start(srd_session_);
72486b78 1367
ce0b6a40
GS
1368 return;
1369 }
e91883bb 1370
a3ebd556
SA
1371 // Create the session
1372 srd_session_new(&srd_session_);
1373 assert(srd_session_);
47747218 1374
a3ebd556
SA
1375 // Create the decoders
1376 srd_decoder_inst *prev_di = nullptr;
6a26fc44 1377 for (const shared_ptr<Decoder>& dec : stack_) {
a3ebd556 1378 srd_decoder_inst *const di = dec->create_decoder_inst(srd_session_);
e91883bb 1379
a3ebd556 1380 if (!di) {
403c3e87 1381 set_error_message(tr("Failed to create decoder instance"));
a3ebd556 1382 srd_session_destroy(srd_session_);
c5f9553c 1383 srd_session_ = nullptr;
a3ebd556
SA
1384 return;
1385 }
e91883bb 1386
a3ebd556
SA
1387 if (prev_di)
1388 srd_inst_stack(srd_session_, prev_di, di);
e91883bb 1389
a3ebd556 1390 prev_di = di;
e91883bb 1391 }
a3ebd556
SA
1392
1393 // Start the session
7dd518b8
SA
1394 if (segments_.size() > 0)
1395 srd_session_metadata_set(srd_session_, SRD_CONF_SAMPLERATE,
1396 g_variant_new_uint64(segments_.at(current_segment_id_).samplerate));
a3ebd556
SA
1397
1398 srd_pd_output_callback_add(srd_session_, SRD_OUTPUT_ANN,
1399 DecodeSignal::annotation_callback, this);
1400
c0c3e62a
SA
1401 srd_pd_output_callback_add(srd_session_, SRD_OUTPUT_BINARY,
1402 DecodeSignal::binary_callback, this);
1403
a3ebd556 1404 srd_session_start(srd_session_);
e3202557
SA
1405
1406 // We just recreated the srd session, so all stack changes are applied now
1407 stack_config_changed_ = false;
e91883bb 1408}
47747218 1409
ce0b6a40
GS
1410void DecodeSignal::terminate_srd_session()
1411{
1412 // Call the "terminate and reset" routine for the decoder stack
1413 // (if available). This does not harm those stacks which already
1414 // have completed their operation, and reduces response time for
1415 // those stacks which still are processing data while the
1416 // application no longer wants them to.
72486b78 1417 if (srd_session_) {
ce0b6a40 1418 srd_session_terminate_reset(srd_session_);
72486b78
SA
1419
1420 // Metadata is cleared also, so re-set it
ba5b52e1 1421 uint64_t samplerate = 0;
7dd518b8 1422 if (segments_.size() > 0)
ba5b52e1
GS
1423 samplerate = segments_.at(current_segment_id_).samplerate;
1424 if (samplerate)
7dd518b8 1425 srd_session_metadata_set(srd_session_, SRD_CONF_SAMPLERATE,
ba5b52e1 1426 g_variant_new_uint64(samplerate));
6a26fc44 1427 for (const shared_ptr<Decoder>& dec : stack_)
72486b78
SA
1428 dec->apply_all_options();
1429 }
ce0b6a40
GS
1430}
1431
e91883bb
SA
1432void DecodeSignal::stop_srd_session()
1433{
1434 if (srd_session_) {
1435 // Destroy the session
1436 srd_session_destroy(srd_session_);
1437 srd_session_ = nullptr;
8ce0e732
SA
1438
1439 // Mark the decoder instances as non-existant since they were deleted
6a26fc44 1440 for (const shared_ptr<Decoder>& dec : stack_)
8ce0e732 1441 dec->invalidate_decoder_inst();
e91883bb 1442 }
47747218
SA
1443}
1444
a8a9222d
SA
1445void DecodeSignal::connect_input_notifiers()
1446{
a8a9222d 1447 // Connect the currently used signals to our slot
a82325d1 1448 for (decode::DecodeChannel& ch : channels_) {
a8a9222d
SA
1449 if (!ch.assigned_signal)
1450 continue;
db51130d 1451 const data::SignalBase *signal = ch.assigned_signal.get();
1c552f40 1452
db51130d
SA
1453 connect(signal, SIGNAL(samples_cleared()),
1454 this, SLOT(on_data_cleared()));
1455 connect(signal, SIGNAL(samples_added(uint64_t, uint64_t, uint64_t)),
1456 this, SLOT(on_data_received()));
1457 }
1458}
a8a9222d 1459
db51130d
SA
1460void DecodeSignal::disconnect_input_notifiers()
1461{
1462 // Disconnect the notification slot from the previous set of signals
1463 for (decode::DecodeChannel& ch : channels_) {
1464 if (!ch.assigned_signal)
1465 continue;
cf1541a1 1466 const data::SignalBase *signal = ch.assigned_signal.get();
db51130d
SA
1467 disconnect(signal, nullptr, this, SLOT(on_data_cleared()));
1468 disconnect(signal, nullptr, this, SLOT(on_data_received()));
a8a9222d
SA
1469 }
1470}
1471
db51130d
SA
1472void DecodeSignal::connect_input_segment_notifiers(uint32_t segment_id)
1473{
1474 for (decode::DecodeChannel& ch : channels_)
1475 if (ch.assigned_signal) {
1476 const shared_ptr<Logic> logic_data = ch.assigned_signal->logic_data();
1477
1478 shared_ptr<const LogicSegment> segment;
1479 if (segment_id < logic_data->logic_segments().size()) {
1480 segment = logic_data->logic_segments().at(segment_id)->get_shared_ptr();
1481 } else {
1482 qWarning() << "Signal" << name() << ":" << ch.assigned_signal->name() \
1483 << "has no logic segment, can't connect notifier" << segment_id;
1484 continue;
1485 }
1486
1c552f40
SA
1487 if (!segment) {
1488 qWarning() << "Signal" << name() << ":" << ch.assigned_signal->name() \
1489 << "has no logic segment, can't connect notifier" << segment_id;
db51130d 1490 continue;
1c552f40 1491 }
db51130d
SA
1492
1493 connect(segment.get(), SIGNAL(completed()), this, SLOT(on_input_segment_completed()));
1494 }
1495}
1496
1497void DecodeSignal::disconnect_input_segment_notifiers(uint32_t segment_id)
1498{
1499 for (decode::DecodeChannel& ch : channels_)
1500 if (ch.assigned_signal) {
1501 const shared_ptr<Logic> logic_data = ch.assigned_signal->logic_data();
1502
1503 shared_ptr<const LogicSegment> segment;
1c552f40 1504 if (segment_id < logic_data->logic_segments().size())
db51130d 1505 segment = logic_data->logic_segments().at(segment_id)->get_shared_ptr();
1c552f40 1506 else
db51130d 1507 continue;
db51130d
SA
1508
1509 if (!segment)
1510 continue;
1511
1512 disconnect(segment.get(), SIGNAL(completed()), this, SLOT(on_input_segment_completed()));
1513 }
1514}
1515
65efd025 1516void DecodeSignal::create_decode_segment()
4913560f 1517{
65efd025 1518 // Create annotation segment
f54e68b0 1519 segments_.emplace_back();
72435789 1520
65efd025 1521 // Add annotation classes
feda6c6b 1522 for (const shared_ptr<Decoder>& dec : stack_)
6a26fc44
SA
1523 for (Row* row : dec->get_rows())
1524 segments_.back().annotation_rows.emplace(row, RowData(row));
e77de61f
SA
1525
1526 // Prepare our binary output classes
6a26fc44 1527 for (const shared_ptr<Decoder>& dec : stack_) {
ac9494ef 1528 uint32_t n = dec->get_binary_class_count();
e77de61f 1529
ac9494ef 1530 for (uint32_t i = 0; i < n; i++)
e77de61f 1531 segments_.back().binary_classes.push_back(
c8a6db0e 1532 {dec.get(), dec->get_binary_class(i), deque<DecodeBinaryDataChunk>()});
e77de61f 1533 }
4913560f
SA
1534}
1535
47747218
SA
1536void DecodeSignal::annotation_callback(srd_proto_data *pdata, void *decode_signal)
1537{
1538 assert(pdata);
b21501d6 1539 assert(decode_signal);
47747218
SA
1540
1541 DecodeSignal *const ds = (DecodeSignal*)decode_signal;
1542 assert(ds);
1543
3b5282a2
SA
1544 if (ds->decode_interrupt_)
1545 return;
1546
02c87df7
SA
1547 if (ds->segments_.empty())
1548 return;
1549
47747218
SA
1550 lock_guard<mutex> lock(ds->output_mutex_);
1551
c0c3e62a 1552 // Get the decoder and the annotation data
47747218
SA
1553 assert(pdata->pdo);
1554 assert(pdata->pdo->di);
6a26fc44
SA
1555 const srd_decoder *const srd_dec = pdata->pdo->di->decoder;
1556 assert(srd_dec);
47747218 1557
c0c3e62a 1558 const srd_proto_data_annotation *const pda = (const srd_proto_data_annotation*)pdata->data;
1becee23
UH
1559 assert(pda);
1560
c0c3e62a 1561 // Find the row
6a26fc44
SA
1562 Decoder* dec = ds->get_decoder_by_instance(srd_dec);
1563 assert(dec);
47747218 1564
6a26fc44 1565 AnnotationClass* ann_class = dec->get_ann_class_by_id(pda->ann_class);
4526de63
SA
1566 if (!ann_class) {
1567 qWarning() << "Decoder" << ds->display_name() << "wanted to add annotation" <<
1568 "with class ID" << pda->ann_class << "but there are only" <<
1569 dec->ann_classes().size() << "known classes";
1570 return;
1571 }
6a26fc44
SA
1572
1573 const Row* row = ann_class->row;
1574
1575 if (!row)
1576 row = dec->get_row_by_id(0);
47747218 1577
f54e68b0
SA
1578 RowData& row_data = ds->segments_[ds->current_segment_id_].annotation_rows.at(row);
1579
1580 // Add the annotation to the row
1581 const Annotation* ann = row_data.emplace_annotation(pdata);
1582
ca9a5918
SA
1583 // We insert the annotation into the global annotation list in a way so that
1584 // the annotation list is sorted by start sample and length. Otherwise, we'd
1585 // have to sort the model, which is expensive
f54e68b0
SA
1586 deque<const Annotation*>& all_annotations =
1587 ds->segments_[ds->current_segment_id_].all_annotations;
ca9a5918
SA
1588
1589 if (all_annotations.empty()) {
1590 all_annotations.emplace_back(ann);
1591 } else {
1592 const uint64_t new_ann_len = (pdata->end_sample - pdata->start_sample);
1593 bool ann_has_earlier_start = (pdata->start_sample < all_annotations.back()->start_sample());
1594 bool ann_is_longer = (new_ann_len >
1595 (all_annotations.back()->end_sample() - all_annotations.back()->start_sample()));
1596
1597 if (ann_has_earlier_start && ann_is_longer) {
1598 bool ann_has_same_start;
1599 auto it = all_annotations.end();
1600
1601 do {
1602 it--;
1603 ann_has_earlier_start = (pdata->start_sample < (*it)->start_sample());
1604 ann_has_same_start = (pdata->start_sample == (*it)->start_sample());
d656b010 1605 ann_is_longer = (new_ann_len > (*it)->length());
ca9a5918
SA
1606 } while ((ann_has_earlier_start || (ann_has_same_start && ann_is_longer)) && (it != all_annotations.begin()));
1607
1608 // Allow inserting at the front
1609 if (it != all_annotations.begin())
1610 it++;
1611
1612 all_annotations.emplace(it, ann);
1613 } else
1614 all_annotations.emplace_back(ann);
1615 }
88a25978
SA
1616
1617 // When emplace_annotation() inserts instead of appends an annotation,
1618 // the pointers in all_annotations that follow the inserted annotation and
1619 // point to annotations for this row are off by one and must be updated
1620 if (&(row_data.annotations().back()) != ann) {
1621 // Search backwards until we find the annotation we just added
1622 auto row_it = row_data.annotations().end();
1623 auto all_it = all_annotations.end();
1624 do {
1625 all_it--;
1626 if ((*all_it)->row_data() == &row_data)
1627 row_it--;
1628 } while (&(*row_it) != ann);
1629
1630 // Update the annotation addresses for this row's annotations until the end
1631 do {
1632 if ((*all_it)->row_data() == &row_data) {
1633 *all_it = &(*row_it);
1634 row_it++;
1635 }
1636 all_it++;
1637 } while (all_it != all_annotations.end());
1638 }
47747218
SA
1639}
1640
c0c3e62a
SA
1641void DecodeSignal::binary_callback(srd_proto_data *pdata, void *decode_signal)
1642{
1643 assert(pdata);
1644 assert(decode_signal);
1645
1646 DecodeSignal *const ds = (DecodeSignal*)decode_signal;
1647 assert(ds);
1648
1649 if (ds->decode_interrupt_)
1650 return;
1651
e77de61f
SA
1652 // Get the decoder and the binary data
1653 assert(pdata->pdo);
1654 assert(pdata->pdo->di);
6a26fc44
SA
1655 const srd_decoder *const srd_dec = pdata->pdo->di->decoder;
1656 assert(srd_dec);
e77de61f 1657
c0c3e62a
SA
1658 const srd_proto_data_binary *const pdb = (const srd_proto_data_binary*)pdata->data;
1659 assert(pdb);
1660
e77de61f 1661 // Find the matching DecodeBinaryClass
c0c3e62a
SA
1662 DecodeSegment* segment = &(ds->segments_.at(ds->current_segment_id_));
1663
e77de61f
SA
1664 DecodeBinaryClass* bin_class = nullptr;
1665 for (DecodeBinaryClass& bc : segment->binary_classes)
6a26fc44
SA
1666 if ((bc.decoder->get_srd_decoder() == srd_dec) &&
1667 (bc.info->bin_class_id == (uint32_t)pdb->bin_class))
e77de61f 1668 bin_class = &bc;
c0c3e62a 1669
e77de61f
SA
1670 if (!bin_class) {
1671 qWarning() << "Could not find valid DecodeBinaryClass in segment" <<
1672 ds->current_segment_id_ << "for binary class ID" << pdb->bin_class <<
1673 ", segment only knows" << segment->binary_classes.size() << "classes";
1674 return;
1675 }
c0c3e62a 1676
e77de61f
SA
1677 // Add the data chunk
1678 bin_class->chunks.emplace_back();
1679 DecodeBinaryDataChunk* chunk = &(bin_class->chunks.back());
1680
1681 chunk->sample = pdata->start_sample;
1682 chunk->data.resize(pdb->size);
1683 memcpy(chunk->data.data(), pdb->data, pdb->size);
1684
6a26fc44 1685 Decoder* dec = ds->get_decoder_by_instance(srd_dec);
b2b18d3a
SA
1686
1687 ds->new_binary_data(ds->current_segment_id_, (void*)dec, pdb->bin_class);
c0c3e62a
SA
1688}
1689
47747218
SA
1690void DecodeSignal::on_capture_state_changed(int state)
1691{
1692 // If a new acquisition was started, we need to start decoding from scratch
ba5f2186
SA
1693 if (state == Session::Running) {
1694 logic_mux_data_invalid_ = true;
47747218 1695 begin_decode();
ba5f2186 1696 }
47747218
SA
1697}
1698
1b56c646
SA
1699void DecodeSignal::on_data_cleared()
1700{
1701 reset_decode();
1702}
1703
47747218
SA
1704void DecodeSignal::on_data_received()
1705{
5620539c
SA
1706 // If we detected a lack of input data when trying to start decoding,
1707 // we have set an error message. Only try again if we now have data
1708 // to work with
1709 if ((!error_message_.isEmpty()) && (get_input_segment_count() == 0))
1710 return;
69e95096
SA
1711 else {
1712 error_message_.clear();
1713 // TODO Emulate noquote()
1714 qDebug().nospace() << name() << ": Error cleared";
1715 }
5620539c 1716
1b56c646
SA
1717 if (!logic_mux_thread_.joinable())
1718 begin_decode();
1719 else
1720 logic_mux_cond_.notify_one();
47747218
SA
1721}
1722
db51130d
SA
1723void DecodeSignal::on_input_segment_completed()
1724{
1725 if (!logic_mux_thread_.joinable())
1726 logic_mux_cond_.notify_one();
1727}
1728
02078aa1
SA
1729void DecodeSignal::on_annotation_visibility_changed()
1730{
1731 annotation_visibility_changed();
1732}
1733
ad908057
SA
1734} // namespace data
1735} // namespace pv