Reset_Handler   PROC
                EXPORT  Reset_Handler             [WEAK]
                IMPORT  SystemInit
                IMPORT  __main
                LDR     R0, =SystemInit
                BLX     R0
                LDR     R0, =__main

/*----------------------------------------------------------------------------
*      RL-ARM - USB
*----------------------------------------------------------------------------
*      Name:    USBD_Demo.c
*      Purpose: USB Device Demonstration
*      Rev.:    V4.20
*----------------------------------------------------------------------------
*      This code is part of the RealView Run-Time Library.
*      Copyright (c) 2004-2011 KEIL - An ARM Company. All rights reserved.
*---------------------------------------------------------------------------*/

#include <RTL.h>
#include <rl_usb.h>
#include "GLCD.h"
#include <LPC17xx.h>
#include "KBD.h"
#include "stdio.h"

extern void getline (char *, int);    /* external function:  input line      */
extern int  getkey  (void);           /* external function:  input character */

OS_TID t_UART;                      /* assigned task id of task: lights    */
OS_TID t_keyread;                     /* assigned task id of task: keyread   */
OS_TID t_Command_to_GLSD_from_Joystick;                          /* Add by Me     */
OS_TID t_USB_Out_report;                      /* Add by Me     */

__task void keyread (void);
__task void Command_to_GLSD_from_Joystick (void);
__task void USB_Out_report (void);
__task void UART (void);

/*----------------------------------------------------------------------------
*        Task 1 'init': Initialize
*---------------------------------------------------------------------------*/

__task void init (void) {
  GLCD_Init          ();
  GLCD_Clear         (Blue);
  GLCD_SetBackColor  (Blue);
  GLCD_SetTextColor  (White);
  GLCD_DisplayString (4, 0, 1, "  USB HID      ");
  GLCD_DisplayString (5, 0, 1, "  DRM Manage   ");
  KBD_Init ();

  os_tsk_prio_self(100);
  usbd_init();                          /* USB Device Initialization          */
  usbd_connect(__TRUE);                 /* USB Device Connect                 */
  t_keyread = os_tsk_create (keyread,0); /* start keyread task               */
  t_Command_to_GLSD_from_Joystick = os_tsk_create (Command_to_GLSD_from_Joystick, 0);
  os_tsk_delete_self();                 /* Terminate Task                     */
}

int main (void) {

  os_sys_init(init);                    /* Init RTX and start 'init'          */
//  t_keyread = os_tsk_create (keyread,0);
//  t_Command_to_GLSD_from_Joystick = os_tsk_create (Command_to_GLSD_from_Joystick, 0);
}

///*----------------------------------------------------------------------------
// *        Task 2 'keyread'
// *---------------------------------------------------------------------------*/
__task void keyread (void) {

  while (1) {                                 /* endless loop                */
    if (INT0_Get() == 0) {                    /* if key pressed              */
      os_evt_set (0x0010, t_UART);          /* send signal to task UART  */
    }

    if (KBD_Get () !=0x079) {
      os_evt_set (0x0004, t_Command_to_GLSD_from_Joystick);

      }

  }
}

///*----------------------------------------------------------------------------
// *        Task 3 'Command_to_GLSD_from_Joystick'
// *---------------------------------------------------------------------------*/
__task void Command_to_GLSD_from_Joystick (void) {
    uint32_t kbd_val;

     while (1) {

     os_evt_wait_or (0x0004, 0xffff);

kbd_val = (LPC_GPIO1->FIOPIN >> 20) & KBD_MASK;

  
  if ((kbd_val & KBD_UP)     == 0) GLCD_DisplayString (4, 0, 1, "  USB UP      ");/* up     pressed means 0    */
  if ((kbd_val & KBD_LEFT)   == 0) GLCD_DisplayString (5, 0, 1, "  USB Left      "); /* left   pressed means 0    */
  if ((kbd_val & KBD_RIGHT)  == 0) GLCD_DisplayString (6, 0, 1, "  USB Right      "); /* right  pressed means 0    */
  if ((kbd_val & KBD_SELECT) == 0) GLCD_DisplayString (7, 0, 1, "  USB Select      "); /* select pressed means 0    */
  if ((kbd_val & KBD_DOWN)   == 0) GLCD_DisplayString (8, 0, 1, "  USB Down      "); /* down   pressed means 0    */


      }
    }

///*----------------------------------------------------------------------------
// *        Task 4 'UART'
// *---------------------------------------------------------------------------*/
__task void UART (void) {
  

   while (1) {
       os_evt_wait_or (0x0010, 0xffff);
//     printf ("\nCommand: ");
     os_dly_wait (50);
        }

}