#include "types.h"
#include "util.h"
#include "arm11/hardware.h"
#include "arm11/i2c.h"
#include "gfx.h"
#include "pxi.h"
#include "arm11/interrupt.h"
#include "arm11/firm.h"

extern bool battery_ok(void);
extern void power_off(void);
extern void power_reboot(void);

int main(void)
{
	bool poweroff_allowed = false;

	hardwareInit();

	for(;;)
	{
		bool successFlag;
		u32 cmdCode = PXI_tryRecvWord(&successFlag);

		// process cmd
		if(successFlag)
		{

			switch(cmdCode)
			{
				case PXI_CMD_ENABLE_LCDS:
					gfx_init();
					PXI_sendWord(PXI_RPL_OK);
					break;
				case PXI_CMD_ALLOW_POWER_OFF:
					poweroff_allowed = true;
					break;
				case PXI_CMD_FORBID_POWER_OFF:
					poweroff_allowed = false;
					break;
				case PXI_CMD_POWER_OFF:
					power_off();
					break;
				case PXI_CMD_REBOOT:
					power_reboot();
					break;
				case PXI_CMD_FIRM_LAUNCH:
					goto start_firmlaunch;
				default:
					break;
			}
		}


		/* Update state, check for changes */
		
		u8 hidstate = i2cmcu_readreg_hid_irq();

		if(hidstate & MCU_HID_POWER_BUTTON_PRESSED)
		{
			if(poweroff_allowed)	// direct power off allowed?
				power_off();
			PXI_trySendWord(PXI_RPL_POWER_PRESSED);
		}

		if(hidstate & MCU_HID_HOME_BUTTON_PRESSED)
			PXI_trySendWord(PXI_RPL_HOME_PRESSED);

		// handle shell state
		if(hidstate & MCU_HID_SHELL_GOT_CLOSED)
			i2cmcu_lcd_poweroff();
		else if(hidstate & MCU_HID_SHELL_GOT_OPENED)
		{
			i2cmcu_lcd_poweron();
			i2cmcu_lcd_backlight_poweron();
		}
		
		hidstate = i2cmcu_readreg_hid_held();
		
		if(!(hidstate & MCU_HID_HOME_BUTTON_NOT_HELD))
			PXI_trySendWord(PXI_RPL_HOME_HELD);

		// wait a bit, don't spam the i2c bus
		wait(0x8000);
	}

start_firmlaunch:
	gfx_deinit(); // TODO: Let ARM9 decide when to deinit gfx

	IRQ_setPriority(IRQ_MPCORE_SW1, 0xE); // Needed by NATIVE_FIRM

	firm_launch();

	return 0;
}