0x0815FE00, 0x0815FE02..0x0815FE0E : Buffer for communication packets
0x0815FE10 : Status/Config?
0x0815FE12 : Size of packet in buffer, written from DS
0x0815FE14 : Size of packet in buffer, written from BPR
0x0815FE16 : ???
0x0815FEFE : Read from before every read/write, discarded. Clocks the Beypointer?

/*
	Copyright (C) 2009 CrazyMax
	Copyright (C) 2009-2013 DeSmuME team

	This file is free software: you can redistribute it and/or modify
	it under the terms of the GNU General Public License as published by
	the Free Software Foundation, either version 2 of the License, or
	(at your option) any later version.

	This file 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
	GNU General Public License for more details.

	You should have received a copy of the GNU General Public License
	along with the this software.  If not, see <http://www.gnu.org/licenses/>.
*/

#include "../slot2.h"
//#include "../armcpu.h"

#define ARR_SIZE 0x30 //IDK. Game never reads higher than around 0x2D
//0-2 = some points, 3-5 = some other points, 6-7 = wins, 8-9 = losses, 0xA-0xB = "game overs", 0xC = battle something(can't read it)
// 0x18-0x27 = 8 character name in Shift-JIS, only supports some characters
//little endian
static u8 arr[ARR_SIZE] = { 0xA8, 0x16, 0x03, 0xF0, 0x06, 0x00, 0x55, 0xA4, 0x5C, 0x11, 0x00, 0x08, 0x37, 0x0D, 0x0E, 0x0F,
						    0x10, 0x11, 0x12, 0x13, 0x14, 0x15, 0x16, 0x17, 0x82, 0x60, 0x82, 0x61, 0x82, 0x62, 0x82, 0x63,
						    0x82, 0x64, 0x82, 0x65, 0x00, 0x00, 0x00, 0x00, 0x28, 0x29, 0x2A, 0x2B, 0x2C, 0x2D, 0x2E, 0x2F,};

class Slot2_GuitarGrip : public ISlot2Interface
{
private: 
	int processCommand;
	u16 status; //idk
	u8 buf[8] = { 0 };
	u8 bufSize = 0;

	u8 reverseNibble(u8 val) { return (val & 0xF0) >> 4 | (val & 0x0F) << 4; }

	u16 processBpr(u32 addr)
	{
		u16 outWord = 0;
		u8 pos;
		u8 size;
		if (processCommand) {
			processCommand = 0;
			u8 cmd = buf[0];

			switch (cmd) {
			case 0x40: //?
				break;
			case 0x44: //Read
				pos = reverseNibble(buf[1]);
				size = reverseNibble(buf[2]);
				for (int i = 0; i < size; i++) { //Copy data into buf
					if ((pos+i < ARR_SIZE) && (i+1 < 8))
						buf[i + 1] = reverseNibble(arr[pos + i]);
				}
				buf[0] = 0x46;
				bufSize = size + 1;
				status = 0x02;
				printf("BPR READ, POS: %02X, SIZE: %02X\n", pos, size);
				break;
			case 0x45: //Write
				pos = reverseNibble(buf[1]);
				size = reverseNibble(buf[2]);
				for (int i = 0; i < size; i++) { //Copy data from buf
					if ((pos+i < ARR_SIZE) && (i+3 < 8))
						arr[pos+i] = reverseNibble(buf[i + 3]);
				}
				buf[0] = 0x46; //Only need to change the first byte of the buffer, the rest is fine
				bufSize = size + 3;
				status = 0x02;
				printf("BPR WRITE, POS: %02X, SIZE: %02X\n", pos, size);
				break;
			case 0x46: //Data
				buf[0] = 0x4C;
				bufSize = 1;
				status = 0x02;
				break;
			case 0x4C: //?
				status = 0x04;
				break;
			default:
				outWord = 0;
				break;
			}
		}

		if ((addr >= 0x0815FE00) && (addr <= 0x815FE0E)) {
			u32 tmp = (addr & 0xF) / 2;
			outWord = buf[tmp];
		} else if (addr == 0x0815FE10) {
			outWord = status;
		}else if (addr == 0x0815FE14) {
			outWord = bufSize;
		}
		return outWord;
	}
	
public:
	virtual Slot2Info const* info()
	{
		//static Slot2InfoSimple info("Guitar Grip", "Guitar Grip for Guitar Hero games", 0x04);
		static Slot2InfoSimple info("Bey Point Reader", "BPR", 0x04);
		return &info;
	}

