/*------------------------------------------------------- 
 * 各種コマンド処理
 *-------------------------------------------------------*/
#include <xc.h>
#include <stdint.h>
#include <ctype.h>
#include "mcr.h"
#include "io.h"
#include "ihex.h"
#include "devinfo.h"
#include "cmd.h"
#include "com.h"
#include "cons.h"

static void   skipline(void);
static int8_t confirm(const char* prompt, int8_t silent, int8_t nl);

/* コマンド: Usage */
void cmd_usage(void)
{
  CLRWDT();
  cons_print_newline(); 
  cons_print_pgm("COMMAND LIST:");
  cons_print_newline(); 
  cons_print_pgm("  U - UNSELECT DEVICE");
  cons_print_newline(); 
  cons_print_pgm("  W - WRITE (UPLOAD INTEL-HEX FILE)");
  cons_print_newline(); 
  cons_print_pgm("  R - READ (DOWNLOAD INTEL-HEX FILE)");
  cons_print_newline(); 
  cons_print_pgm("  V - VERIFY (COMPARE MEMORY AND INTEL-HEX FILE)");
  cons_print_newline(); 
  cons_print_pgm("  D - DUMP (PRINT MEMORY CONTENTS)");
  cons_print_newline(); 
  cons_print_pgm("  E - ERASE (BLANK MEMORY CONTENTS)");
  cons_print_newline(); 
  cons_print_pgm("  P - PRINT DEVICE DESCRPTION");
}

/* コマンド: 行末まで読み飛ばし 
 * (間違って HEX ファイルをアップロードした時のため) */
void cmd_skip_line(void)
{
  skipline();
}

static void skipline(void)
{
  for (;;) {
    CLRWDT();
    int16_t ch = 0;
    while ((ch = cons_getc()) < 0) {
      CLRWDT();
    }
    if ((ch == CHAR_CR) || (ch == CHAR_LF)) {
      break;
    }
  }
}

/* コマンド: 書込 */
void cmd_write(uint8_t dev)
{
  cmd_write_verify(dev, IHEX_CMD_WRITE);
}

/* コマンド: ベリファイ */
void cmd_verify(uint8_t dev)
{
  cmd_write_verify(dev, IHEX_CMD_VERIFY);
}

/* 書込/ベリファイ */
void cmd_write_verify(uint8_t dev, enum ihex_cmd_e cmd)
{
  uint16_t nerrs = 0;
  /* 確認 */
  cons_print_newline();
  if (cmd == IHEX_CMD_WRITE) {
    cons_print_pgm("UPLOAD INTEL-HEX FILE TO WRITE ");
  } else if (cmd == IHEX_CMD_VERIFY) {
    cons_print_pgm("UPLOAD INTEL-HEX FILE TO VERIFY ");
  }
  /* EEPROMデバイス初期化 */
  if (!(*devs[dev].f_init)(dev)) {
    cons_print_newline();
    cons_print_pgm("ERROR: MEMORY DEVICE NOT CONNECTED");
    return;
  }
  OUT_LED_MEM_ON(); 
  /* 書き込みループ */
  ihex_init();
  enum ihex_ret_e r = IHEX_OK;
  uint16_t lineno = 0;
  uint16_t progress = 0;
  for (;;) {
    CLRWDT();
    /* HEXファイル1行読込(メモリ書込/ベリファイ) */
    r = ihex_read_line(dev, cmd); 
    /* 進行状況を表示 */
    lineno++;
    if (progress == 0) {
      progress++;
      if (r == IHEX_OK) {
        cons_print_newline();
        if (cmd == IHEX_CMD_WRITE) {
          cons_print_pgm("WRITING");
        } else if (cmd == IHEX_CMD_VERIFY) {
          cons_print_pgm("VERIFYING");
        }
      }
    }
    if ((lineno & 0x3F) == 1) {
      cons_print_pgm(".");
      progress++;
      if (progress == 64) {
        progress = 0;
      }
    }
    /* ファイル終端ならば完了 */
    if (r == IHEX_EOF) {
      break;
    }
    /* エラー処理 */
    if ((r != IHEX_OK) && (nerrs == 0)){
      nerrs = 1;
      cons_print_newline();
      switch (r) {
      case IHEX_ERR_CHECKSUM:
        cons_print_pgm("CHECKSUM DOES NOT MATCH");
        break;
      case IHEX_ERR_FORMAT: 
        cons_print_pgm("BROKEN INTEL-HEX FILE");
        break;
      case IHEX_ERR_ADDR:
        cons_print_pgm("ADDRESS OUT OF RANGE");
        break;
      case IHEX_ERR_VERIFY:
        cons_print_pgm("UNVERIFIED");
        break;
      case IHEX_ERR_UNSUPP: 
        cons_print_pgm("UNSUPPORTED INTEL-HEX FORMAT");
        break;
      default: 
        cons_print_pgm("ERROR");
        break;
      }
    }
    if (r == IHEX_ERR_FORMAT) {
      break;
    }
  }
  /* 終了メッセージ */
  cons_print_newline();
  if (nerrs == 0) {
    cons_print_pgm("COMPLETED");
  }
  /* EEPROMデバイス動作完了 */
  (*devs[dev].f_deinit)(dev);
  OUT_LED_MEM_OFF(); 
}

