#include <string>
#include "LGI3D.h"
#include "SDL.h"
#include <Windows.h>
extern int joystick_index1;
extern int joystick_index2;
extern SDL_Haptic* haptic2;
extern SDL_Joystick* GameController2;
extern SDL_Haptic* ControllerHaptic2;

void LGI3D::FFBLoop(EffectConstants *constants, Helpers *helpers, EffectTriggers* triggers) {
	
	int ff = helpers->ReadIntPtr(0x0065DA20, /* isRelativeOffset */ true);
	UINT8 ff1 = helpers->ReadByte(ff + 0x44, /* isRelativeOffset */ false);
	INT_PTR health1p1 = helpers->ReadIntPtr(0x008429F4, /* isRelativeOffset*/ true);
	INT_PTR health1p2 = helpers->ReadIntPtr(health1p1 + 0x4, /* isRelativeOffset */ false);
	INT_PTR health1p3 = helpers->ReadIntPtr(health1p2 + 0x74, /* isRelativeOffset */ false);
	INT_PTR health2p3 = helpers->ReadIntPtr(health1p2 + 0x78, /* isRelativeOffset */ false);
	float health1p = helpers->ReadFloat32(health1p3 + 0x14, /* isRelativeOffset */ false); //1p health
	float health2p = helpers->ReadFloat32(health2p3 + 0x14, /* isRelativeOffset */ false); //2p health
	helpers->log("got value: ");
	std::string ffs = std::to_string(ff1);
	helpers->log((char *)ffs.c_str());
	float static oldFloat1 = 0.0;
	float static oldFloat2 = 0.0;
	float newFloat1 = health1p;
	float newFloat2 = health2p;

	wchar_t *settingsFilename = TEXT(".\\FFBPlugin.ini");
	int HowtoRumbleKnockEffect = GetPrivateProfileInt(TEXT("Settings"), TEXT("HowtoRumbleKnockEffect"), 0, settingsFilename);
	int HowtoRumbleMotorEffect = GetPrivateProfileInt(TEXT("Settings"), TEXT("HowtoRumbleMotorEffect"), 0, settingsFilename);
	int HowtoRumbleHealthEffect = GetPrivateProfileInt(TEXT("Settings"), TEXT("HowtoRumbleHealthEffect"), 0, settingsFilename);
	int Knock1pStrength = GetPrivateProfileInt(TEXT("Settings"), TEXT("Knock1pStrength"), 0, settingsFilename);
	int Motor1pStrength = GetPrivateProfileInt(TEXT("Settings"), TEXT("Motor1pStrength"), 0, settingsFilename);
	int Health1pStrength = GetPrivateProfileInt(TEXT("Settings"), TEXT("Health1pStrength"), 0, settingsFilename);
	int Knock2pStrength = GetPrivateProfileInt(TEXT("Settings"), TEXT("Knock2pStrength"), 0, settingsFilename);
	int Motor2pStrength = GetPrivateProfileInt(TEXT("Settings"), TEXT("Motor2pStrength"), 0, settingsFilename);
	int Health2pStrength = GetPrivateProfileInt(TEXT("Settings"), TEXT("Health2pStrength"), 0, settingsFilename);

	for (int i = 0; i < SDL_NumJoysticks(); i++)
	{
		wchar_t * deviceGUIDString2 = new wchar_t[256];
		int Device2GUID = GetPrivateProfileString(TEXT("Settings"), TEXT("Device2GUID"), NULL, deviceGUIDString2, 256, settingsFilename);
		char joystick_guid[256];
		sprintf(joystick_guid, "%S", deviceGUIDString2);
		SDL_JoystickGUID guid, dev_guid;
		int numJoysticks = SDL_NumJoysticks();
		std::string njs = std::to_string(numJoysticks);
		((char)njs.c_str());
		for (int i = 0; i < SDL_NumJoysticks(); i++)
		{
			extern int joystick1Index;
			if (i == joystick1Index)
			{
				continue;
			}
			SDL_Joystick* js2 = SDL_JoystickOpen(i);
			joystick_index2 = SDL_JoystickInstanceID(js2);
			SDL_JoystickGUID guid = SDL_JoystickGetGUID(js2);
			char guid_str[1024];
			SDL_JoystickGetGUIDString(guid, guid_str, sizeof(guid_str));
			const char* name = SDL_JoystickName(js2);
			char text[256];
			sprintf(text, "Joystick: %d / Name: %s / GUID: %s\n", i, name, guid_str);
			guid = SDL_JoystickGetGUIDFromString(joystick_guid);
			dev_guid = SDL_JoystickGetGUID(js2);
			if (!memcmp(&guid, &dev_guid, sizeof(SDL_JoystickGUID)))
			{
				GameController2 = SDL_JoystickOpen(i);
				ControllerHaptic2 = SDL_HapticOpenFromJoystick(GameController2);
				break;
			}
			SDL_JoystickClose(js2);
		}
		haptic2 = ControllerHaptic2;
		if ((SDL_HapticRumbleSupported(haptic2) == SDL_TRUE))
		{
			SDL_HapticRumbleInit;
			SDL_HapticRumbleInit(ControllerHaptic2);
		}
	}

	if ((oldFloat1 != newFloat1) && (health1p != 0x1))
	{
		if (HowtoRumbleHealthEffect == 0)
		{
			double percentForce = ((Health1pStrength) / 100.0);
			double percentLength = (400);
			triggers->LeftRight(percentForce, percentForce, percentLength);
		}
		else if (HowtoRumbleHealthEffect == 1)
		{
			double percentForce = ((Health1pStrength) / 100.0);
			double percentLength = (400);
			triggers->LeftRight(0, percentForce, percentLength);
		}
		else if (HowtoRumbleHealthEffect == 2)
		{
			double percentForce = ((Health1pStrength) / 100.0);
			double percentLength = (400);
			triggers->LeftRight(percentForce, 0, percentLength);
		}
	}
	else if ((oldFloat2 != newFloat2) && (health2p != 0x1))
	{
		if (HowtoRumbleHealthEffect == 0)
		{
			double percentForce = ((Health2pStrength) / 100.0);
			double percentLength = (400);
			triggers->LeftRightDevice2(percentForce, percentForce, percentLength);
		}
		else if (HowtoRumbleHealthEffect == 1)
		{
			double percentForce = ((Health2pStrength) / 100.0);
			double percentLength = (400);
			triggers->LeftRightDevice2(0, percentForce, percentLength);
		}
		else if (HowtoRumbleHealthEffect == 2)
		{
			double percentForce = ((Health2pStrength) / 100.0);
			double percentLength = (400);
			triggers->LeftRightDevice2(percentForce, 0, percentLength);
		}
	}
	if (ff1 == 0x20)
	{
		if (HowtoRumbleKnockEffect == 0)
		{
			double percentForce = ((Knock1pStrength) / 100.0);
			double percentLength = (100);
			triggers->LeftRight(percentForce, percentForce, percentLength);
		}
		else if (HowtoRumbleKnockEffect == 1)
		{
			double percentForce = ((Knock1pStrength) / 100.0);
			double percentLength = (100);
			triggers->LeftRight(0, percentForce, percentLength);
		}
		else if (HowtoRumbleKnockEffect == 2)
		{
			double percentForce = ((Knock1pStrength) / 100.0);
			double percentLength = (100);
			triggers->LeftRight(percentForce, 0, percentLength);
		}
	}
	else if (ff1 == 0x40)
	{
		if (HowtoRumbleMotorEffect == 0)
		{
			double percentForce = ((Motor1pStrength) / 100.0);
			double percentLength = (100);
			triggers->LeftRight(percentForce, percentForce, percentLength);
		}
		else if (HowtoRumbleMotorEffect == 1)
		{
			double percentForce = ((Motor1pStrength) / 100.0);
			double percentLength = (100);
			triggers->LeftRight(0, percentForce, percentLength);
		}
		else if (HowtoRumbleMotorEffect == 2)
		{
			double percentForce = ((Motor1pStrength) / 100.0);
			double percentLength = (100);
			triggers->LeftRight(percentForce, 0, percentLength);
		}
	}
	else if (ff1 == 0x22)
	{
		if (HowtoRumbleKnockEffect == 0)
		{
			double percentForce = ((Knock1pStrength) / 100.0);
			double percentLength = (100);
			triggers->LeftRight(percentForce, percentForce, percentLength);
		}
		else if (HowtoRumbleKnockEffect == 1)
		{
			double percentForce = ((Knock1pStrength) / 100.0);
			double percentLength = (100);
			triggers->LeftRight(0, percentForce, percentLength);
		}
		else if (HowtoRumbleKnockEffect == 2)
		{
			double percentForce = ((Knock1pStrength) / 100.0);
			double percentLength = (100);
			triggers->LeftRight(percentForce, 0, percentLength);
		}
	}
	else if (ff1 == 0x42)
	{
		if (HowtoRumbleMotorEffect == 0)
		{
			double percentForce = ((Motor1pStrength) / 100.0);
			double percentLength = (100);
			triggers->LeftRight(percentForce, percentForce, percentLength);
		}
		else if (HowtoRumbleMotorEffect == 1)
		{
			double percentForce = ((Motor1pStrength) / 100.0);
			double percentLength = (100);
			triggers->LeftRight(0, percentForce, percentLength);
		}
		else if (HowtoRumbleMotorEffect == 2)
		{
			double percentForce = ((Motor1pStrength) / 100.0);
			double percentLength = (100);
			triggers->LeftRight(percentForce, 0, percentLength);
		}
	}
	else if (ff1 == 0x4)
	{
		if (HowtoRumbleKnockEffect == 0)
		{
			double percentForce = ((Knock1pStrength) / 100.0);
			double percentLength = (100);
			triggers->LeftRightDevice2(percentForce, percentForce, percentLength);
		}
		else if (HowtoRumbleKnockEffect == 1)
		{
			double percentForce = ((Knock1pStrength) / 100.0);
			double percentLength = (100);
			triggers->LeftRightDevice2(0, percentForce, percentLength);
		}
		else if (HowtoRumbleKnockEffect == 2)
		{
			double percentForce = ((Knock1pStrength) / 100.0);
			double percentLength = (100);
			triggers->LeftRightDevice2(percentForce, 0, percentLength);
		}
	}
	else if (ff1 == 0x8)
	{
		if (HowtoRumbleMotorEffect == 0)
		{
			double percentForce = ((Motor1pStrength) / 100.0);
			double percentLength = (100);
			triggers->LeftRightDevice2(percentForce, percentForce, percentLength);
		}
		else if (HowtoRumbleMotorEffect == 1)
		{
			double percentForce = ((Motor1pStrength) / 100.0);
			double percentLength = (100);
			triggers->LeftRightDevice2(0, percentForce, percentLength);
		}
		else if (HowtoRumbleMotorEffect == 2)
		{
			double percentForce = ((Motor1pStrength) / 100.0);
			double percentLength = (100);
			triggers->LeftRightDevice2(percentForce, 0, percentLength);
		}
	}
	else if (ff1 == 0x6)
	{
	if (HowtoRumbleKnockEffect == 0)
	{
		double percentForce = ((Knock1pStrength) / 100.0);
		double percentLength = (100);
		triggers->LeftRightDevice2(percentForce, percentForce, percentLength);
	}
	else if (HowtoRumbleKnockEffect == 1)
	{
		double percentForce = ((Knock1pStrength) / 100.0);
		double percentLength = (100);
		triggers->LeftRightDevice2(0, percentForce, percentLength);
	}
	else if (HowtoRumbleKnockEffect == 2)
	{
		double percentForce = ((Knock1pStrength) / 100.0);
		double percentLength = (100);
		triggers->LeftRightDevice2(percentForce, 0, percentLength);
	}
	}
	else if (ff1 == 0xA)
	{
	if (HowtoRumbleMotorEffect == 0)
	{
		double percentForce = ((Motor1pStrength) / 100.0);
		double percentLength = (100);
		triggers->LeftRightDevice2(percentForce, percentForce, percentLength);
	}
	else if (HowtoRumbleMotorEffect == 1)
	{
		double percentForce = ((Motor1pStrength) / 100.0);
		double percentLength = (100);
		triggers->LeftRightDevice2(0, percentForce, percentLength);
	}
	else if (HowtoRumbleMotorEffect == 2)
	{
		double percentForce = ((Motor1pStrength) / 100.0);
		double percentLength = (100);
		triggers->LeftRightDevice2(percentForce, 0, percentLength);
	}
	}
	else if (ff1 == 0x24)
	{
		if (HowtoRumbleKnockEffect == 0)
		{
			double percentForce = ((Knock1pStrength) / 100.0);
			double percentLength = (100);
			triggers->LeftRight(percentForce, percentForce, percentLength);
			triggers->LeftRightDevice2(percentForce, percentForce, percentLength);
		}
		else if (HowtoRumbleKnockEffect == 1)
		{
			double percentForce = ((Knock1pStrength) / 100.0);
			double percentLength = (100);
			triggers->LeftRight(percentForce, percentForce, percentLength);
			triggers->LeftRightDevice2(0, percentForce, percentLength);
		}
		else if (HowtoRumbleKnockEffect == 2)
		{
			double percentForce = ((Knock1pStrength) / 100.0);
			double percentLength = (100);
			triggers->LeftRight(percentForce, percentForce, percentLength);
			triggers->LeftRightDevice2(percentForce, 0, percentLength);
		}
	}
	else if (ff1 == 0x4A)
	{
		if (HowtoRumbleMotorEffect == 0)
		{
			double percentForce = ((Motor1pStrength) / 100.0);
			double percentLength = (100);
			triggers->LeftRight(percentForce, percentForce, percentLength);
			triggers->LeftRightDevice2(percentForce, percentForce, percentLength);
		}
		else if (HowtoRumbleMotorEffect == 1)
		{
			double percentForce = ((Motor1pStrength) / 100.0);
			double percentLength = (100);
			triggers->LeftRight(0, percentForce, percentLength);
			triggers->LeftRightDevice2(0, percentForce, percentLength);
		}
		else if (HowtoRumbleMotorEffect == 2)
		{
			double percentForce = ((Motor1pStrength) / 100.0);
			double percentLength = (100);
			triggers->LeftRight(percentForce, 0, percentLength);
			triggers->LeftRightDevice2(percentForce, 0, percentLength);
		}
	}
	oldFloat1 = newFloat1;
	oldFloat2 = newFloat2;
}