	virtual void connect()
	{
		processCommand = 0;
		bufSize = 0;
		status = 0;
	}

	virtual void writeWord(u8 PROCNUM, u32 addr, u16 val)
	{
		//printf("writeWord: %08X = %04X\n", addr, val);

		if ((addr >= 0x0815FE00) && (addr <= 0x0815FE0E)) {
			u32 tmp = (addr & 0xF) / 2;
			buf[tmp] = val & 0xFF;
		}

		if ((addr == 0x0815FE12)) {
			bufSize = val & 0xFF;
			processCommand = 1;
		} else if (addr == 0x0815FE16) {
			status = 0x0; //?
		}
	}

	virtual u8	readByte(u8 PROCNUM, u32 addr) 
	{
		//if (addr != 0x080000B2)
		//	printf("readByte: %08X\n", addr);

		return 0x96; //Detection
	}
	
	virtual u16	readWord(u8 PROCNUM, u32 addr)
	{
		u16 outWord = 0x0000;

		if (addr == 0x080000BE) { //Detection
			outWord = 0xF500;
		}

		if ((addr >= 0x815FE00) && (addr < 0x815FEFE))
			outWord = processBpr(addr);

		//if ((addr > 0x080000BE) && (addr != 0x0815FEFE))
		//	printf("readWord: %08X = %04X\n", addr, outWord);// from %08X(ARM%c)\n", addr, outWord, ARMPROC.instruct_adr, PROCNUM ? '7' : '9');

		return outWord;
	}
	virtual u32	readLong(u8 PROCNUM, u32 addr) { if (addr != 0x080000AC) printf("readLong: %08X\n", addr);  return 0x0; }
};

ISlot2Interface* construct_Slot2_GuitarGrip() { return new Slot2_GuitarGrip(); }

void guitarGrip_setKey(bool green, bool red, bool yellow, bool blue)
{
	//const u8 g = (green)	? (1 << 6) : 0;
	//const u8 r = (red)		? (1 << 5) : 0;
	//const u8 y = (yellow)	? (1 << 4) : 0;
	//const u8 b = (blue)		? (1 << 3) : 0;
	//
	//guitarKeyStatus = ~(g | r | y | b);
}

void guitarGrip_setKey(u8 theKeys)
{
	//guitarKeyStatus = theKeys;
}

--Configure the keyboard controls below
forwardsKey = "U";  --These keys move the camera forward, backward, left, right, up, down
backwardsKey = "J"; --^^^
leftKey = "H";      --^^^
rightKey = "K";     --^^^
upKey = "T";        --^^^
downKey = "G";      --^^^
rotateUpKey = "numpad8";     --These keys rotate the camera
rotateDownKey = "numpad5";   --^^^
rotateLeftKey = "numpad4";  --^^^
rotateRightKey = "numpad6";  --^^^
pitchOffsetKey = "Y"; --Sets the pitch offset to correct for unwanted roll. Aim at the horizon and press to set it.
resetKey = "L"; --Resets everything
movScaleDownKey = "numpad0"; --Adjusts movement scaling down
movScaleUpKey = "numpad1";   --Adjusts movement scaling up
rotScaleDownKey = "numpad2"; --Adjusts rotation scaling down
rotScaleUpKey = "numpad3";   --Adjusts rotation scaling up
scaleMultDownKey = "numpad7"; --Makes the scale adjustment keys 10x less effective
scaleMultUpKey = "numpad9";   --Makes the scale adjustment keys 10x more effective
mouseAimButton = "rightclick"; --Button for mouse aiming. May be leftclick, rightclick, middleclick or a keyboard key



