#ifndef TEST_TOOLS
#define TEST_TOOLS

#include "../DFPSR/includeEssentials.h"
#include "../DFPSR/api/algorithmAPI.h"
#include "../DFPSR/math/FVector.h"
#include <cstdlib>
#include <csignal>
#include <stdio.h>

using namespace dsr;

static bool beginsWith(const ReadableString &message, const ReadableString &prefix) {
	// Reading a character out of bound safely returns \0 by value, so we can rely
	// on the null character to exit early if message is storter than prefix.
	for (int c = 0; c < string_length(prefix); c++) {
		if (message[c] != prefix[c]) {
			return false;
		}
	}
	return true;
}

static thread_local String ExpectedErrorPrefix;

#define OP_EQUALS(A, B) ((A) == (B))
#define OP_NOT_EQUALS(A, B) ((A) != (B))
#define OP_LESSER(A, B) ((A) < (B))
#define OP_LESSER_OR_EQUAL(A, B) ((A) <= (B))
#define OP_GREATER(A, B) ((A) > (B))
#define OP_GREATER_OR_EQUAL(A, B) ((A) >= (B))
inline bool OP_NEAR(float a, float b) {
	return a > b - 0.0001f && a < b + 0.0001f;
}
inline bool OP_NEAR(double a, double b) {
	return a > b - 0.0000001 && a < b + 0.0000001;
}
inline bool OP_NEAR(const FVector2D& a, const FVector2D& b) {
	return OP_NEAR(a.x, b.x) && OP_NEAR(a.y, b.y);
}
inline bool OP_NEAR(const FVector3D& a, const FVector3D& b) {
	return OP_NEAR(a.x, b.x) && OP_NEAR(a.y, b.y) && OP_NEAR(a.z, b.z);
}
inline bool OP_NEAR(const FVector4D& a, const FVector4D& b) {
	return OP_NEAR(a.x, b.x) && OP_NEAR(a.y, b.y) && OP_NEAR(a.z, b.z) && OP_NEAR(a.w, b.w);
}

static void messageHandler(const ReadableString &message, MessageType type) {
	if (type == MessageType::Error) {
		if (string_length(ExpectedErrorPrefix) == 0) {
			// Unexpected error!
			string_sendMessage_default(message, MessageType::Error);
		} else {
			// Expected error.
			if (!beginsWith(message, ExpectedErrorPrefix)) {
				string_sendMessage_default(string_combine(U"Unexpected message in error!\n\nMessage:\n", message, U"\n\nExpected prefix:\n", ExpectedErrorPrefix, U"\n\n"), MessageType::Error);
			} else {
				string_sendMessage_default(U"*", MessageType::StandardPrinting);
			}
		}
	} else {
		// Forward everything to the default message handler.
		string_sendMessage_default(message, type);
	}
}

static void handleArguments(const List<String> &args) {
	for (int i = 1; i < args.length(); i++) {
		String key = string_upperCase(args[i]);
		String value;
		if (i + 1 < args.length()) {
			value = args[i + 1];
		}
		if (string_match(key, U"-P") || string_match(key, U"--PATH")) {
			file_setCurrentPath(value);
		}
	}
}

static thread_local String testName = U"Uninitialized test\n";
static thread_local String stateName = U"New thread\n";
static bool failed = false;

