size_t HID_Flag()
{
return i2cReadRegister(I2C_DEV_MCU, 0x10);
}
size_t Level3D()
{
return i2cReadRegister(I2C_DEV_MCU, 0x08);
}
size_t VolumeLevel()
{
return i2cReadRegister(I2C_DEV_MCU, 0x09);
}
size_t BatteryLevel()
{
return i2cReadRegister(I2C_DEV_MCU, 0x0B);
}

#define BUTTON_POWER 1
#define BUTTON_HOME 8
#define BUTTON_WIFI10
u32 padflag_state;


u32 InputWait() {
static u64 delay = 0;
u32 pad_state_old = HID_STATE;
delay = (delay) ? 72 : 128;
timer_start();
u32 HIDFlag = 0;

while (true) {
padflag_state = 0;

HIDFlag = HID_Flag();
if (HIDFlag == 0x01){padflag_state = BUTTON_POWER;return 0;}
if (HIDFlag == 0x04){padflag_state = BUTTON_HOME;return 0;}
if (HIDFlag == 0x10){padflag_state = BUTTON_WIFI;return 0;}

u32 pad_state = HID_STATE;
if (!(~pad_state & BUTTON_ANY)) { // no buttons pressed
pad_state_old = pad_state;
delay = 0;
continue;
}
if ((pad_state == pad_state_old) &&
(!(~pad_state & BUTTON_ARROW) ||
(delay && (timer_msec() < delay))))
continue;
//Make sure the key is pressed
u32 t_pressed = 0;
for(; (t_pressed < 0x13000) && (pad_state == HID_STATE); t_pressed++);

if (t_pressed >= 0x13000)return ~pad_state;

}
}

} else if (padflag_state == BUTTON_POWER) {
DeinitFS();
PowerOff();
} else if (padflag_state == BUTTON_HOME) {
DeinitFS();
Reboot();
}