#include "thread_pool.h"

/*

Copyright (c) 2020 Péter Magyar

Permission is hereby granted, free of charge, to any person obtaining a copy
of this software and associated documentation files (the "Software"), to deal
in the Software without restriction, including without limitation the rights
to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
copies of the Software, and to permit persons to whom the Software is
furnished to do so, subject to the following conditions:

The above copyright notice and this permission notice shall be included in all
copies or substantial portions of the Software.

THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE
AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE
SOFTWARE.

*/

#include "core/version.h"

#if VERSION_MAJOR > 3
#include "core/config/engine.h"
#include "core/config/project_settings.h"
#else
#include "core/engine.h"
#include "core/project_settings.h"
#endif

#include "core/os/os.h"
#include "scene/main/scene_tree.h"

#include "core/version.h"

#if VERSION_MAJOR >= 4
#define CONNECT(sig, obj, target_method_class, method) connect(sig, callable_mp(obj, &target_method_class::method))
#define DISCONNECT(sig, obj, target_method_class, method) disconnect(sig, callable_mp(obj, &target_method_class::method))

#define REAL FLOAT
#else
#define CONNECT(sig, obj, target_method_class, method) connect(sig, obj, #method)
#define DISCONNECT(sig, obj, target_method_class, method) disconnect(sig, obj, #method)
#endif

ThreadPool *ThreadPool::_instance;

ThreadPool *ThreadPool::get_singleton() {
	return _instance;
}

bool ThreadPool::get_use_threads() const {
	return _use_threads;
}
void ThreadPool::set_use_threads(const bool value) {
	_use_threads = value;
}

int ThreadPool::get_thread_count() const {
	return _thread_count;
}
void ThreadPool::set_thread_count(const bool value) {
	_thread_count = value;
}

int ThreadPool::get_thread_fallback_count() const {
	return _thread_fallback_count;
}
void ThreadPool::set_thread_fallback_count(const bool value) {
	_thread_fallback_count = value;
}

float ThreadPool::get_max_work_per_frame_percent() const {
	return _max_work_per_frame_percent;
}
void ThreadPool::set_max_work_per_frame_percent(const bool value) {
	_max_work_per_frame_percent = value;
}

float ThreadPool::get_max_time_per_frame() const {
	return _max_time_per_frame;
}
void ThreadPool::set_max_time_per_frame(const bool value) {
	_max_time_per_frame = value;
}

void ThreadPool::cancel_task_wait(Ref<ThreadPoolJob> job) {
	ERR_FAIL_COND(!job.is_valid());

	_THREAD_SAFE_LOCK_

	for (int i = 0; i < _queue.size(); ++i) {
		Ref<ThreadPoolJob> j = _queue[i];

		if (j == job) {
			_queue.write[i].unref();
			_THREAD_SAFE_UNLOCK_
			return;
		}
	}

	_THREAD_SAFE_UNLOCK_

	for (int i = 0; i < _threads.size(); ++i) {
		Ref<ThreadPoolJob> j = _threads[i]->job;

		if (j == job) {
			job->set_cancelled(true);

			while (_threads[i]->job == job) {
				OS::get_singleton()->delay_usec(1000);
			}

			return;
		}
	}
}
void ThreadPool::cancel_task(Ref<ThreadPoolJob> job) {
	ERR_FAIL_COND(!job.is_valid());

	_THREAD_SAFE_LOCK_

	for (int i = 0; i < _queue.size(); ++i) {
		Ref<ThreadPoolJob> j = _queue[i];

		if (j == job) {
			_queue.write[i].unref();
			_THREAD_SAFE_UNLOCK_
			return;
		}
	}

	_THREAD_SAFE_UNLOCK_

	for (int i = 0; i < _threads.size(); ++i) {
		Ref<ThreadPoolJob> j = _threads[i]->job;

		if (j == job) {
			job->set_cancelled(true);
			return;
		}
	}
}

