/*------------------------------------------------------- 
 * 経路設定
 *-------------------------------------------------------*/
#include <xc.h>
#include <stdint.h>
#include <stdio.h>
#include <ctype.h>
#include "mcr.h"
#include "io.h"
#include "defs.h"
#include "route.h"
#include "action.h"
#include "fatal.h"
#include "mem.h"

/* 接続可能なポイントの最大数 */
uint16_t       max_turnouts = 0;
/* 経路総数 */
uint16_t       n_routes     = 0;

static void read_route_spec(enum action_e act,
                            uint8_t rid_action,
                            uint8_t rid_next,
                            uint16_t lineno);

/* 経路情報の各行を読み順次処理を行う */
void route_read(enum action_e act,
                uint8_t rid_action)
{
  n_routes = 0;
  uint8_t occur_end     = 0;
  uint8_t occur_nroutes = 0;
  uint16_t rid_next = 0;
  uint16_t lineno = 1;
  mem_addr_set(0);
  while (!mem_is_end()) {
    CLRWDT();
    uint8_t ch = mem_read(); /* 行頭の指示子文字 */
    switch (ch) {
    default:
      fatal_sc(ERR_R_ILLCMD, lineno,
               "ILLEGAL COMMAND", ch);
      break;
    case CMD_CH_END:     /* データ終了記号 */
      occur_end = 1;
      break;
    case CMD_CH_COMMENT: /* コメント行 */
      break;
    case CMD_CH_NROUTES: /* 経路総数記述 */
      if (occur_nroutes != 0) { /* 二重出現 */
        fatal_s(ERR_R_SYNTAX, lineno,
                "COMMAND '=' APPEARS MULTIPLY");
      }
      occur_nroutes = 1;
      /* 空白文字を読み飛ばす */
      if (!mem_is_space(mem_read())) {
        fatal_s(ERR_R_SYNTAX, lineno,
                "SPACE EXPECTED");
      }
      mem_skip_space();
      /* 経路数を読む */
      n_routes = mem_read_number();
      /* 文終端チェック*/
      if (mem_read() != CMD_CH_TERMINATOR) {
        fatal_s(ERR_R_SYNTAX, lineno,
                "LINE TERMINATOR EXPECTED");
      }
      break;
    case CMD_CH_ROUTESPEC: /* 経路仕様記述 */
      rid_next++; /* 記述されているべき経路番号 */
      /* 空白文字を読み飛ばす */
      if (!mem_is_space(mem_read())) {
        fatal_s(ERR_R_SYNTAX, lineno,
                "SPACE CHARACTER EXPECTED");
      }
      mem_skip_space();
      /* 経路仕様記述を読む */      
      read_route_spec(act, rid_action, rid_next, lineno);
      break;
    }
    /* データ終了チェック */
    if (occur_end == 1) {
      break;
    }
    /* 行末まで読み飛ばし */
    mem_skip_to_eol();
    lineno++;
  }
  /* データ統合性チェック */ 
  if (n_routes != rid_next) { /* 記述されていない経路あり */
    fatal_s(ERR_R_MISSING, lineno,
            "NOT ENOUGH NUMBER OF ROUTES");
  }
  if (occur_end == 0) { /* データ終了記号が欠落 */
    fatal_s(ERR_R_NONTERM, lineno,
            "COMMAND '/' NOT FOUND");
  }
}

/* 経路仕様記述を1行読む */
static void read_route_spec(enum action_e act,
                            uint8_t rid_action,
                            uint8_t rid_next, 
                            uint16_t lineno)
{
  char ch = 0;
  /* 経路番号 (経路番号は1,2,3,...の順序で出現する事) */
  uint8_t rid = mem_read_number();
  if (rid != rid_next) { /* 経路番号順序違反 */
    fatal_si(ERR_R_ORDERING, lineno,
             "UNEXPECTED ROUTE ID", rid); 
  }
  /* ポイント番号リスト */
  while (!mem_is_end()) {
    /* 空白文字を読み飛ばす */
    ch = mem_read();
    if (mem_is_space(ch)) {
      mem_skip_space();
    } else if (ch == CMD_CH_TERMINATOR) { /* リスト終了 */
      mem_unread();
      break;
    }
    /* 記述解析 */
    ch = mem_read();
    if ((ch == '+') ||
        (ch == '-')) { /* 切替方向＆ポイント番号 */
      /* 切替方向 */
      enum turnout_dir_e tdir = TURNOUT_DIR_NORMAL;
      switch (ch) {
      case '+': tdir = TURNOUT_DIR_NORMAL;  break; /* 定位 */
      case '-': tdir = TURNOUT_DIR_REVERSE; break; /* 反位 */
      }
      /* ポイント番号 p */
      uint8_t p = mem_read_number();
      if ((p == 0) || (p > MAX_N_TURNOUTS)) { /* 範囲外 */
        fatal_si(ERR_R_TURNOUT, lineno,
                 "UNEXPECTED TURNOUT NUMBER", p); 
      }
      /* 現在行の経路番号が動作対象の経路番号なら実行 */
      if (rid == rid_action) { 
        action_exec(act, p, tdir);
      }
    } else { /* 不正文字 */
      fatal_sc(ERR_R_SYNTAX, lineno,
               "ILLEGAL CHARACTER", ch);
    }
  }
}
