// Guitar Hero Live controller emulator

#include "stdafx.h"
#include "GHLtar.h"
#include "Emu/Cell/lv2/sys_usbd.h"
#include "Emu/Io/ghltar_config.h"
#include "Input/pad_thread.h"

LOG_CHANNEL(ghltar_log, "GHLTAR");

template <>
void fmt_class_string<ghltar_btn>::format(std::string& out, u64 arg)
{
	format_enum(out, arg, [](ghltar_btn value)
	{
		switch (value)
		{
		case ghltar_btn::w1: return "W1";
		case ghltar_btn::w2: return "W2";
		case ghltar_btn::w3: return "W3";
		case ghltar_btn::b1: return "B1";
		case ghltar_btn::b2: return "B2";
		case ghltar_btn::b3: return "B3";
		case ghltar_btn::start: return "Start";
		case ghltar_btn::hero_power: return "Hero Power";
		case ghltar_btn::ghtv: return "GHTV";
		case ghltar_btn::strum_down: return "Strum Down";
		case ghltar_btn::strum_up: return "Strum Up";
		case ghltar_btn::dpad_left: return "D-Pad Left";
		case ghltar_btn::dpad_right: return "D-Pad Right";
		case ghltar_btn::whammy: return "Whammy";
		case ghltar_btn::tilt: return "Tilt";
		case ghltar_btn::count: return "Count";
		}

		return unknown;
	});
}

usb_device_ghltar::usb_device_ghltar(u32 controller_index, const std::array<u8, 7>& location)
	: usb_device_emulated(location), m_controller_index(controller_index)
{
	device        = UsbDescriptorNode(USB_DESCRIPTOR_DEVICE, UsbDeviceDescriptor{0x0200, 0x00, 0x00, 0x00, 0x20, 0x12BA, 0x074B, 0x0100, 0x01, 0x02, 0x00, 0x01});
	auto& config0 = device.add_node(UsbDescriptorNode(USB_DESCRIPTOR_CONFIG, UsbDeviceConfiguration{0x0029, 0x01, 0x01, 0x00, 0x80, 0x96}));
	config0.add_node(UsbDescriptorNode(USB_DESCRIPTOR_INTERFACE, UsbDeviceInterface{0x00, 0x00, 0x02, 0x03, 0x00, 0x00, 0x00}));
	config0.add_node(UsbDescriptorNode(USB_DESCRIPTOR_HID, UsbDeviceHID{0x0111, 0x00, 0x01, 0x22, 0x001d}));
	config0.add_node(UsbDescriptorNode(USB_DESCRIPTOR_ENDPOINT, UsbDeviceEndpoint{0x81, 0x03, 0x0020, 0x01}));
	config0.add_node(UsbDescriptorNode(USB_DESCRIPTOR_ENDPOINT, UsbDeviceEndpoint{0x01, 0x03, 0x0020, 0x01}));
}

usb_device_ghltar::~usb_device_ghltar()
{
}

void usb_device_ghltar::control_transfer(u8 bmRequestType, u8 bRequest, u16 wValue, u16 wIndex, u16 wLength, u32 buf_size, u8* buf, UsbTransfer* transfer)
{
	transfer->fake = true;

	// Control transfers are nearly instant
	switch (bmRequestType)
	{
		case 0x21:
			switch (bRequest)
			{
			case 0x09:
				// Do nothing here - not sure what it should do.
				break;
			default:
				ghltar_log.error("Unhandled Query: buf_size=0x%02X, Type=0x%02X, bRequest=0x%02X, bmRequestType=0x%02X", buf_size, (buf_size > 0) ? buf[0] : -1, bRequest, bmRequestType);
				break;
			}
			break;
		default:
			usb_device_emulated::control_transfer(bmRequestType, bRequest, wValue, wIndex, wLength, buf_size, buf, transfer);
			break;
	}
}

extern bool is_input_allowed();