Ref<ThreadPoolJob> ThreadPool::get_running_job(const Variant &object, const StringName &method) {
	if (!_use_threads)
		return _queue[_current_queue_head];

	for (int i = 0; i < _threads.size(); ++i) {
		Ref<ThreadPoolJob> j = _threads[i]->job;

		if (!j.is_valid())
			continue;

		if (j->get_object() == object && j->get_method() == method) {
			return j;
		}
	}

	ERR_FAIL_V(Ref<ThreadPoolJob>());
}

Ref<ThreadPoolJob> ThreadPool::get_queued_job(const Variant &object, const StringName &method) {
	for (int i = 0; i < _queue.size(); ++i) {
		Ref<ThreadPoolJob> j = _queue[i];

		ERR_CONTINUE(!j.is_valid());

		if (j->get_object() == object && j->get_method() == method) {
			return j;
		}
	}

	return Ref<ThreadPoolJob>();
}

void ThreadPool::add_job(const Ref<ThreadPoolJob> &job) {
	_THREAD_SAFE_LOCK_

	if (_use_threads) {
		for (int i = 0; i < _threads.size(); ++i) {
			ThreadPoolContext *context = _threads.get(i);

			if (!context->job.is_valid()) {
				context->job = job;
				context->semaphore->post();
				_THREAD_SAFE_UNLOCK_
				return;
			}
		}
	}

	if (_current_queue_tail == _queue.size()) {
		if (_current_queue_head == 0) {
			_queue.resize(_queue.size() + _queue_grow_size);
		} else {
			int j = 0;

			for (int i = _current_queue_head; i < _current_queue_tail; ++i) {
				_queue.write[j++] = _queue[i];
			}

			_current_queue_head = 0;
			_current_queue_tail = j;
		}
	}

	_queue.write[_current_queue_tail++] = job;

	_THREAD_SAFE_UNLOCK_
}

Ref<ThreadPoolExecuteJob> ThreadPool::create_execute_job_simple(const Variant &obj, const StringName &p_method) {
	Ref<ThreadPoolExecuteJob> job;
	job.instance();

	job->setup(obj, p_method);

	ERR_FAIL_COND_V(job->get_complete(), job);

	add_job(job);

	return job;
}

Ref<ThreadPoolExecuteJob> ThreadPool::create_execute_job(const Variant &obj, const StringName &p_method, VARIANT_ARG_DECLARE) {
	Ref<ThreadPoolExecuteJob> job;
	job.instance();

	job->setup(obj, p_method, p_arg1, p_arg2, p_arg3, p_arg4, p_arg5);

	ERR_FAIL_COND_V(job->get_complete(), job);

	add_job(job);

	return job;
}