--Gamepad controls assume you have an Xbox style controller

--  Left stick moves left/right and forward/back
--  Right stick rotates
--  Triggers move up down
--  
--  A button resets position, rotation, and pitch offset
--  B button resets rotation and pitch offset
--  X sets pitch offset
--  Y resets the movement and rotation scale
--  
--  Dpad Up/Down adjusts the movement scale
--  Dpad Left/Right adjusts the rotation scale
--  Hold the left or right bumpers to make smaller or bigger changes to the scales
--  
--  Setting the pitch offset is important. Without doing so, your view will roll around as you look left and right in most games.
--  Angle your view towards the "horizon" and rotate the camera 90 degrees to the left or right. Then hold X and adjust up/down a little until everything's level.

joyID = -1; --Controller ID to use. The script will attempt to find a suitable controller, but you can manually set this if you wish
yaw = 0.0;
pitch = 0.0;
pitchoffs = 0.0; --used to correct for the initial pitch of the camera
xpos = 0.0; --coordinates in a virtual 3D space
ypos = 0.0; --^^^
zpos = 0.0; --^^^
matAdjustment = {1,0,0,0,0,1,0,0,0,0,1,0,0,0,0,1};
movscale = 1.0;
rotscale = 1.0;
cooldown = 0;

function MatrixMult4x4(m1, m2) --sorta copied/inspired from some lua matrix library
    local mtx = {0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0}
    for i=1,4 do
        for j=1,4 do
            local num = 0
            for n=1,4 do
                num = num + m1[(i-1)*4+n] * m2[(n-1)*4+j]
            mtx[(i-1)*4+j] = num
            end
        end
    end
    return mtx;
end

function Rotate(angle,x,y,z)
    local s = math.sin(math.rad(angle));
    local c = math.cos(math.rad(angle));
    return {(1-c)*x*x+c, (1-c)*y*x-s*z, (1-c)*z*x+s*y, 0,
            (1-c)*x*y+s*z, (1-c)*y*y+c, (1-c)*z*y-s*x, 0,
            (1-c)*x*z-s*y, (1-c)*y*z+s*x, (1-c)*z*z+c, 0,
            0, 0, 0, 1};
end

function vecrotx(angle, vx, vy, vz) --used for pitch correction in the functions below
    return vx,
            vy * math.cos(math.rad(angle)) - vz * math.sin(math.rad(angle)),
            vy * math.sin(math.rad(angle)) + vz * math.cos(math.rad(angle));
end

function ApplyMovement(fX, fY, fZ, l)
    fX, fY, fZ = vecrotx(pitchoffs, fX, fY, fZ);
    
    local mag = math.sqrt(fX*fX + fY*fY + fZ*fZ);
    fX = fX / mag; fY = fY / mag; fZ = fZ / mag;
    fX = fX * l; fY = fY * l; fZ = fZ * l;
    xpos = xpos + fX; ypos = ypos + fY; zpos = zpos + fZ;
end

function MoveForward(l) --sorta based off https://www.gamedev.net/forums/topic/415144-get-forward-right-up-vectors-from-pitch-yaw-roll/
    local fX = math.sin(math.rad(yaw)) * math.cos(math.rad(pitch+pitchoffs));
    local fY = -math.sin(math.rad(pitch+pitchoffs));
    local fZ = -math.cos(math.rad(yaw)) * math.cos(math.rad(pitch+pitchoffs));
    
    ApplyMovement(fX, fY, fZ, l);
end