/* コマンド: メモリ内容読み出し(Intel HEXファイルとして) */
void cmd_read(uint8_t dev)
{
#define IHEX_LINE_NBYTES  16
  uint32_t addr = 0;
  uint8_t nbytes = 0;
  uint8_t data[IHEX_LINE_NBYTES];
  uint8_t done = 0;
  uint8_t emit = 0;
  uint8_t success = 0;
  /* 確認 */
  if (!confirm("READY?", 1, 1)){
    return;
  }
  /* EEPROMデバイス初期化 */
  if (!(*devs[dev].f_init)(dev)) {
    cons_print_pgm("ERROR: MEMORY DEVICE NOT CONNECTED");
    return;
  }
  OUT_LED_MEM_ON(); 
  /* Intel HEX ファイルとして表示 */
  (*devs[dev].f_read_begin)(dev, addr, devs[dev].size_in_byte);
  for (;;) {
    CLRWDT();
    if (emit == 1) {
      emit = 0;
      if (cons_get_ready()) {
        cons_print_newline();
        cons_print_pgm("INTERRUPTED");
        cons_print_newline();
        while (cons_getc() >= 0) { /* 受信文字すべてを捨てる */
          ;
        }
        break;
      }
      if (nbytes != 0) {
        uint8_t chksum = 0;
        /* レコードタイプ 4; 拡張線形アドレス(32-bit)出力 */
        if ((addr & 0xFFFF) == 0x0000) {
          uint8_t d2 = (addr >> 16) & 0xFF; 
          uint8_t d3 = (addr >> 24) & 0xFF; 
          chksum = (unsigned)0x02 + 0x00 + 0x00 + 0x04 + d3 + d2;
          cons_print_pgm(":02000004");
          cons_print_hex(d3);
          cons_print_hex(d2);
          cons_print_hex((unsigned)0 - chksum);
          cons_print_newline();
        }
        /* レコードタイプ 0; データ出力(16-bitアドレッシング) */
        uint8_t a0 =  addr       & 0xFF; 
        uint8_t a1 = (addr >> 8) & 0xFF; 
        chksum = (unsigned)0x00 + nbytes + a1 + a0 + 0x00;
        cons_print_pgm(":");
        cons_print_hex(nbytes);
        cons_print_hex(a1);
        cons_print_hex(a0);
        cons_print_pgm("00");
        uint8_t i = 0;
        for (i = 0; i < nbytes; i++) {
          addr++;
          cons_print_hex(data[i]);
          chksum += data[i];
        }
        nbytes = 0;
        cons_print_hex((unsigned)0 - chksum);
        cons_print_newline();
      }
    }
    if (done == 1) {
      /* レコードタイプ 2; EOF */
      cons_print_pgm(":00000001FF");
      cons_print_newline();
      success = 1;
      break;
    }
    if (addr + nbytes == devs[dev].size_in_byte) {
      emit = 1;
      done = 1;
    } else {
      data[nbytes] = (*devs[dev].f_read_byte)(dev);
      nbytes++;
      if (nbytes == IHEX_LINE_NBYTES) {
        emit = 1;
      }
    }
  }
  (*devs[dev].f_read_done)(dev);
  /* EEPROMデバイス動作完了 */
  (*devs[dev].f_deinit)(dev);
  /* 完了 */
  OUT_LED_MEM_OFF(); 
  if (success == 1) {
    uint16_t t = 6000;
    while (t != 0) {
      CLRWDT();
      t--;
      __delay_ms(10);
      if (cons_getc() >= 0) {
        break;
      }
    }
    cons_print_pgm("COMPLETED");
  }
}

