CubicSDR/src/demod/DemodulatorInstance.cpp

#include "DemodulatorInstance.h"

DemodulatorInstance::DemodulatorInstance() :
		t_Demod(NULL), t_PreDemod(NULL), t_Audio(NULL), threadQueueDemod(NULL), demodulatorThread(NULL), terminated(false), audioTerminated(false), demodTerminated(
				false), preDemodTerminated(false) {

	label = new std::string("Unnamed");
	threadQueueDemod = new DemodulatorThreadInputQueue;
	threadQueuePostDemod = new DemodulatorThreadPostInputQueue;
	threadQueueCommand = new DemodulatorThreadCommandQueue;
	threadQueueNotify = new DemodulatorThreadCommandQueue;

	demodulatorPreThread = new DemodulatorPreThread(threadQueueDemod, threadQueuePostDemod, threadQueueNotify);
	demodulatorPreThread->setCommandQueue(threadQueueCommand);
	demodulatorThread = new DemodulatorThread(threadQueuePostDemod, threadQueueNotify);

	audioInputQueue = new AudioThreadInputQueue;
	audioThread = new AudioThread(audioInputQueue, threadQueueNotify);

	demodulatorThread->setAudioInputQueue(audioInputQueue);
}

DemodulatorInstance::~DemodulatorInstance() {
	delete audioThread;
	delete demodulatorThread;

	delete audioInputQueue;
	delete threadQueueDemod;
}

void DemodulatorInstance::setVisualOutputQueue(DemodulatorThreadOutputQueue *tQueue) {
	demodulatorThread->setVisualOutputQueue(tQueue);
}

void DemodulatorInstance::run() {
	t_Audio = new std::thread(&AudioThread::threadMain, audioThread);

#ifdef __APPLE__    // Already using pthreads, might as well do some custom init..
	pthread_attr_t attr;
	size_t size;

	pthread_attr_init(&attr);
	pthread_attr_setstacksize(&attr, 2048000);
	pthread_attr_getstacksize(&attr, &size);
    pthread_attr_setschedpolicy(&attr, SCHED_RR);
	pthread_create(&t_PreDemod, &attr, &DemodulatorPreThread::pthread_helper, demodulatorPreThread);
	pthread_attr_destroy(&attr);

	pthread_attr_init(&attr);
	pthread_attr_setstacksize(&attr, 2048000);
	pthread_attr_getstacksize(&attr, &size);
    pthread_attr_setschedpolicy(&attr, SCHED_RR);
	pthread_create(&t_Demod, &attr, &DemodulatorThread::pthread_helper, demodulatorThread);
	pthread_attr_destroy(&attr);

	std::cout << "Initialized demodulator stack size of " << size << std::endl;

#else
	t_PreDemod = new std::thread(&DemodulatorPreThread::threadMain, demodulatorPreThread);
	t_Demod = new std::thread(&DemodulatorThread::threadMain, demodulatorThread);
#endif
}

void DemodulatorInstance::updateLabel(int freq) {
	std::stringstream newLabel;
	newLabel.precision(3);
	newLabel << std::fixed << ((float) freq / 1000000.0);
	setLabel(newLabel.str());
}

DemodulatorThreadCommandQueue *DemodulatorInstance::getCommandQueue() {
	return threadQueueCommand;
}

DemodulatorThreadParameters &DemodulatorInstance::getParams() {
	return demodulatorPreThread->getParams();
}

void DemodulatorInstance::terminate() {
	std::cout << "Terminating demodulator preprocessor thread.." << std::endl;
	demodulatorPreThread->terminate();
	std::cout << "Terminating demodulator thread.." << std::endl;
	demodulatorThread->terminate();
	std::cout << "Terminating demodulator audio thread.." << std::endl;
	audioThread->terminate();
}

std::string DemodulatorInstance::getLabel() {
	return *(label.load());
}

void DemodulatorInstance::setLabel(std::string labelStr) {
	std::string *newLabel = new std::string;
	newLabel->append(labelStr);
	std::string *oldLabel;
	oldLabel = label;
	label = newLabel;
	delete oldLabel;
}

bool DemodulatorInstance::isTerminated() {
	while (!threadQueueNotify->empty()) {
		DemodulatorThreadCommand cmd;
		threadQueueNotify->pop(cmd);

		switch (cmd.cmd) {
		case DemodulatorThreadCommand::DEMOD_THREAD_CMD_AUDIO_TERMINATED:
			audioThread = NULL;
			t_Audio->join();
			audioTerminated = true;
			break;
		case DemodulatorThreadCommand::DEMOD_THREAD_CMD_DEMOD_TERMINATED:
			demodulatorThread = NULL;
#ifdef __APPLE__
			pthread_join(t_Demod, NULL);
#else
			t_Demod->join();
#endif
			demodTerminated = true;
			break;
		case DemodulatorThreadCommand::DEMOD_THREAD_CMD_DEMOD_PREPROCESS_TERMINATED:
			demodulatorPreThread = NULL;
#ifdef __APPLE__
			pthread_join(t_PreDemod, NULL);
#else
			t_PreDemod->join();
#endif
			preDemodTerminated = true;
			break;
		default:
			break;
		}
	}

	terminated = audioTerminated && demodTerminated && preDemodTerminated;

	return terminated;
}