void usb_device_ghltar::interrupt_transfer(u32 buf_size, u8* buf, u32 /*endpoint*/, UsbTransfer* transfer)
{
	ensure(buf_size >= 27);

	transfer->fake            = true;
	transfer->expected_count  = buf_size;
	transfer->expected_result = HC_CC_NOERR;
	// Interrupt transfers are slow(6ms, TODO accurate measurement)
	// But make the emulated guitar reply in 1ms for better input behavior
	transfer->expected_time = get_timestamp() + 1'000;

	memset(buf, 0, buf_size);

	buf[0] = 0x00; // Frets
	// FRET HEXMASK:
	// 0x02 = B1
	// 0x04 = B2
	// 0x08 = B3
	// 0x01 = W1
	// 0x10 = W2
	// 0x20 = W3

	buf[1] = 0x00; // Buttons
	// BUTTONS HEXMASK:
	// 0x01 = Select/Hero Power
	// 0x02 = Start/Pause
	// 0x04 = GHTV Button
	// 0x10 = Sync Button

	buf[2] = 0x0F; // D-Pad
	// DPAD VALUES:
	// 0x00 = Up
	// 0x01 = Up-Left
	// 0x02 = Left
	// 0x03 = Left-Down
	// 0x04 = Down
	// 0x05 = Down-Right
	// 0x06 = Right
	// 0x07 = Up-Right
	// 0x0F = None

	buf[4] = 0x80; // Strummer

	buf[5]  = 0x80; // Hero Power (when buf[19] == 0x00 or 0xFF, set to that.)
	buf[6]  = 0x80; // Whammy
	buf[19] = 0x80; // Accelerometer

	buf[3]  = 0x80; // Unknown, always 0x80
	buf[22] = 0x01; // Unknown, always 0x01
	buf[24] = 0x02; // Unknown, always 0x02
	buf[26] = 0x02; // Unknown, always 0x02
	// buf[7] through buf[18] are always 0x00
	// buf[21]/[23]/[25] are also always 0x00

	if (!is_input_allowed())
	{
		return;
	}

	std::lock_guard lock(pad::g_pad_mutex);
	const auto handler = pad::get_current_handler();
	const auto& pad    = ::at32(handler->GetPads(), m_controller_index);

	if (!(pad->m_port_status & CELL_PAD_STATUS_CONNECTED))
	{
		return;
	}

	const auto& cfg = ::at32(g_cfg_ghltar.players, m_controller_index);
	cfg->handle_input(pad, true, [&buf](ghltar_btn btn, u16 value, bool pressed)
		{
			if (!pressed)
				return;

			switch (btn)
			{
			case ghltar_btn::w1:
				buf[0] += 0x01; // W1
				break;
			case ghltar_btn::b1:
				buf[0] += 0x02; // B1
				break;
			case ghltar_btn::b2:
				buf[0] += 0x04; // B2
				break;
			case ghltar_btn::b3:
				buf[0] += 0x08; // B3
				break;
			case ghltar_btn::w3:
				buf[0] += 0x20; // W3
				break;
			case ghltar_btn::w2:
				buf[0] += 0x10; // W2
				break;
			case ghltar_btn::strum_down:
				buf[4] = 0xFF; // Strum Down
				break;
			case ghltar_btn::strum_up:
				buf[4] = 0x00; // Strum Up
				break;
			case ghltar_btn::dpad_left:
				buf[2] = 0x02; // Left D-Pad (Unused)
				break;
			case ghltar_btn::dpad_right:
				buf[2] = 0x06; // Right D-Pad (Unused)
				break;
			case ghltar_btn::start:
				buf[1] += 0x02; // Pause
				break;
			case ghltar_btn::hero_power:
				buf[1] += 0x01; // Hero Power
				break;
			case ghltar_btn::ghtv:
				buf[1] += 0x04; // GHTV Button
				break;
			case ghltar_btn::whammy:
				buf[6] = ~(value) + 0x01; // Whammy
				break;
			case ghltar_btn::tilt:
				buf[19] = static_cast<u8>(value); // Tilt
				if (buf[19] >= 0xF0)
					buf[5] = 0xFF;
				else if (buf[19] <= 0x10)
					buf[5] = 0x00;
				break;
			case ghltar_btn::count:
				break;
			}
		});
}