static int8_t confirm(const char* prompt, int8_t silent, int8_t nl)
{
  cons_print_newline();
  cons_print_pgm(prompt);
  cons_print_pgm(" (Y/N) ");
  if (nl) {
    cons_print_newline();
  }
  int16_t c = 0;
  while ((c = cons_getc()) < 0) {
    CLRWDT();
  }
  char ch = (char)c;
  if (!silent) {
    cons_putc(ch);
  }
  if ((ch != 'Y') && (ch != 'y')) {
    cons_print_newline();  
    cons_print_pgm("CANCELD");
    return 0;
  }
  return 1;
}

/* コマンド: メモリ内容ダンプ */
void cmd_dump(uint8_t dev)
{
  /* EEPROMデバイス初期化 */
  if (!(*devs[dev].f_init)(dev)) {
    cons_print_newline();
    cons_print_pgm("ERROR: MEMORY DEVICE NOT CONNECTED");
    return;
  }
  /* 256バイトごとに16進数ダンプ */
  uint32_t addr;
  for (addr = 0; addr < devs[dev].size_in_byte; addr++) {
    CLRWDT();
    uint8_t a8 = addr & 0xFF;
    if (a8 == 0x00) {
      (*devs[dev].f_read_begin)(dev, addr, 256);
    }
    if (a8 == 0x00) {
      cons_print_newline();
      cons_print_pgm("          ");
      cons_print_pgm("+0 +1 +2 +3 +4 +5 +6 +7 ");
      cons_print_pgm("+8 +9 +A +B +C +D +E +F");
    }
    if ((a8 & 0x0F) == 0x00) {
      cons_print_newline();
      cons_print_hex((addr >> 24) & 0xFF);
      cons_print_hex((addr >> 16) & 0xFF);
      cons_print_hex((addr >>  8) & 0xFF);
      cons_print_hex( addr        & 0xFF);
      cons_print_pgm(": ");
    }
    uint8_t d = (*devs[dev].f_read_byte)(dev);
    cons_print_hex(d);
    cons_putc(' ');
    if (a8 == 0xFF) { 
      (*devs[dev].f_read_done)(dev);
      /* 次の256バイトを表示する:
       * (スペースキー押下)か終了するか(それ以外のキー押下) */
      cons_print_newline();
      cons_print_pgm("--MORE-- ");
      cons_print_pgm("(HIT SPACE KEY TO CONTINUE; ");
      cons_print_pgm("'Q' TO EXIT) ");
      int16_t c = 0;
      while ((c = cons_getc()) < 0) {
        CLRWDT();
      }
      if (toupper((char)c) == 'Q') {
        break;
      }
    }
  }
  /* EEPROMデバイス動作完了 */
  (*devs[dev].f_deinit)(dev);
}

/* コマンド: 消去 */
void cmd_erase(uint8_t dev)
{
  enum ihex_ret_e r = IHEX_OK;
  /* 確認 */
  if (!confirm("ERASE MEMORY?", 0, 0)){
    return;
  }
  /* EEPROMデバイス初期化 */
  if (!(*devs[dev].f_init)(dev)) {
    cons_print_newline();
    cons_print_pgm("ERROR: MEMORY DEVICE NOT CONNECTED");
    return;
  }
  OUT_LED_MEM_ON(); 
  /* 消去 */
  cons_print_newline();  
  cons_print_pgm("ERASING MEMORY...");
  (*devs[dev].f_erase)(dev);
  cons_print_newline();  
  cons_print_pgm("COMPLETED");
  /* EEPROMデバイス動作完了 */
  (*devs[dev].f_deinit)(dev);
  OUT_LED_MEM_OFF();
}

/* 書き込みによる消去 */
void erase_by_write(uint8_t dev)
{
  uint32_t addr;
  (*devs[dev].f_write_begin)(dev, 0, devs[dev].size_in_byte);
  uint16_t xpos = CONS_WIDTH + 1;
  for (addr = 0; addr < devs[dev].size_in_byte; addr++) {
    CLRWDT();
    if ((addr & 0x1FF) == 0x000) {
      /* 作業進展の表示(512バイトごとアドレスを表示) */
      uint16_t sl = 7;
      if (xpos + sl >= CONS_WIDTH-1) {
        cons_print_newline();
        cons_print_pgm("  ");
        xpos = 2;
      }
      cons_print_hex((addr >> 16) & 0xFF);
      cons_print_hex((addr >>  8) & 0xFF);
      cons_print_hex( addr        & 0xFF);
      cons_print_pgm(" ");
      xpos = xpos + sl;
    }
    (*devs[dev].f_write_byte)(dev, 0xFF);
  }
  (*devs[dev].f_write_done)(dev);
}

/* コマンド: EEPROMデバイス情報表示 */
void cmd_desc(uint8_t dev)
{
  cons_print_newline();
  cons_print_pgm(devs[dev].desc);
}
