/*----------------------------------------------------------------------------
 * Name:    Blinky.c
 * Purpose: LED Flasher
 * Note(s): __USE_LCD   - enable Output on LCD, uncomment #define in code to use
 *  				for demo (NOT for analysis purposes)
 *----------------------------------------------------------------------------
 * Copyright (c) 2008-2011 Keil - An ARM Company.
 * Name: Anita Tino
 *----------------------------------------------------------------------------*/

#include "Blinky.h"

#include <stdio.h>

#include "Board_Joystick.h"
#include "GLCD.h"
#include "LED.h"
#include "LPC17xx.h"

#define __FI 1      /* Font index 16x24         */
#define __USE_LCD 0 /* Uncomment to use the LCD */

// ITM Stimulus Port definitions for printf //////////////////
#define ITM_Port8(n) (*((volatile unsigned char *)(0xE0000000 + 4 * n)))
#define ITM_Port16(n) (*((volatile unsigned short *)(0xE0000000 + 4 * n)))
#define ITM_Port32(n) (*((volatile unsigned long *)(0xE0000000 + 4 * n)))

#define DEMCR (*((volatile unsigned long *)(0xE000EDFC)))
#define TRCENA 0x01000000

struct __FILE {
  int handle;
};
FILE __stdout;
FILE __stdin;

int fputc(int ch, FILE *f) {
  if (DEMCR & TRCENA) {
    while (ITM_Port32(0) == 0);
    ITM_Port8(0) = ch;
  }
  return (ch);
}

/* Import external variables from IRQ.c file                                  */
extern uint8_t clock_ms;

int main(void) {
  LED_Init(); /* LED Initialization            */
  Joystick_Initialize();

#ifdef __USE_LCD
  GLCD_Init(); /* Initialize graphical LCD (if enabled */

  GLCD_Clear(White); /* Clear graphical LCD display   */
  GLCD_SetBackColor(Blue);
  GLCD_SetTextColor(Yellow);
  GLCD_DisplayString(0, 0, __FI, "     COE718 Lab 1    ");
  GLCD_SetTextColor(White);
  GLCD_DisplayString(1, 0, __FI, "       Blinky.c     ");
  GLCD_DisplayString(2, 0, __FI, "  Try the joystick! ");
  GLCD_SetBackColor(White);
  GLCD_SetTextColor(Blue);
  GLCD_DisplayString(6, 0, __FI, "Direction:");
#endif

  // SystemCoreClockUpdate();
  SysTick_Config(SystemCoreClock / 100);

  const char *joystick = "NONE ";
  while (1) {
    const uint32_t state = Joystick_GetState();

    if (state & JOYSTICK_LEFT) {
      joystick = "LEFT ";
      LED_Out(1);
    } else if (state & JOYSTICK_RIGHT) {
      joystick = "RIGHT";
      LED_Out(2);
    } else if (state & JOYSTICK_DOWN) {
      joystick = "DOWN ";
      LED_Out(3);
    } else if (state & JOYSTICK_UP) {
      joystick = "UP   ";
      LED_Out(4);
    } else if (state & JOYSTICK_CENTER) {
      joystick = "PRESS";
      LED_Out(5);
    }

#ifdef __USE_LCD
    GLCD_SetTextColor(Green);
    GLCD_DisplayString(6, 11, __FI, (unsigned char *)joystick);
#endif

    /* Print message with AD value every 10 ms */
    if (clock_ms) {
      clock_ms = 0;

      printf("Joystick: %s\r\n", joystick);
    }
  }
}