#include 
#include 
#include 
#include 

static void *xfb = NULL;
static GXRModeObj *rmode = NULL;

//---------------------------------------------------------------------------------
int main(int argc, char **argv) {
//---------------------------------------------------------------------------------

   VIDEO_Init();
   WPAD_Init();
   rmode = VIDEO_GetPreferredMode(NULL);
   xfb = MEM_K0_TO_K1(SYS_AllocateFramebuffer(rmode));
   console_init(xfb,20,20,rmode->fbWidth,rmode->xfbHeight,rmode->fbWidth*VI_DISPLAY_PIX_SZ);
   VIDEO_Configure(rmode);
   VIDEO_SetNextFramebuffer(xfb);
   VIDEO_SetBlack(FALSE);
   VIDEO_Flush();
   VIDEO_WaitVSync();
   if(rmode->viTVMode&VI_NON_INTERLACE) VIDEO_WaitVSync();

   printf("\x1b[2;0H");
   printf("leds\n");
	 while(WPAD_Probe(0, NULL) != WPAD_ERR_NONE)
	 {
		WPAD_ScanPads();
    printf("\n\nfound wiimote\n\n");
    if (WPAD_ButtonsDown(0) & WPAD_BUTTON_HOME) { exit(0); }
	 }

   while(1) {
      WPAD_ScanPads();
      if (WPAD_ButtonsDown(0) & WPAD_BUTTON_HOME) { exit(0); }
      
      if (WPAD_ButtonsDown(0) & WPAD_BUTTON_1)
      {
         wiiuse_set_leds(WPAD_CHAN_0,WIIMOTE_LED_1, NULL);
      }
      if (WPAD_ButtonsDown(0) & WPAD_BUTTON_2)
      {
         wiiuse_set_leds(WPAD_CHAN_0,WIIMOTE_LED_2, NULL);
      }
      if (WPAD_ButtonsDown(0) & WPAD_BUTTON_A)
      {
         wiiuse_set_leds(WPAD_CHAN_0,WIIMOTE_LED_3, NULL);
      }
      if (WPAD_ButtonsDown(0) & WPAD_BUTTON_B)
      {
         wiiuse_set_leds(WPAD_CHAN_0,WIIMOTE_LED_4, NULL);
      }

      // Wait for the next frame
      VIDEO_WaitVSync();
   }
   return 0;
}