function MoveUp(l)
    local fX = math.sin(math.rad(yaw)) * math.cos(math.rad(pitchoffs+90));
    local fY = -math.sin(math.rad(pitchoffs+90));
    local fZ = -math.cos(math.rad(yaw)) * math.cos(math.rad(pitchoffs+90));
    
    ApplyMovement(fX, fY, fZ, l);
end

function MoveRight(l)
    local fX = math.sin(math.rad(yaw+90));
    local fY = 0;
    local fZ = -math.cos(math.rad(yaw+90));
    
    ApplyMovement(fX, fY, fZ, l);
end

function on3d()
    emu.set3dtransform(2,matAdjustment);
end
emu.register3devent(on3d);
emu.set3dtransform(1,nil);

if joyID == -1 then
    for i = 0, 15 do
        c = controller.get(i);
        if c.x and c.y and c.z and c.u and c.r then --simple check that only looks for all the needed axes
            joyID = i;
            print("Found suitable controller, id " .. i);
            break;
        end
    end
else
    print("Using manually set controller, id " .. joyID);
end
if joyID == -1 then
    print("No suitable controller found!");
end

while true do
    if joyID ~= -1 then
        local joy = controller.get(joyID)
        
        scalemult = 1;
        if joy["5"] then --Left bumper
            scalemult = 0.1;
        elseif joy["6"] then --Right bumper
            scalemult = 10;
        end
        if joy.up and cooldown==0 then --Dpad
            cooldown = 10;
            movscale = movscale + (0.1 * scalemult);
            print("Movement scale: " .. movscale);
        end
        if joy.down and cooldown==0 then --Dpad
            cooldown = 10;
            movscale = movscale - (0.1 * scalemult);
            print("Movement scale: " .. movscale);
        end
        if joy.right and cooldown==0 then --Dpad
            cooldown = 10;
            rotscale = rotscale + (0.1 * scalemult);
            print("Rotation scale: " .. rotscale);
        end
        if joy.left and cooldown==0 then --Dpad
            cooldown = 10;
            rotscale = rotscale - (0.1 * scalemult);
            print("Rotation scale: " .. rotscale);
        end
        
        if(math.abs(joy.x)>0.25) then --Left Stick
            MoveRight(-joy.x * movscale);
        end
        if(math.abs(joy.y)>0.25) then --Left Stick
            MoveForward(joy.y * movscale);
        end
        if(math.abs(joy.z)>0.25) then --Triggers
            MoveUp(-joy.z * movscale);
        end
        if(math.abs(joy.u)>0.25) then --Right Stick
            yaw = (yaw + (joy.u * rotscale)) % 360;
        end
        if(math.abs(joy.r)>0.25) then --Right Stick
            pitch = (pitch + (joy.r * rotscale)) % 360;
        end
        
        if joy["1"] and cooldown==0 then --A button
            cooldown = 20;
            yaw = 0.0;
            pitch = 0.0;
            pitchoffs = 0.0;
            xpos = 0.0;
            ypos = 0.0;
            zpos = 0.0;
            movscale = 1.0;
            rotscale = 1.0;
            print("Reset everything");
        end
        if joy["2"] and cooldown==0 then --B button
            cooldown = 20;
            yaw = 0.0;
            pitch = 0.0;
            pitchoffs = 0.0;
            print("Reset rotations");
        end
        if joy["3"] then --X button
            pitchoffs = -pitch;
        end
        if joy["4"] and cooldown==0 then --Y button
            cooldown = 20;
            movscale = 1.0;
            rotscale = 1.0;
            print("Movement/rotation scales reset");
        end
        if joy["8"] and cooldown==0 then --Start
            cooldown = 20;
            print(string.format("X,Y,Z = {%.4f, %.4f, %.4f}", xpos, ypos, zpos));
            print(string.format("yaw,pitch = {%.4f, %.4f}", yaw, pitch));
            print(string.format("pitch offset = %.4f", pitchoffs));
        end
    end
    
    
    --Ugly duplicated code for keyboard input
    keys = input.get()
    scalemult = 1;
    if keys[scaleMultDownKey] then
        scalemult = 0.1;
    elseif keys[scaleMultUpKey] then
        scalemult = 10;
    end
    if keys[movScaleUpKey] and cooldown==0 then --Dpad
        cooldown = 10;
        movscale = movscale + (0.1 * scalemult);
        print("Movement scale: " .. movscale);
    end
    if keys[movScaleDownKey] and cooldown==0 then --Dpad
        cooldown = 10;
        movscale = movscale - (0.1 * scalemult);
        print("Movement scale: " .. movscale);
    end
    if keys[rotScaleUpKey] and cooldown==0 then --Dpad
        cooldown = 10;
        rotscale = rotscale + (0.1 * scalemult);
        print("Rotation scale: " .. rotscale);
    end
    if keys[rotScaleDownKey] and cooldown==0 then --Dpad
        cooldown = 10;
        rotscale = rotscale - (0.1 * scalemult);
        print("Rotation scale: " .. rotscale);
    end
    
    if keys[forwardsKey] then
        MoveForward(-1 * movscale);
    end
    if keys[backwardsKey] then
        MoveForward(1 * movscale);
    end
    if keys[leftKey] then
        MoveRight(1 * movscale);
    end
    if keys[rightKey] then
        MoveRight(-1 * movscale);
    end
    if keys[upKey] then
        MoveUp(1 * movscale);
    end
    if keys[downKey] then
        MoveUp(-1 * movscale);
    end
    if keys[rotateUpKey] then
        pitch = (pitch - 1 * rotscale) % 360;
    end
    if keys[rotateDownKey] then
        pitch = (pitch + 1 * rotscale) % 360;
    end
    if keys[rotateLeftKey] then
        yaw = (yaw - 1 * rotscale) % 360;
    end
    if keys[rotateRightKey] then
        yaw = (yaw + 1 * rotscale) % 360;
    end
    if keys[pitchOffsetKey] then
        pitchoffs = -pitch;
    end
    if keys[resetKey] and cooldown==0 then
        cooldown = 20;
        yaw = 0.0;
        pitch = 0.0;
        pitchoffs = 0.0;
        xpos = 0.0;
        ypos = 0.0;
        zpos = 0.0;
        movscale = 1.0;
        rotscale = 1.0;
        print("Reset everything");
    end
    
    --Mouse aiming
    if keys[mouseAimButton] then
        if keys.xmouse and keys.ymouse then
            tmpX = (keys.xmouse - 128) / 128;
            tmpY = (keys.ymouse - 96) / 96;
            yaw = (yaw + tmpX * rotscale) % 360;
            pitch = (pitch + tmpY * rotscale) % 360;
        end
    end
    
    
    local tmp = Rotate(-yaw, 0.0, math.cos(math.rad(pitchoffs)), math.sin(math.rad(pitchoffs))); --roll correction magic sauce
    tmp = MatrixMult4x4(tmp, Rotate(-pitch, 1.0, 0.0, 0.0));
    local translation = {1,0,0,0,0,1,0,0,0,0,1,0,xpos,ypos,zpos,1};
    matAdjustment = MatrixMult4x4(translation, tmp);
    
    if cooldown>0 then cooldown=cooldown-1 end
    emu.frameadvance();
