#include <arm/NXP/LPC17xx/LPC17xx.h>
#include <arm/bits.h>
#include <string.h>
#include "config.h"
#include "diskio.h"
#include "ff.h"
#include "timer.h"
#include "uart.h"
#include "fileops.h"
#include "memory.h"
#include "snes.h"
#include "fpga.h"
#include "fpga_spi.h"
#include "cic.h"
#include "sdnative.h"

#include "sysinfo.h"

static uint32_t sd_tacc_max, sd_tacc_avg;

void sysinfo_loop() {
  sd_tacc_max = 0;
  sd_tacc_avg = 0;
  while(sram_readbyte(SRAM_CMD_ADDR) != 0x00) {
    write_sysinfo();
    delay_ms(100);
  }
}

void write_sysinfo() {
  uint32_t sram_addr = SRAM_SYSINFO_ADDR;
  char linebuf[40];
  int len;
  int sd_ok = 0;
  uint8_t *sd_cid = sdn_getcid();
  uint32_t sd_tacc_max_int = sd_tacc_max / 1000;
  uint32_t sd_tacc_max_frac = sd_tacc_max - (sd_tacc_max_int * 1000);
  uint32_t sd_tacc_avg_int = sd_tacc_avg / 1000;
  uint32_t sd_tacc_avg_frac = sd_tacc_avg - (sd_tacc_avg_int * 1000);
  uint16_t numfiles = sram_readshort(SRAM_DB_ADDR+12);
  uint16_t numdirs = sram_readshort(SRAM_DB_ADDR+14);
  int32_t sysclk = get_snes_sysclk();

  len = snprintf(linebuf, sizeof(linebuf), "Firmware version: %s", CONFIG_VERSION);
  sram_writeblock(linebuf, sram_addr, 40);
  sram_memset(sram_addr+len, 40-len, 0x20);
  sram_addr += 40;
  len = snprintf(linebuf, sizeof(linebuf), "                                        ");
  sram_writeblock(linebuf, sram_addr, 40);
  sram_memset(sram_addr+len, 40-len, 0x20);
  sram_addr += 40;
  if(disk_state == DISK_REMOVED) {
    sd_tacc_max = 0;
    sd_tacc_avg = 0;
    len = snprintf(linebuf, sizeof(linebuf), "                                        ");
    sram_writeblock(linebuf, sram_addr, 40);
    sram_memset(sram_addr+len, 40-len, 0x20);
    sram_addr += 40;
    len = snprintf(linebuf, sizeof(linebuf), "         *** SD Card removed ***        ");
    sram_writeblock(linebuf, sram_addr, 40);
    sram_memset(sram_addr+len, 40-len, 0x20);
    sram_addr += 40;
    len = snprintf(linebuf, sizeof(linebuf), "                                        ");
    sram_writeblock(linebuf, sram_addr, 40);
    sram_memset(sram_addr+len, 40-len, 0x20);
    sram_addr += 40;
    len = snprintf(linebuf, sizeof(linebuf), "                                        ");
    sram_writeblock(linebuf, sram_addr, 40);
    sram_memset(sram_addr+len, 40-len, 0x20);
    sram_addr += 40;
    sd_ok = 0;
  } else {
    len = snprintf(linebuf, sizeof(linebuf), "SD Maker/OEM:    0x%02x, \"%c%c\"", sd_cid[1], sd_cid[2], sd_cid[3]);
    sram_writeblock(linebuf, sram_addr, 40);
    sram_memset(sram_addr+len, 40-len, 0x20);
    sram_addr += 40;
    len = snprintf(linebuf, sizeof(linebuf), "SD Product Name: \"%c%c%c%c%c\", Rev. %d.%d", sd_cid[4], sd_cid[5], sd_cid[6], sd_cid[7], sd_cid[8], sd_cid[9]>>4, sd_cid[9]&15);
    sram_writeblock(linebuf, sram_addr, 40);
    sram_memset(sram_addr+len, 40-len, 0x20);
    sram_addr += 40;
    len = snprintf(linebuf, sizeof(linebuf), "SD Serial No.:   %02x%02x%02x%02x, Mfd. %d/%02d", sd_cid[10], sd_cid[11], sd_cid[12], sd_cid[13], 2000+((sd_cid[14]&15)<<4)+(sd_cid[15]>>4), sd_cid[15]&15);
    sram_writeblock(linebuf, sram_addr, 40);
    sram_memset(sram_addr+len, 40-len, 0x20);
    sram_addr += 40;
    if(sd_tacc_max)
      len = snprintf(linebuf, sizeof(linebuf), "SD acc. time: %ld.%03ld / %ld.%03ld ms avg/max", sd_tacc_avg_int, sd_tacc_avg_frac, sd_tacc_max_int, sd_tacc_max_frac);
    else
      len = snprintf(linebuf, sizeof(linebuf), "SD acc. time: measuring...  ");
    sram_writeblock(linebuf, sram_addr, 40);
    sram_memset(sram_addr+len, 40-len, 0x20);
    sram_addr += 40;
    sd_ok = 1;
  }
  len = snprintf(linebuf, sizeof(linebuf), "                                        ");
  sram_writeblock(linebuf, sram_addr, 40);
  sram_memset(sram_addr+len, 40-len, 0x20);
  sram_addr += 40;
  len = snprintf(linebuf, sizeof(linebuf), "CIC state: %s", get_cic_statefriendlyname(get_cic_state()));
  sram_writeblock(linebuf, sram_addr, 40);
  sram_memset(sram_addr+len, 40-len, 0x20);
  sram_addr += 40;
  if(sysclk == -1)
    len = snprintf(linebuf, sizeof(linebuf), "SNES master clock: measuring...");
  else
    len = snprintf(linebuf, sizeof(linebuf), "SNES master clock: %ldHz    ", get_snes_sysclk());
  sram_writeblock(linebuf, sram_addr, 40);
  sram_memset(sram_addr+len, 40-len, 0x20);
  sram_addr += 40;
  len = snprintf(linebuf, sizeof(linebuf), "                                        ");
  sram_writeblock(linebuf, sram_addr, 40);
  sram_memset(sram_addr+len, 40-len, 0x20);
  sram_addr += 40;
  len = snprintf(linebuf, sizeof(linebuf), "Database: %d files, %d dirs", numfiles, numdirs);
  sram_writeblock(linebuf, sram_addr, 40);
  sram_memset(sram_addr+len, 40-len, 0x20);
  sram_addr += 40;
  len = snprintf(linebuf, sizeof(linebuf), "                                        ");
  sram_writeblock(linebuf, sram_addr, 40);
  sram_memset(sram_addr+len, 40-len, 0x20);
  sram_addr += 40;
  len = snprintf(linebuf, sizeof(linebuf), "                                        ");
  sram_writeblock(linebuf, sram_addr, 40);
  sram_memset(sram_addr+len, 40-len, 0x20);
  sram_hexdump(SRAM_SYSINFO_ADDR, 13*40);
  if(sysclk != -1 && sd_ok)sdn_gettacc(&sd_tacc_max, &sd_tacc_avg);
}