#if VERSION_MAJOR < 4
Variant ThreadPool::_create_job_bind(const Variant **p_args, int p_argcount, Variant::CallError &r_error) {
#else
Variant ThreadPool::_create_job_bind(const Variant **p_args, int p_argcount, Callable::CallError &r_error) {
#endif
	if (p_argcount < 2) {
#if VERSION_MAJOR < 4
		r_error.error = Variant::CallError::CALL_ERROR_TOO_FEW_ARGUMENTS;
#else
		r_error.error = Callable::CallError::CALL_ERROR_TOO_FEW_ARGUMENTS;
#endif

		r_error.argument = 1;
		return Variant();
	}

	if (p_args[0]->get_type() != Variant::OBJECT) {
#if VERSION_MAJOR < 4
		r_error.error = Variant::CallError::CALL_ERROR_INVALID_ARGUMENT;
#else
		r_error.error = Callable::CallError::CALL_ERROR_INVALID_ARGUMENT;
#endif

		r_error.argument = 0;
		r_error.expected = Variant::OBJECT;
		return Variant();
	}

	if (p_args[1]->get_type() != Variant::STRING) {
#if VERSION_MAJOR < 4
		r_error.error = Variant::CallError::CALL_ERROR_INVALID_ARGUMENT;
#else
		r_error.error = Callable::CallError::CALL_ERROR_INVALID_ARGUMENT;
#endif

		r_error.argument = 1;
		r_error.expected = Variant::STRING;
		return Variant();
	}

	Ref<ThreadPoolExecuteJob> job;
	job.instance();

	job->_setup_bind(p_args, p_argcount, r_error);

	ERR_FAIL_COND_V(job->get_complete(), job);

	add_job(job);

	return job;
}

void ThreadPool::_thread_finished(ThreadPoolContext *context) {
	_THREAD_SAFE_LOCK_

	context->job.unref();

	if (_current_queue_head != _current_queue_tail) {
		context->job = _queue.get(_current_queue_head);
		context->semaphore->post();
		_queue.write[_current_queue_head].unref();

		++_current_queue_head;
	}

	_THREAD_SAFE_UNLOCK_
}

void ThreadPool::_worker_thread_func(void *user_data) {
	ThreadPoolContext *context = reinterpret_cast<ThreadPoolContext *>(user_data);

	while (context->running) {
		context->semaphore->wait();

		if (!context->job.is_valid())
			continue;

		context->job->execute();

		ThreadPool::get_singleton()->_thread_finished(context);
	}
}

void ThreadPool::register_update() {
	SceneTree::get_singleton()->CONNECT("idle_frame", this, ThreadPool, update);
}

void ThreadPool::update() {
	if (_current_queue_head == _current_queue_tail)
		return;

	float remaining_time = _max_time_per_frame;

	while (remaining_time > 0 && _current_queue_head != _current_queue_tail) {
		Ref<ThreadPoolJob> job = _queue.get(_current_queue_head);

		if (!job.is_valid()) {
			++_current_queue_head;
			continue;
		}

		job->set_max_allocated_time(remaining_time);
		job->execute();

		remaining_time -= job->get_current_execution_time();

		if (job->get_complete()) {
			_queue.write[_current_queue_head++].unref();
		}
	}
}

ThreadPool::ThreadPool() {
	_instance = this;

	_current_queue_head = 0;
	_current_queue_tail = 0;

	_use_threads = GLOBAL_DEF("thread_pool/use_threads", true);
	_thread_count = GLOBAL_DEF("thread_pool/thread_count", -1);
	_thread_fallback_count = GLOBAL_DEF("thread_pool/thread_fallback_count", 4);

	if (_thread_fallback_count <= 0) {
		print_error("ThreadPool: thread_fallback_count is invalid! Check ProjectSettings/ThreadPool/thread_fallback_count! Needs to be > 0! Set to 1!");

		_thread_fallback_count = 1;
	}

	//Todo Add help text, as this will only come into play if threading is disabled, or not available
	_max_work_per_frame_percent = GLOBAL_DEF("thread_pool/max_work_per_frame_percent", 25);

	_queue_start_size = GLOBAL_DEF("thread_pool/queue_start_size", 20);
	_queue_grow_size = GLOBAL_DEF("thread_pool/queue_grow_size", 10);
	_queue.resize(_queue_start_size);

	//Todo this should be recalculated constantly to smooth out performance better
	_max_time_per_frame = (1 / 60.0) * (_max_work_per_frame_percent / 100.0);

	if (!OS::get_singleton()->can_use_threads()) {
		_use_threads = false;
	}

	if (_use_threads) {
		if (_thread_count <= 0) {
			_thread_count = OS::get_singleton()->get_processor_count() + _thread_count;
		}

		//a.k.a OS::get_singleton()->get_processor_count() is not implemented, or returns something unexpected, or too high negative number
		if (_thread_count <= 0) {
			_thread_count = _thread_fallback_count;
		}

		_threads.resize(_thread_count);

		for (int i = 0; i < _threads.size(); ++i) {
			ThreadPoolContext *context = memnew(ThreadPoolContext);

			context->running = true;
			context->semaphore = memnew(Semaphore);

			context->thread = memnew(Thread());
			context->thread->start(ThreadPool::_worker_thread_func, context);

			_threads.write[i] = context;
		}
	} else {
		call_deferred("register_update");
	}
}

ThreadPool::~ThreadPool() {
	for (int i = 0; i < _threads.size(); ++i) {
		ThreadPoolContext *context = _threads.get(i);

		context->running = false;
		context->semaphore->post();
	}

	for (int i = 0; i < _threads.size(); ++i) {
		ThreadPoolContext *context = _threads.get(i);

		context->thread->wait_to_finish();

		memdelete(context->thread);
		memdelete(context->semaphore);
		context->job.unref();
		memdelete(context);
	}

	_threads.clear();

	_queue.clear();
	//_job_pool.clear();
}

void ThreadPool::_bind_methods() {
	ClassDB::bind_method(D_METHOD("get_use_threads"), &ThreadPool::get_use_threads);
	ClassDB::bind_method(D_METHOD("set_use_threads", "value"), &ThreadPool::set_use_threads);
	ADD_PROPERTY(PropertyInfo(Variant::BOOL, "use_threads"), "set_use_threads", "get_use_threads");

	ClassDB::bind_method(D_METHOD("get_thread_count"), &ThreadPool::get_thread_count);
	ClassDB::bind_method(D_METHOD("set_thread_count", "value"), &ThreadPool::set_thread_count);
	ADD_PROPERTY(PropertyInfo(Variant::INT, "thread_count"), "set_thread_count", "get_thread_count");

	ClassDB::bind_method(D_METHOD("get_thread_fallback_count"), &ThreadPool::get_thread_fallback_count);
	ClassDB::bind_method(D_METHOD("set_thread_fallback_count", "value"), &ThreadPool::set_thread_fallback_count);
	ADD_PROPERTY(PropertyInfo(Variant::INT, "thread_fallback_count"), "set_thread_fallback_count", "get_thread_fallback_count");

	ClassDB::bind_method(D_METHOD("get_max_work_per_frame_percent"), &ThreadPool::get_max_work_per_frame_percent);
	ClassDB::bind_method(D_METHOD("set_max_work_per_frame_percent", "value"), &ThreadPool::set_max_work_per_frame_percent);
	ADD_PROPERTY(PropertyInfo(Variant::REAL, "max_work_per_frame_percent"), "set_max_work_per_frame_percent", "get_max_work_per_frame_percent");

	ClassDB::bind_method(D_METHOD("get_max_time_per_frame"), &ThreadPool::get_max_time_per_frame);
	ClassDB::bind_method(D_METHOD("set_max_time_per_frame", "value"), &ThreadPool::set_max_time_per_frame);
	ADD_PROPERTY(PropertyInfo(Variant::REAL, "max_time_per_frame"), "set_max_time_per_frame", "get_max_time_per_frame");

	ClassDB::bind_method(D_METHOD("create_execute_job_simple", "object", "method"), &ThreadPool::create_execute_job_simple);

	MethodInfo mi;
	mi.arguments.push_back(PropertyInfo(Variant::OBJECT, "obj"));
	mi.arguments.push_back(PropertyInfo(Variant::STRING, "method"));

	mi.name = "create_job";
	ClassDB::bind_vararg_method(METHOD_FLAGS_DEFAULT, "create_execute_job", &ThreadPool::_create_job_bind, mi);

	ClassDB::bind_method(D_METHOD("get_running_job", "object", "method"), &ThreadPool::get_running_job);
	ClassDB::bind_method(D_METHOD("get_queued_job", "object", "method"), &ThreadPool::get_queued_job);

	ClassDB::bind_method(D_METHOD("add_job", "job"), &ThreadPool::add_job);

	ClassDB::bind_method(D_METHOD("register_update"), &ThreadPool::register_update);
	ClassDB::bind_method(D_METHOD("update"), &ThreadPool::update);

	ClassDB::bind_method(D_METHOD("cancel_task_wait", "job"), &ThreadPool::cancel_task_wait);
	ClassDB::bind_method(D_METHOD("cancel_task", "job"), &ThreadPool::cancel_task);
}