#include "lolevel.h"
#include "platform.h"
#include "keyboard.h"
#include "kbd_common.h"

long kbd_new_state[3] = { 0xFFFFFFFF, 0xFFFFFFFF, 0xFFFFFFFF };
long kbd_prev_state[3] = { 0xFFFFFFFF, 0xFFFFFFFF, 0xFFFFFFFF };
long kbd_mod_state[3] = { 0xFFFFFFFF, 0xFFFFFFFF, 0xFFFFFFFF };

extern void _GetKbdState(long*);

int get_usb_bit()
{
        long usb_physw[3];
        usb_physw[USB_IDX] = 0;
        _kbd_read_keys_r2(usb_physw);
        return(( usb_physw[USB_IDX] & USB_MASK)==USB_MASK) ;
}

KeyMap keymap[] = {
	// Order IS important. kbd_get_pressed_key will walk down this table  
	// and take the first matching mask. Notice that KEY_SHOOT_HALF is  
	// always pressed if KEY_SHOOT_FULL is. --MarcusSt
    { 0, KEY_ZOOM_IN         ,0x00002000 }, // Found @0xffb0fa14, levent 0x02
    { 0, KEY_ZOOM_OUT        ,0x00001000 }, // Found @0xffb0fa0c, levent 0x03
    { 1, KEY_PRINT           ,0x80000000 }, // KEY Playback for ALT menu
    { 1, KEY_SHOOT_FULL      ,0x00300000 }, // Found @0xffb0fa24, levent 0x01    
    { 1, KEY_SHOOT_FULL_ONLY ,0x00200000 }, // Found @0xffb0fa24, levent 0x01
    { 1, KEY_SHOOT_HALF      ,0x00100000 }, // Found @0xffb0fa1c, levent 0x00
    { 1, KEY_SET             ,0x08000000 }, // Found @0xffb0fa54, levent 0x08
    { 1, KEY_MENU            ,0x04000000 }, // Found @0xffb0fa4c, levent 0x09
    { 1, KEY_LEFT            ,0x02000000 }, // Found @0xffb0fa44, levent 0x06
    { 1, KEY_RIGHT           ,0x01000000 }, // Found @0xffb0fa3c, levent 0x07    
    { 1, KEY_DOWN            ,0x00800000 }, // Found @0xffb0fa34, levent 0x05
    { 1, KEY_UP              ,0x00400000 }, // Found @0xffb0fa2c, levent 0x04
    { 1, KEY_PLAYBACK        ,0x80000000 }, // Found @0xffb0fa74, levent 0x101
//    { 1, KEY_POWER           ,0x40000000 }, // Found @0xffb0fa6c, levent 0x100
    { 1, KEY_HELP            ,0x20000000 }, // Found @0xffb0fa64, levent 0x14
    { 1, KEY_VIDEO           ,0x10000000 }, // Found @0xffb0fa5c, levent 0x1a
    { 0, 0, 0 }
};

// NOP 

long __attribute__((naked,noinline)) wrap_kbd_p1_f() {
	
	//a2300 @0xff82ee08
	asm volatile(
		"STMFD	SP!, {R1-R7,LR} \n"
		"MOV	R5, #0 \n"
		"BL	my_kbd_read_keys \n"	// pached
		"B	_kbd_p1_f_cont \n"
	);
	
	return 0; // shut up the compiler
}

void __attribute__((noinline)) mykbd_task() {
	while (physw_run) {
        _SleepTask(physw_sleep_delay);

		if (wrap_kbd_p1_f() == 1) {   // autorepeat ?
			_kbd_p2_f();
		}
	}
	_ExitTask();
}

void my_kbd_read_keys() {
    kbd_update_key_state();
    kbd_update_physw_bits();
}

void kbd_fetch_data(long *dst)
{
    _GetKbdState(dst);
    _kbd_read_keys_r2(dst);
}