end

joyid = 0 --change this if your preferred controller isn't being picked up
deadzone = 0.15 --Adjust analog stick deadzones

cooldown=0
weapon=0
subweapon=0
togglestylus=false
toggleaim=false
vcurx=128
vcury=96
key = {}
joy = {}

--Set the controls here
morphkey = "joy.down" --morph ball switch
visorkey = "joy.up" --scan visor switch(hold)
okkey = "joy.2" --ok button in messages
leftkey = "joy.left" --left arrow in messages
rightkey = "joy.right" --right arrow in messages
weaponkey = "joy.4" --weapon cycle
subweaponkey1 = "joy.5" --subweapon cycle back
subweaponkey2 = "joy.6" --subweapon cycle forward
leftstickx = "joy.x" --must be analog stick axis
leftsticky = "joy.y" --must be analog stick axis
rightstickx = "joy.u" --must be analog stick axis
rightsticky = "joy.r" --must be analog stick axis
shootkey = "joy.z" --may be either analog axis or button
boostkey = "joy.3" --morph ball boost
vstyluskey = "joy.7" --virtual stylus(hold)
jumpkey = "joy.1" --jump
startkey = "joy.8" --start


--https://www.lua.org/pil/14.1.html
function getfield (f)
  local v = _G    -- start with the table of globals
  for w in string.gfind(f, "[%w_]+") do
    v = v[w]
  end
  return v