#define START_TEST(NAME) \
DSR_MAIN_CALLER(dsrMain) \
void dsrMain(List<String> args) \
	{ \
		testName = #NAME; \
		stateName = U"While Assigning message handler"; \
		std::signal(SIGSEGV, [](int signal) { failed = true; throwError(U"Segmentation fault from ", testName, U"! ", stateName); }); \
		string_assignMessageHandler(&messageHandler); \
		stateName = U"While handling arguments\n"; \
		handleArguments(args); \
		stateName = U"Test start\n"; \
		printText(U"Running test \"", #NAME, "\":\n "); \
		intptr_t startAllocationCount = heap_getAllocationCount(); \
		heap_forAllHeapAllocations([](AllocationHeader * header, void * allocation) { \
			heap_setAllocationCustomFlags(header, 1u); \
		}); \
		{

#define END_TEST \
		} \
		printText(U" (done)\n"); \
		stateName = U"After test end\n"; \
		if (failed) { \
			heap_terminatingApplication(); \
			exit(1); \
		} \
	}

// These can be used instead of ASSERT_CRASH to handle multiple template arguments that are not enclosed within ().
#define BEGIN_CRASH(PREFIX) \
	ExpectedErrorPrefix = PREFIX; \
	stateName = string_combine(U"During expected crash starting with ", PREFIX, U"\n");
#define END_CRASH \
	ExpectedErrorPrefix = "";

// Prefix is the expected start of the error message.
//   Just enough to know that we triggered the right error message.
#define ASSERT_CRASH(A, PREFIX) \
	BEGIN_CRASH(PREFIX); \
	(void)(A); \
	END_CRASH \
	stateName = string_combine(U"After expected crash starting with ", PREFIX, U"\n");

#define ASSERT(CONDITION) \
{ \
	stateName = string_combine(U"While evaluating condition ", #CONDITION, U"\n"); \
	if (CONDITION) { \
		printText(U"*"); \
	} else { \
		printText( \
			U"\n\n", \
			U"_______________________________ FAIL _______________________________\n", \
			U"\n", \
			U"Failed assertion!\nCondition: ", #CONDITION, U"\n", \
			U"____________________________________________________________________\n" \
		); \
		failed = true; \
	} \
}

#define ASSERT_COMP(A, B, OP, OP_NAME) \
{ \
	stateName = string_combine(U"While evaluating condition ", #A, " ", OP_NAME, U" ", #B, U"\n"); \
	auto lhs = A; \
	auto rhs = B; \
	if (OP(lhs, rhs)) { \
		printText(U"*"); \
	} else { \
		printText( \
			U"\n\n", \
			U"_______________________________ FAIL _______________________________\n", \
			U"\n", \
			U"Condition: ", #A, " ", OP_NAME, U" ", #B, U"\n", \
			lhs, " ", OP_NAME, " ", rhs, U" is false.\n", \
			U"____________________________________________________________________\n" \
		); \
		failed = true; \
	} \
}
#define ASSERT_EQUAL(A, B) ASSERT_COMP(A, B, OP_EQUALS, "==")
#define ASSERT_NOT_EQUAL(A, B) ASSERT_COMP(A, B, OP_NOT_EQUALS, "!=")
#define ASSERT_LESSER(A, B) ASSERT_COMP(A, B, OP_LESSER, "<")
#define ASSERT_LESSER_OR_EQUAL(A, B) ASSERT_COMP(A, B, OP_LESSER_OR_EQUAL, "<=")
#define ASSERT_GREATER(A, B) ASSERT_COMP(A, B, OP_GREATER, ">")
#define ASSERT_GREATER_OR_EQUAL(A, B) ASSERT_COMP(A, B, OP_GREATER_OR_EQUAL, ">=")
#define ASSERT_NEAR(A, B) ASSERT_COMP(A, B, OP_NEAR, "==")

#define ASSERT_HEAP_DEPTH(DEPTH) { \
	intptr_t currentAllocationCount = heap_getAllocationCount(); \
	intptr_t expectedAllocationCount = startAllocationCount + (DEPTH); \
	if (currentAllocationCount != expectedAllocationCount) { \
		printf( \
			"\n\n" \
			"_______________________________ FAIL _______________________________\n" \
			"\n" \
			"Expected allocation count %i but found %i allocations instead.\n" \
			"____________________________________________________________________\n" \
		, (int)expectedAllocationCount, (int)currentAllocationCount); \
		failed = true; \
	} \
}

const String inputPath = string_combine(U"test", file_separator(), U"input", file_separator());
const String expectedPath = string_combine(U"test", file_separator(), U"expected", file_separator());

#endif