/*------------------------------------------------------- 
 * トラックプラン: スクリプト (EEPROM内データ)
 *-------------------------------------------------------*/
#include <xc.h>
#include <stdint.h>
#include "ar.h"
#include "fsm.h"
#include "mem.h"
#include "script.h"
#include "fatal.h"

/* ラベル表 (ラベルのEEPROMアドレス) */ 
uint16_t script_label_memaddr[N_LABELS];
uint16_t script_label_lineno[N_LABELS];
/* スクリプト文の解析結果 */
struct script_st_s script_st;

/*------------------------------------------------------- 
 * 初期化
 *-------------------------------------------------------*/
void script_init(void)
{
  /* EEPROM接続検査 */
  if (!mem_probe_device()) {
    fatal(AR_ERROR_NO_EEPROM);
  }
  mem_init(MEM_TYPE_24FC512);
  /* ラベル登録 */
  script_intern_labels();
  /* スクリプト検証(静的検査) */
  script_verify();
}

/*------------------------------------------------------- 
 * ラベル登録 
 *-------------------------------------------------------*/
void script_intern_labels(void)
{
  /* ラベル表をクリア */
  uint8_t lid;
  for (lid = 0; lid < N_LABELS; lid++) {
    script_label_memaddr[lid] = LABEL_UNDEFINED;
    script_label_lineno[lid]  = 0;
  }
  /* PASS1: ラベル定義と構文検査 */
  script_rewind();
  script_st.state = SCRIPT_STATE_IDLE;
  while (!script_eof() &&
         (script_st.state != SCRIPT_STATE_END)) {
    script_read(SCRIPT_PASS_1);
  }
}

/*------------------------------------------------------- 
 * スクリプト検証(静的検査) 
 *-------------------------------------------------------*/
void script_verify(void)
{
  /* PASS2: スクリプト検証 */
  /*   参照ラベル定義の検査 */
  /*   実行時でのスクリプト終端への到達可能性の検査 */
  script_rewind();
  script_st.state = SCRIPT_STATE_IDLE;
  int8_t reachable = 1; /* 1文目へは到達可能 */
  while (!script_eof() &&
         (script_st.state != SCRIPT_STATE_END)) {
    script_read(SCRIPT_PASS_2); /* ジャンプ先ラベル定義検査 */
    switch (script_st.state) {  /* スクリプト終端への到達可能性の追跡 */
    case SCRIPT_STATE_LABEL_FETCHED:
      reachable = 1; /* 次の文は到達可能 */
      break;
    case SCRIPT_STATE_JUMP_FETCHED:
      reachable = 0; /* 次の文は到達不可能 */
      break;
    default:         /* 次の文の到達可能性は今の文と同じ */
      break;
    }
  }
  if ((script_st.state == SCRIPT_STATE_END) &&
      reachable) { /* 実行時にスクリプト終端へ到達する可能性有り */
    fatal_s(AR_ERROR_OUT_OF_RANGE, script_st.lineno,
            "REACHABLITY TO END-OF-SCRIPT");
  }
}

/*------------------------------------------------------- 
 * スクリプト実行制御
 *-------------------------------------------------------*/
enum ar_state_e fsm_script_next(enum ar_state_e ar_state)
{
  switch (ar_state) {
  default:
    fatal(AR_ERROR_INTERNAL);
    break;
  case AR_STATE_INIT:  /* 初期状態 */
    ar_state = AR_STATE_RUNNING;
    /* スクリプト実行準備 */
    script_rewind();
    script_st.state = SCRIPT_STATE_IDLE;
    break;
  case AR_STATE_HOME: /* 定位置状態 */
    ar_state = AR_STATE_RUNNING;
    break;
  case AR_STATE_RUNNING: /* スクリプト実行状態 */
    ar_state = script_exec();  /* PASS3: スクリプト実行 */
    break;
  }
  return ar_state;
}
