| 
									
										
										
										
											2015-08-03 01:04:20 +02:00
										 |  |  | ///////////////////////////////////////////////////////////////////////////////////
 | 
					
						
							|  |  |  | // Copyright (C) 2015 Edouard Griffiths, F4EXB                                   //
 | 
					
						
							|  |  |  | //                                                                               //
 | 
					
						
							|  |  |  | // 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                  //
 | 
					
						
							|  |  |  | //                                                                               //
 | 
					
						
							|  |  |  | // 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 <stdio.h>
 | 
					
						
							|  |  |  | #include <errno.h>
 | 
					
						
							| 
									
										
										
										
											2015-08-04 04:17:24 +02:00
										 |  |  | #include <assert.h>
 | 
					
						
							| 
									
										
										
										
											2015-08-03 01:04:20 +02:00
										 |  |  | #include "dsp/samplefifo.h"
 | 
					
						
							| 
									
										
										
										
											2015-08-09 10:33:04 +02:00
										 |  |  | #include <QDebug>
 | 
					
						
							| 
									
										
										
										
											2015-08-03 01:04:20 +02:00
										 |  |  | 
 | 
					
						
							|  |  |  | #include "filesourcethread.h"
 | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | const int FileSourceThread::m_rateDivider = 1000/FILESOURCE_THROTTLE_MS; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | FileSourceThread::FileSourceThread(std::ifstream *samplesStream, SampleFifo* sampleFifo, QObject* parent) : | 
					
						
							|  |  |  | 	QThread(parent), | 
					
						
							|  |  |  | 	m_running(false), | 
					
						
							|  |  |  | 	m_ifstream(samplesStream), | 
					
						
							|  |  |  | 	m_buf(0), | 
					
						
							|  |  |  | 	m_bufsize(0), | 
					
						
							|  |  |  | 	m_chunksize(0), | 
					
						
							|  |  |  | 	m_sampleFifo(sampleFifo), | 
					
						
							| 
									
										
										
										
											2015-08-06 01:14:44 +02:00
										 |  |  | 	m_samplesCount(0), | 
					
						
							| 
									
										
										
										
											2015-08-03 01:04:20 +02:00
										 |  |  | 	m_samplerate(0) | 
					
						
							|  |  |  | { | 
					
						
							| 
									
										
										
										
											2015-08-04 04:17:24 +02:00
										 |  |  |     assert(m_ifstream != 0); | 
					
						
							| 
									
										
										
										
											2015-08-03 01:04:20 +02:00
										 |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | FileSourceThread::~FileSourceThread() | 
					
						
							|  |  |  | { | 
					
						
							|  |  |  | 	if (m_running) { | 
					
						
							|  |  |  | 		stopWork(); | 
					
						
							|  |  |  | 	} | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	if (m_buf != 0) { | 
					
						
							|  |  |  | 		free(m_buf); | 
					
						
							|  |  |  | 	} | 
					
						
							|  |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | void FileSourceThread::startWork() | 
					
						
							|  |  |  | { | 
					
						
							| 
									
										
										
										
											2015-08-09 10:33:04 +02:00
										 |  |  | 	qDebug() << "FileSourceThread::startWork: "; | 
					
						
							| 
									
										
										
										
											2015-08-04 04:17:24 +02:00
										 |  |  |      | 
					
						
							|  |  |  |     if (m_ifstream->is_open()) | 
					
						
							|  |  |  |     { | 
					
						
							| 
									
										
										
										
											2015-08-09 10:33:04 +02:00
										 |  |  |         qDebug() << "  - file stream open, starting..."; | 
					
						
							| 
									
										
										
										
											2015-08-04 04:17:24 +02:00
										 |  |  |         m_startWaitMutex.lock(); | 
					
						
							|  |  |  |         start(); | 
					
						
							|  |  |  |         while(!m_running) | 
					
						
							|  |  |  |             m_startWaiter.wait(&m_startWaitMutex, 100); | 
					
						
							|  |  |  |         m_startWaitMutex.unlock(); | 
					
						
							|  |  |  |     } | 
					
						
							|  |  |  |     else | 
					
						
							|  |  |  |     { | 
					
						
							| 
									
										
										
										
											2015-08-09 10:33:04 +02:00
										 |  |  |         qDebug() << "  - file stream closed, not starting."; | 
					
						
							| 
									
										
										
										
											2015-08-04 04:17:24 +02:00
										 |  |  |     } | 
					
						
							| 
									
										
										
										
											2015-08-03 01:04:20 +02:00
										 |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | void FileSourceThread::stopWork() | 
					
						
							|  |  |  | { | 
					
						
							| 
									
										
										
										
											2015-08-09 10:33:04 +02:00
										 |  |  | 	qDebug() << "FileSourceThread::stopWork"; | 
					
						
							| 
									
										
										
										
											2015-08-03 01:04:20 +02:00
										 |  |  | 	m_running = false; | 
					
						
							|  |  |  | 	wait(); | 
					
						
							|  |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | void FileSourceThread::setSamplerate(int samplerate) | 
					
						
							|  |  |  | { | 
					
						
							| 
									
										
										
										
											2015-08-09 10:33:04 +02:00
										 |  |  | 	qDebug() << "FileSourceThread::setSamplerate:" | 
					
						
							| 
									
										
										
										
											2015-08-04 04:17:24 +02:00
										 |  |  | 			<< " new:" << samplerate | 
					
						
							|  |  |  | 			<< " old:" << m_samplerate; | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2015-08-03 01:04:20 +02:00
										 |  |  | 	if (samplerate != m_samplerate) | 
					
						
							|  |  |  | 	{ | 
					
						
							|  |  |  | 		if (m_running) { | 
					
						
							|  |  |  | 			stopWork(); | 
					
						
							|  |  |  | 		} | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2015-08-04 04:17:24 +02:00
										 |  |  | 		m_samplerate = samplerate; | 
					
						
							| 
									
										
										
										
											2015-08-06 00:10:23 +02:00
										 |  |  | 		m_chunksize = (m_samplerate / m_rateDivider)*4; // TODO: implement FF and slow motion here. 4 corresponds to live. 2 is half speed, 8 is doulbe speed
 | 
					
						
							|  |  |  | 		m_bufsize = m_chunksize; | 
					
						
							| 
									
										
										
										
											2015-08-03 01:04:20 +02:00
										 |  |  | 
 | 
					
						
							|  |  |  | 		if (m_buf == 0)	{ | 
					
						
							| 
									
										
										
										
											2015-08-09 10:33:04 +02:00
										 |  |  | 			qDebug() << "  - Allocate buffer"; | 
					
						
							| 
									
										
										
										
											2015-08-03 01:04:20 +02:00
										 |  |  | 			m_buf = (quint8*) malloc(m_bufsize); | 
					
						
							|  |  |  | 		} else { | 
					
						
							| 
									
										
										
										
											2015-08-09 10:33:04 +02:00
										 |  |  | 			qDebug() << "  - Re-allocate buffer"; | 
					
						
							| 
									
										
										
										
											2015-08-03 01:04:20 +02:00
										 |  |  | 			m_buf = (quint8*) realloc((void*) m_buf, m_bufsize); | 
					
						
							|  |  |  | 		} | 
					
						
							| 
									
										
										
										
											2015-08-04 04:17:24 +02:00
										 |  |  | 
 | 
					
						
							| 
									
										
										
										
											2015-08-09 10:33:04 +02:00
										 |  |  | 		qDebug() << "  - size: " << m_bufsize | 
					
						
							|  |  |  | 				<< " #samples: " << (m_bufsize/4); | 
					
						
							| 
									
										
										
										
											2015-08-03 01:04:20 +02:00
										 |  |  | 	} | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2015-08-06 00:10:23 +02:00
										 |  |  | 	//m_samplerate = samplerate;
 | 
					
						
							| 
									
										
										
										
											2015-08-03 01:04:20 +02:00
										 |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | void FileSourceThread::run() | 
					
						
							|  |  |  | { | 
					
						
							|  |  |  | 	int res; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	m_running = true; | 
					
						
							|  |  |  | 	m_startWaiter.wakeAll(); | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2015-08-04 04:17:24 +02:00
										 |  |  | 	while(m_running) // actual work is in the tick() function
 | 
					
						
							| 
									
										
										
										
											2015-08-03 01:04:20 +02:00
										 |  |  | 	{ | 
					
						
							|  |  |  | 		sleep(1); | 
					
						
							|  |  |  | 	} | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	m_running = false; | 
					
						
							|  |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | void FileSourceThread::connectTimer(const QTimer& timer) | 
					
						
							|  |  |  | { | 
					
						
							| 
									
										
										
										
											2015-08-09 10:33:04 +02:00
										 |  |  | 	qDebug() << "FileSourceThread::connectTimer"; | 
					
						
							| 
									
										
										
										
											2015-08-03 01:04:20 +02:00
										 |  |  | 	connect(&timer, SIGNAL(timeout()), this, SLOT(tick())); | 
					
						
							|  |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | void FileSourceThread::tick() | 
					
						
							|  |  |  | { | 
					
						
							|  |  |  | 	if (m_running) | 
					
						
							|  |  |  | 	{ | 
					
						
							|  |  |  | 		// read samples directly feeding the SampleFifo (no callback)
 | 
					
						
							|  |  |  | 		m_ifstream->read(reinterpret_cast<char*>(m_buf), m_chunksize); | 
					
						
							| 
									
										
										
										
											2015-08-04 04:17:24 +02:00
										 |  |  |          | 
					
						
							|  |  |  |         if (m_ifstream->eof()) | 
					
						
							|  |  |  |         { | 
					
						
							|  |  |  |             m_sampleFifo->write(m_buf, m_ifstream->gcount()); | 
					
						
							|  |  |  |             // TODO: handle loop playback situation
 | 
					
						
							| 
									
										
										
										
											2015-08-05 09:26:00 +02:00
										 |  |  |     		m_ifstream->clear(); | 
					
						
							|  |  |  |     		m_ifstream->seekg(0, std::ios::beg); | 
					
						
							| 
									
										
										
										
											2015-08-06 01:14:44 +02:00
										 |  |  |     		m_samplesCount = 0; | 
					
						
							| 
									
										
										
										
											2015-08-05 09:26:00 +02:00
										 |  |  |             //stopWork();
 | 
					
						
							| 
									
										
										
										
											2015-08-05 03:25:06 +02:00
										 |  |  |             //m_ifstream->close();
 | 
					
						
							| 
									
										
										
										
											2015-08-04 04:17:24 +02:00
										 |  |  |         } | 
					
						
							|  |  |  |         else | 
					
						
							|  |  |  |         { | 
					
						
							|  |  |  |             m_sampleFifo->write(m_buf, m_chunksize); | 
					
						
							| 
									
										
										
										
											2015-08-06 01:14:44 +02:00
										 |  |  |     		m_samplesCount += m_chunksize / 4; | 
					
						
							| 
									
										
										
										
											2015-08-04 04:17:24 +02:00
										 |  |  |         } | 
					
						
							| 
									
										
										
										
											2015-08-03 01:04:20 +02:00
										 |  |  | 	} | 
					
						
							|  |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | /*
 | 
					
						
							|  |  |  | void FileSourceThread::decimate1(SampleVector::iterator* it, const qint16* buf, qint32 len) | 
					
						
							|  |  |  | { | 
					
						
							|  |  |  | 	qint16 xreal, yimag; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	for (int pos = 0; pos < len; pos += 2) { | 
					
						
							|  |  |  | 		xreal = buf[pos+0]; | 
					
						
							|  |  |  | 		yimag = buf[pos+1]; | 
					
						
							|  |  |  | 		Sample s( xreal * 16, yimag * 16 ); // shift by 4 bit positions (signed)
 | 
					
						
							|  |  |  | 		**it = s; | 
					
						
							|  |  |  | 		(*it)++; | 
					
						
							|  |  |  | 	} | 
					
						
							|  |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | //  Decimate according to specified log2 (ex: log2=4 => decim=16)
 | 
					
						
							|  |  |  | void FileSourceThread::callback(const qint16* buf, qint32 len) | 
					
						
							|  |  |  | { | 
					
						
							|  |  |  | 	SampleVector::iterator it = m_convertBuffer.begin(); | 
					
						
							|  |  |  | 	decimate1(&it, buf, len); | 
					
						
							|  |  |  | 	m_sampleFifo->write(m_convertBuffer.begin(), it); | 
					
						
							|  |  |  | } | 
					
						
							|  |  |  | */ |