end

while true do
    joysend = {}
    key=input.get()
    joy = controller.get(joyid)
    
    if getfield(vstyluskey) then
        toggleaim = true --this exists to just delay the pressing of the screen when you release the virtual stylus key
        if vcury>0 then
            gui.drawbox(vcurx-1, vcury-1, vcurx+1, vcury+1, "#000000", "#FFFFFF")
        else
            gui.drawbox(vcurx-1, vcury, vcurx+1, vcury+1, "#FFFFFF") --workaround for vcury=0, as it would draw to the top screen
            gui.pixel(vcurx, vcury, "#000000")
        end
        
        if getfield(subweaponkey2) then
            stylus.set{x=vcurx, y=vcury, touch=true}
        end
        if getfield(subweaponkey1) and cooldown==0 then
            togglestylus = not togglestylus
            print('Touchscreen input allowed = ' .. tostring(togglestylus))
            cooldown = 20
        end
        tmp = getfield(rightstickx)
        if tmp and math.abs(tmp)>deadzone then
            vcurx = vcurx + (tmp * 5)
        end
        tmp = getfield(rightsticky)
        if tmp and math.abs(tmp)>deadzone then
            vcury = vcury + (tmp * 5)
        end
        
        if vcurx<0 then vcurx=0 end
        if vcurx>255 then vcurx=255 end
        if vcury<0 then vcury=0 end
        if vcury>191 then vcury=191 end
    else
        if getfield(morphkey) then --Morph
            stylus.set{touch=false} emu.frameadvance() emu.frameadvance()
            stylus.set{x=231, y=167, touch=true} emu.frameadvance() emu.frameadvance()
        end
        if getfield(visorkey) then --Visor
            if cooldown == 0 then
                stylus.set{touch=false} emu.frameadvance() emu.frameadvance()
            end
            cooldown = 10
            stylus.set{x=128, y=173, touch=true}
        end
        if getfield(okkey) then --OK (in scans and messages)
            stylus.set{touch=false} emu.frameadvance() emu.frameadvance()
            stylus.set{x=128, y=142, touch=true} emu.frameadvance() emu.frameadvance()
        end
        if getfield(leftkey) then --Left arrow (in scans and messages)
            stylus.set{touch=false} emu.frameadvance() emu.frameadvance()
            stylus.set{x=71, y=141, touch=true} emu.frameadvance() emu.frameadvance()
        end
        if getfield(rightkey) then --Right arrow (in scans and messages)
            stylus.set{touch=false} emu.frameadvance() emu.frameadvance()
            stylus.set{x=185, y=141, touch=true} emu.frameadvance() emu.frameadvance()
        end
        if getfield(weaponkey) and cooldown==0 then --Switch weapon (beam->missile->subweapon->beam)
            cooldown=20
            weapon=(weapon+1)%3
            stylus.set{touch=false} emu.frameadvance() emu.frameadvance()
            stylus.set{x=85+40*weapon, y=32, touch=true} emu.frameadvance()
            stylus.set{x=85+40*weapon, y=32, touch=true}
        end
        if (getfield(subweaponkey1) or getfield(subweaponkey2)) and cooldown==0 then --Switch subweapon (previous and next)
            cooldown=20
            weapon=2
            if getfield(subweaponkey1) then subweapon=(subweapon-1)%6 end --previous
            if getfield(subweaponkey2) then subweapon=(subweapon+1)%6 end --next
            subX=93+25*subweapon subY=48+25*subweapon
            stylus.set{touch=false} emu.frameadvance() emu.frameadvance()
            stylus.set{x=232, y=34, touch=true} emu.frameadvance()
            stylus.set{x=232, y=34, touch=true} emu.frameadvance()
            stylus.set{x=subX, y=subY, touch=true} emu.frameadvance()
            stylus.set{x=subX, y=subY, touch=true}
        end
        tmp = getfield(leftstickx)
        if tmp and tmp < -deadzone then
            joysend.left = true
        elseif tmp and tmp > deadzone then
            joysend.right = true
        end
        tmp = getfield(leftsticky)
        if tmp and tmp < -deadzone then
            joysend.up = true
        elseif tmp and tmp > deadzone then
            joysend.down = true
        end
        tmp = getfield(rightstickx)
        if tmp and math.abs(tmp)>deadzone and togglestylus==false then
            memory.writedword(0x020DEDA6, (tmp * 4))
            toggleaim=false
        end
        tmp = getfield(rightsticky)
        if tmp and math.abs(tmp)>deadzone and togglestylus==false then
            memory.writedword(0x020DEDAE, (tmp * 6))
            toggleaim=false
        end
        if getfield(boostkey) then
            joysend.R = true
        end
        
        tmp = getfield(shootkey)
        if tmp then
            if type(tmp) == "number" then
                if math.abs(tmp) > deadzone then
                    joysend.L = true
                end
            elseif type(tmp) == "boolean" then
                joysend.L = true
            end
        end
        
        if getfield(jumpkey) then
            joysend.B = true
        end
        if getfield(startkey) then
            joysend.start = true
        end
    end
    
    if cooldown>0 then
        cooldown=cooldown-1
    else
        ball = memory.readbyte(0x020DB098) == 0x02 --Is this a good way of detecting morph ball status??
        if ball==false and togglestylus==false and toggleaim==false then
            stylus.set{x=128, y=96, touch=true} --Required for aiming
        end
    end
    
    joypad.set(1,joysend)
    emu.frameadvance()
