/* Copyright (C) 2018-2019 Thomas Jespersen, TKJ Electronics. All rights reserved.
 *
 * This program is free software: you can redistribute it and/or modify it
 * under the terms of the MIT License
 *
 * 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 MIT License for further details.
 *
 * Contact information
 * ------------------------------------------
 * Thomas Jespersen, TKJ Electronics
 * Web      :  http://www.tkjelectronics.dk
 * e-mail   :  thomasj@tkjelectronics.dk
 * ------------------------------------------
 */
 
#include "ApplicationTemplate.h"
#include "cmsis_os.h"

ApplicationTemplate::ApplicationTemplate() : _TaskHandle(0), _isRunning(false), _shouldStop(false)
{
	_params = new Parameters;

	Start();
}

ApplicationTemplate::~ApplicationTemplate()
{
	_shouldStop = true;
	while (_isRunning) osDelay(10);
}

int ApplicationTemplate::Start()
{
	if (_isRunning) return 0; // task already running
	_shouldStop = false;
	return xTaskCreate( ApplicationTemplate::Thread, (char *)"Application Template", THREAD_STACK_SIZE, (void*) this, THREAD_PRIORITY, &_TaskHandle);
}

int ApplicationTemplate::Stop(uint32_t timeout)
{
	if (!_isRunning) return 0; // task not running

	_shouldStop = true;

	uint32_t timeout_millis = timeout;
	while (_isRunning && timeout_millis > 0) {
		osDelay(1);
		timeout_millis--;
	}
	if (_isRunning) return -1; // timeout trying to stop task

	return 1;
}

int ApplicationTemplate::Restart(uint32_t timeout)
{
	if (!_isRunning) return 0; // task not running
	int errCode = Stop(timeout);
	if (errCode != 1) return errCode;
	return Start();
}

void ApplicationTemplate::Thread(void * pvParameters)
{
	ApplicationTemplate * task = (ApplicationTemplate *)pvParameters;
	task->_isRunning = true;

	while (!task->_shouldStop) {
		/* THIS IS THE MAIN LOOP */
		osDelay(1000);
	}

	task->_isRunning = false;
	task->_TaskHandle = 0;
	vTaskDelete(NULL); // delete/stop this current task
}