/*------------------------------------------------------- 
 * スクリプト実行エンジン
 *-------------------------------------------------------*/
#include <xc.h>
#include <stdint.h>
#include "pp-const.h"
#include "ar.h"
#include "mem.h"
#include "script.h"
#include "random.h"
#include "fatal.h"

/* 確率表 */
static uint16_t prob10_table[11] = {
  0,       /* =  0 * 65535 / 10 */
  6553,    /* =  1 * 65535 / 10 */
  13107,   /* =  2 * 65535 / 10 */
  19660,   /* =  3 * 65535 / 10 */
  26214,   /* =  4 * 65535 / 10 */
  32767,   /* =  5 * 65535 / 10 */
  39321,   /* =  6 * 65535 / 10 */
  45874,   /* =  7 * 65535 / 10 */
  52428,   /* =  8 * 65535 / 10 */
  58981,   /* =  9 * 65535 / 10 */
  65535    /* = 10 * 65535 / 10 */
};

enum ar_state_e script_exec(void)
{
  enum ar_state_e  ar_state = AR_STATE_RUNNING;
  uint8_t lid = 0;
  uint8_t p = 0;
  /* 文種に応じて実行 */
  switch (script_st.state) {
  default:  
  case SCRIPT_STATE_NOP:
  case SCRIPT_STATE_END:
    /* モーター停止 */
    ar_motor_off(); 
    fatal_s(AR_ERROR_INTERNAL, script_st.lineno,
            "INTERNAL ERROR"); /* 内部エラー */
    break;
  case SCRIPT_STATE_IDLE: /* アイドル状態 */
    script_read(SCRIPT_PASS_3); /* 次の1文を読み取る */
    break;
  case SCRIPT_STATE_COMMENT_FETCHED: /* コメント */
    script_st.state = SCRIPT_STATE_IDLE;
    break;
  case SCRIPT_STATE_LABEL_FETCHED: /* ラベル定義 */
    script_st.state = SCRIPT_STATE_IDLE;
    lid = script_st.p[0];
    if (lid == LABEL_ID_HOME) { /* 定位置 */
      ar_state = AR_STATE_HOME; 
    }
    break;
  case SCRIPT_STATE_JUMP_FETCHED: /* 無条件ジャンプ */
    script_st.state = SCRIPT_STATE_IDLE;
    lid = script_st.p[0]; /* label */
    mem_addr_set(script_label_memaddr[lid]);
    break;
  case SCRIPT_STATE_JUMP_RAND_FETCHED: /* 確率的ジャンプ */
    script_st.state = SCRIPT_STATE_IDLE;
    lid = script_st.p[0]; /* label */
    p   = script_st.p[1]; /* 確率 p/10 で */
    if ((p == 10) ||
        ((p <= 10) && (random_get16() < prob10_table[p]))) {
      mem_addr_set(script_label_memaddr[lid]);
    }
    break;
  case SCRIPT_STATE_JUMP_SENS_FETCHED: /* センサ条件ジャンプ */
    script_st.state = SCRIPT_STATE_IDLE;
    lid = script_st.p[0]; /* label */
    if (if_sensor_get(script_st.p[1]) /* sn */
        == script_st.p[2]) {          /* on(=1), off(=0) */
      mem_addr_set(script_label_memaddr[lid]);
    }
    break;
  case SCRIPT_STATE_MOTORON_FETCHED: /* モータ&常点灯On/Off */
    script_st.state = SCRIPT_STATE_IDLE;
    switch (script_st.p[0]) { /* on/off */
    case 0: ar_motor_off(); break; /* オフ */
    case 1: ar_motor_on();  break; /* オン */
    }
    break;
  case SCRIPT_STATE_TRACKDIR_FETCHED: /* 線路極性 */
    script_st.state = SCRIPT_STATE_IDLE;
    enum ar_track_dir_e tdir = AR_TRACK_DIR_NORMAL;
    switch (script_st.p[1]) { /* dir */
    case 1: tdir = AR_TRACK_DIR_NORMAL;  break; /* 正方向 */
    case 2: tdir = AR_TRACK_DIR_REVERSE; break; /* 逆方向 */
    }
    switch (script_st.p[0]) { /* track */
    case 1: ar_track1_dir_set(tdir); break; /* トラック1 */
    case 2: ar_track2_dir_set(tdir); break; /* トラック2 */
    }
    break;
  case SCRIPT_STATE_TURNOUT_FETCHED: /* ポイント切替 */
    script_st.state = SCRIPT_STATE_IDLE;
    switch (script_st.p[1]) { /* dir */
    case 1: if_toq_set_normal(script_st.p[0]);  break;
    case 2: if_toq_set_reverse(script_st.p[0]); break;
    }
    break;
  case SCRIPT_STATE_TURNOUT_W_FETCHED: /* ポイント待機 */
    if (if_toq_is_done()) {
      script_st.state = SCRIPT_STATE_IDLE;
    }
    break;
  case SCRIPT_STATE_RUNUNTIL_FETCHED: /* 走行開始 */
    script_st.state = SCRIPT_STATE_RUN_EXEC;
    ar_motor_run_until(script_st.p[0],  /* speed */
                       script_st.p[1],  /* decpi */
                       script_st.p[2],  /* sn-brake */
                       script_st.p[3]); /* sn-stop */
    break;
  case SCRIPT_STATE_RUNTO_FETCHED: /* 走行開始 */
    script_st.state = SCRIPT_STATE_RUN_EXEC;
    ar_motor_run_to(script_st.p[0],  /* speed */
                    script_st.p[1]); /* sn-pass */
    break;
  case SCRIPT_STATE_RUN_EXEC: /* 走行継続 */
    if (!ar_motor_next()) { 
      script_st.state = SCRIPT_STATE_IDLE;
    }
    random_get16();
    break;
  case SCRIPT_STATE_ACCESARY_FETCHED: /* アクセサリ制御 */
    script_st.state = SCRIPT_STATE_IDLE;
    switch (script_st.p[1]) { /* on/off */
    case 0: if_accessary_off(script_st.p[0]); break; /* オフ */
    case 1: if_accessary_on(script_st.p[0]);  break; /* オン */
    }
    break;
  case SCRIPT_STATE_STAY_FETCHED: /* 停止開始(相対時間) */
    script_st.state = SCRIPT_STATE_STAY_EXEC;
    ar_stay_start(script_st.p[0]); /* time (rel) */
    break;
  case SCRIPT_STATE_STAY_ABS_FETCHED: /* 停止開始(絶対時間) */
    script_st.state = SCRIPT_STATE_STAY_EXEC;
    ar_stay_abs_start(script_st.p[0]); /* time (abs) */
    break;
  case SCRIPT_STATE_STAY_EXEC: /* 停止継続 */
    if (!ar_stay_next()) { 
      script_st.state = SCRIPT_STATE_IDLE;
    }
    break;
  }
  return ar_state;
}