end

dpad = {"up", "down", "left", "right"}
sticks = {"x", "y", "z", "r", "u", "v"}

function showControllers()
    gui.box(0, 0, 256, 192, "#808080")
    gui.box(0, -192, 256, 0, "#808080")
    for i=0,15 do
        cont = controller.get(i)
        if type(next(cont)) ~= "nil" then
            gui.text(0, (18*i)-143, i)
            xoffs = 14
            for ii=0,32 do
                col = "#606060"
                tmp = tostring(ii)
                if cont[tmp] ~= nil then
                    if cont[tmp] == true then col = "#FF0000" end
                    gui.text(xoffs, (18*i)-143, tmp, col) --goes off screen if controller has more than ~20 buttons.
                    xoffs = xoffs + string.len(tmp)*6 + 2
                end
            end
            xoffs = 14
            for idx, name in ipairs(dpad) do
                col = "#606060"
                if cont[name] ~= nil then
                    if cont[name] == true then col = "#FF0000" end
                    gui.text(xoffs, (18*i)-143+9, name, col)
                    xoffs = xoffs + string.len(name)*6 + 4
                end
            end
            for idx, name in ipairs(sticks) do
                col = "#606060"
                if cont[name] ~= nil then
                    if math.abs(cont[name]) > 0.25 then col = "#FF0000" end
                    gui.text(xoffs, (18*i)-143+9, name, col)
                    xoffs = xoffs + string.len(name)*6 + 2
                end
            end
        end
    end
end
gui.register(showControllers)

0208B5B0 E3A00000

0208B4DC E3A00000

020A3BBC E3A00000