mirror of
				https://github.com/f4exb/sdrangel.git
				synced 2025-11-04 05:30:32 -05:00 
			
		
		
		
	Add worker source
This commit is contained in:
		
							parent
							
								
									ff26ece347
								
							
						
					
					
						commit
						3287346a7e
					
				
							
								
								
									
										159
									
								
								plugins/channelrx/demoddatv/ldpctool/ldpcworker.cpp
									
									
									
									
									
										Normal file
									
								
							
							
						
						
									
										159
									
								
								plugins/channelrx/demoddatv/ldpctool/ldpcworker.cpp
									
									
									
									
									
										Normal file
									
								
							@ -0,0 +1,159 @@
 | 
				
			|||||||
 | 
					/*
 | 
				
			||||||
 | 
					LDPC testbench
 | 
				
			||||||
 | 
					Copyright 2018 Ahmet Inan <xdsopl@gmail.com>
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
					Transformed into external decoder for third-party applications
 | 
				
			||||||
 | 
					Copyright 2019 <pabr@pabr.org>
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
					Transformed again in to a Qt worker.
 | 
				
			||||||
 | 
					*/
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
					#include <QDebug>
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
					#include <stdlib.h>
 | 
				
			||||||
 | 
					#ifdef _MSC_VER
 | 
				
			||||||
 | 
					#include <malloc.h>
 | 
				
			||||||
 | 
					#endif
 | 
				
			||||||
 | 
					#include <iostream>
 | 
				
			||||||
 | 
					#include <iomanip>
 | 
				
			||||||
 | 
					#include <random>
 | 
				
			||||||
 | 
					#include <cmath>
 | 
				
			||||||
 | 
					#include <cassert>
 | 
				
			||||||
 | 
					#include <chrono>
 | 
				
			||||||
 | 
					#include <cstring>
 | 
				
			||||||
 | 
					#include <algorithm>
 | 
				
			||||||
 | 
					#include <functional>
 | 
				
			||||||
 | 
					#include "ldpcworker.h"
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
					LDPCWorker::LDPCWorker(int modcod, int maxTrials, int batchSize, bool shortFrames) :
 | 
				
			||||||
 | 
					    m_maxTrials(maxTrials),
 | 
				
			||||||
 | 
					    m_aligned_buffer(nullptr),
 | 
				
			||||||
 | 
					    m_ldpc(nullptr),
 | 
				
			||||||
 | 
					    m_code(nullptr),
 | 
				
			||||||
 | 
					    m_simd(nullptr)
 | 
				
			||||||
 | 
					{
 | 
				
			||||||
 | 
					    // DVB-S2 MODCOD definitions
 | 
				
			||||||
 | 
					    static const char *mc_tabnames[2][32] = { // [shortframes][modcod]
 | 
				
			||||||
 | 
					                                             {// Normal frames
 | 
				
			||||||
 | 
					                                              0, "B1", "B2", "B3", "B4", "B5", "B6", "B7",
 | 
				
			||||||
 | 
					                                              "B8", "B9", "B10", "B11", "B5", "B6", "B7", "B9",
 | 
				
			||||||
 | 
					                                              "B10", "B11", "B6", "B7", "B8", "B9", "B10", "B11",
 | 
				
			||||||
 | 
					                                              "B7", "B8", "B8", "B10", "B11", 0, 0, 0},
 | 
				
			||||||
 | 
					                                             {// Short frames
 | 
				
			||||||
 | 
					                                              0, "C1", "C2", "C3", "C4", "C5", "C6", "C7",
 | 
				
			||||||
 | 
					                                              "C8", "C9", "C10", 0, "C5", "C6", "C7", "C9",
 | 
				
			||||||
 | 
					                                              "C10", 0, "C6", "C7", "C8", "C9", "C10", 0,
 | 
				
			||||||
 | 
					                                              "C7", "C8", "C8", "C10", 0, 0, 0, 0}};
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
					    const char *tabname = mc_tabnames[shortFrames][modcod];
 | 
				
			||||||
 | 
					    if (!tabname)
 | 
				
			||||||
 | 
					    {
 | 
				
			||||||
 | 
					        qCritical() << "LDPCWorker::LDPCWorker: unsupported modcod";
 | 
				
			||||||
 | 
					        return;
 | 
				
			||||||
 | 
					    }
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
					    m_ldpc = ldpctool::create_ldpc((char *)"S2", tabname[0], atoi(tabname + 1));
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
					    if (!m_ldpc)
 | 
				
			||||||
 | 
					    {
 | 
				
			||||||
 | 
					        qCritical() << "LDPCWorker::LDPCWorker: no such table!";
 | 
				
			||||||
 | 
					        return;
 | 
				
			||||||
 | 
					    }
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
					    m_codeLen = m_ldpc->code_len();
 | 
				
			||||||
 | 
					    m_dataLen = m_ldpc->data_len();
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
					    m_decode.init(m_ldpc);
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
					    BLOCKS = batchSize;
 | 
				
			||||||
 | 
					    m_code = new ldpctool::code_type[BLOCKS * m_codeLen];
 | 
				
			||||||
 | 
					    m_aligned_buffer = ldpctool::LDPCUtil::aligned_malloc(sizeof(ldpctool::simd_type), sizeof(ldpctool::simd_type) * m_codeLen);
 | 
				
			||||||
 | 
					    m_simd = reinterpret_cast<ldpctool::simd_type *>(m_aligned_buffer);
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
					    // Expect LLR values in int8_t format.
 | 
				
			||||||
 | 
					    if (sizeof(ldpctool::code_type) != 1) {
 | 
				
			||||||
 | 
					        qCritical() << "LDPCWorker::LDPCWorker: Unsupported code_type";
 | 
				
			||||||
 | 
					    }
 | 
				
			||||||
 | 
					}
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
					LDPCWorker::~LDPCWorker()
 | 
				
			||||||
 | 
					{
 | 
				
			||||||
 | 
					    m_condOut.wakeAll();
 | 
				
			||||||
 | 
					    delete m_ldpc;
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
					    ldpctool::LDPCUtil::aligned_free(m_aligned_buffer);
 | 
				
			||||||
 | 
					    delete[] m_code;
 | 
				
			||||||
 | 
					}
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
					void LDPCWorker::process(QByteArray data)
 | 
				
			||||||
 | 
					{
 | 
				
			||||||
 | 
					    int trials_count = 0;
 | 
				
			||||||
 | 
					    int max_count = 0;
 | 
				
			||||||
 | 
					    int num_decodes = 0;
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
					    int iosize = m_codeLen * sizeof(*m_code);
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
					    m_mutexIn.lock();
 | 
				
			||||||
 | 
					    m_dataIn.append(data);
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
					    if (m_dataIn.size() >= BLOCKS)
 | 
				
			||||||
 | 
					    {
 | 
				
			||||||
 | 
					        for (int j = 0; j < BLOCKS; j++)
 | 
				
			||||||
 | 
					        {
 | 
				
			||||||
 | 
					            QByteArray inputData = m_dataIn.takeAt(0);
 | 
				
			||||||
 | 
					            memcpy(m_code + j * m_codeLen, inputData.data(), inputData.size());
 | 
				
			||||||
 | 
					        }
 | 
				
			||||||
 | 
					        m_mutexIn.unlock();
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
					        for (int j = 0; j < BLOCKS; j += ldpctool::SIMD_WIDTH)
 | 
				
			||||||
 | 
					        {
 | 
				
			||||||
 | 
					            int blocks = j + ldpctool::SIMD_WIDTH > BLOCKS ? BLOCKS - j : ldpctool::SIMD_WIDTH;
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
					            for (int n = 0; n < blocks; ++n)
 | 
				
			||||||
 | 
					                for (int i = 0; i < m_codeLen; ++i)
 | 
				
			||||||
 | 
					                    reinterpret_cast<ldpctool::code_type *>(m_simd + i)[n] = m_code[(j + n) * m_codeLen + i];
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
					            int count = m_decode(m_simd, m_simd + m_dataLen, m_maxTrials, blocks);
 | 
				
			||||||
 | 
					            num_decodes++;
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
					            if (count < 0)
 | 
				
			||||||
 | 
					            {
 | 
				
			||||||
 | 
					                trials_count += m_maxTrials;
 | 
				
			||||||
 | 
					                max_count++;
 | 
				
			||||||
 | 
					            }
 | 
				
			||||||
 | 
					            else
 | 
				
			||||||
 | 
					            {
 | 
				
			||||||
 | 
					                trials_count += m_maxTrials - count;
 | 
				
			||||||
 | 
					            }
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
					            if (num_decodes == 20)
 | 
				
			||||||
 | 
					            {
 | 
				
			||||||
 | 
					                qDebug() << "ldpc_tool: trials: " << ((trials_count*100)/(num_decodes*m_maxTrials)) << "% max: "
 | 
				
			||||||
 | 
					                        << ((max_count*100)/num_decodes) << "% at converging to a code word (max trials: " << m_maxTrials << ")";
 | 
				
			||||||
 | 
					                trials_count = 0;
 | 
				
			||||||
 | 
					                max_count = 0;
 | 
				
			||||||
 | 
					                num_decodes = 0;
 | 
				
			||||||
 | 
					            }
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
					            for (int n = 0; n < blocks; ++n)
 | 
				
			||||||
 | 
					                for (int i = 0; i < m_codeLen; ++i)
 | 
				
			||||||
 | 
					                    m_code[(j + n) * m_codeLen + i] = reinterpret_cast<ldpctool::code_type *>(m_simd + i)[n];
 | 
				
			||||||
 | 
					        }
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
					        for (int i = 0; i < BLOCKS * m_codeLen; ++i)
 | 
				
			||||||
 | 
					            assert(!std::isnan(m_code[i]));
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
					        m_mutexOut.lock();
 | 
				
			||||||
 | 
					        for (int j = 0; j < BLOCKS; j++)
 | 
				
			||||||
 | 
					        {
 | 
				
			||||||
 | 
					            QByteArray outputData((const char *)m_code + j * m_codeLen, iosize);
 | 
				
			||||||
 | 
					            m_dataOut.append(outputData);
 | 
				
			||||||
 | 
					        }
 | 
				
			||||||
 | 
					        m_condOut.wakeAll();
 | 
				
			||||||
 | 
					        m_mutexOut.unlock();
 | 
				
			||||||
 | 
					    }
 | 
				
			||||||
 | 
					    else
 | 
				
			||||||
 | 
					    {
 | 
				
			||||||
 | 
					        m_mutexIn.unlock();
 | 
				
			||||||
 | 
					    }
 | 
				
			||||||
 | 
					}
 | 
				
			||||||
							
								
								
									
										94
									
								
								plugins/channelrx/demoddatv/ldpctool/ldpcworker.h
									
									
									
									
									
										Normal file
									
								
							
							
						
						
									
										94
									
								
								plugins/channelrx/demoddatv/ldpctool/ldpcworker.h
									
									
									
									
									
										Normal file
									
								
							@ -0,0 +1,94 @@
 | 
				
			|||||||
 | 
					///////////////////////////////////////////////////////////////////////////////////
 | 
				
			||||||
 | 
					// Copyright (C) 2022 Jon Beniston, M7RCE                                        //
 | 
				
			||||||
 | 
					//                                                                               //
 | 
				
			||||||
 | 
					// This program is free software; you can redistribute it and/or modify          //
 | 
				
			||||||
 | 
					// it under the terms of the GNU General Public License as published by          //
 | 
				
			||||||
 | 
					// the Free Software Foundation as version 3 of the License, or                  //
 | 
				
			||||||
 | 
					// (at your option) any later version.                                           //
 | 
				
			||||||
 | 
					//                                                                               //
 | 
				
			||||||
 | 
					// This program is distributed in the hope that it will be useful,               //
 | 
				
			||||||
 | 
					// but WITHOUT ANY WARRANTY; without even the implied warranty of                //
 | 
				
			||||||
 | 
					// MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the                  //
 | 
				
			||||||
 | 
					// GNU General Public License V3 for more details.                               //
 | 
				
			||||||
 | 
					//                                                                               //
 | 
				
			||||||
 | 
					// You should have received a copy of the GNU General Public License             //
 | 
				
			||||||
 | 
					// along with this program. If not, see <http://www.gnu.org/licenses/>.          //
 | 
				
			||||||
 | 
					///////////////////////////////////////////////////////////////////////////////////
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
					#include <QObject>
 | 
				
			||||||
 | 
					#include <QByteArray>
 | 
				
			||||||
 | 
					#include <QMutex>
 | 
				
			||||||
 | 
					#include <QWaitCondition>
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
					#include "testbench.h"
 | 
				
			||||||
 | 
					#include "algorithms.h"
 | 
				
			||||||
 | 
					#include "ldpc.h"
 | 
				
			||||||
 | 
					#include "layered_decoder.h"
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
					class LDPCWorker : public QObject {
 | 
				
			||||||
 | 
					    Q_OBJECT
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
					public:
 | 
				
			||||||
 | 
					    LDPCWorker(int modcod, int maxTrials, int batchSize, bool shortFrames);
 | 
				
			||||||
 | 
					    ~LDPCWorker();
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
					    // Are we busy
 | 
				
			||||||
 | 
					    bool busy()
 | 
				
			||||||
 | 
					    {
 | 
				
			||||||
 | 
					        QMutexLocker locker(&m_mutexIn);
 | 
				
			||||||
 | 
					        return m_dataIn.size() >= BLOCKS;
 | 
				
			||||||
 | 
					    }
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
					    // Is processed data available?
 | 
				
			||||||
 | 
					    bool dataAvailable()
 | 
				
			||||||
 | 
					    {
 | 
				
			||||||
 | 
					        QMutexLocker locker(&m_mutexOut);
 | 
				
			||||||
 | 
					        return !m_dataOut.isEmpty();
 | 
				
			||||||
 | 
					    }
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
					    // Get processed data
 | 
				
			||||||
 | 
					    QByteArray data()
 | 
				
			||||||
 | 
					    {
 | 
				
			||||||
 | 
					        m_mutexOut.lock();
 | 
				
			||||||
 | 
					        if (m_dataOut.isEmpty()) {
 | 
				
			||||||
 | 
					            m_condOut.wait(&m_mutexOut);
 | 
				
			||||||
 | 
					        }
 | 
				
			||||||
 | 
					        QByteArray data = m_dataOut.takeAt(0);
 | 
				
			||||||
 | 
					        m_mutexOut.unlock();
 | 
				
			||||||
 | 
					        return data;
 | 
				
			||||||
 | 
					    }
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
					public slots:
 | 
				
			||||||
 | 
					    void process(QByteArray data);
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
					signals:
 | 
				
			||||||
 | 
					    void finished();
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
					private:
 | 
				
			||||||
 | 
					    QMutex m_mutexIn;
 | 
				
			||||||
 | 
					    QMutex m_mutexOut;
 | 
				
			||||||
 | 
					    QWaitCondition m_condOut;
 | 
				
			||||||
 | 
					    QList<QByteArray> m_dataIn;
 | 
				
			||||||
 | 
					    QList<QByteArray> m_dataOut;
 | 
				
			||||||
 | 
					    int m_maxTrials;
 | 
				
			||||||
 | 
					    int BLOCKS;
 | 
				
			||||||
 | 
					    int m_codeLen;
 | 
				
			||||||
 | 
					    int m_dataLen;
 | 
				
			||||||
 | 
					    void *m_aligned_buffer;
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
					    ldpctool::LDPCInterface *m_ldpc;
 | 
				
			||||||
 | 
					    ldpctool::code_type *m_code;
 | 
				
			||||||
 | 
					    ldpctool::simd_type *m_simd;
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
					    typedef ldpctool::NormalUpdate<ldpctool::simd_type> update_type;
 | 
				
			||||||
 | 
					    //typedef SelfCorrectedUpdate<simd_type> update_type;
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
					    //typedef MinSumAlgorithm<simd_type, update_type> algorithm_type;
 | 
				
			||||||
 | 
					    //typedef OffsetMinSumAlgorithm<simd_type, update_type, FACTOR> algorithm_type;
 | 
				
			||||||
 | 
					    typedef ldpctool::MinSumCAlgorithm<ldpctool::simd_type, update_type, ldpctool::FACTOR> algorithm_type;
 | 
				
			||||||
 | 
					    //typedef LogDomainSPA<simd_type, update_type> algorithm_type;
 | 
				
			||||||
 | 
					    //typedef LambdaMinAlgorithm<simd_type, update_type, 3> algorithm_type;
 | 
				
			||||||
 | 
					    //typedef SumProductAlgorithm<simd_type, update_type> algorithm_type;
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
					    ldpctool::LDPCDecoder<ldpctool::simd_type, algorithm_type> m_decode;
 | 
				
			||||||
 | 
					};
 | 
				
			||||||
		Loading…
	
	
			
			x
			
			
		
	
		Reference in New Issue
	
	Block a user