/***********************************************
 * プログラマブル自動列車運転システム / PIC16F18877
 * by Hirotsugu Kakugawa
 ************************************************/
#include <xc.h>
#include <stdint.h>
#include "mcr.h"
#include "mcr-motor.h"
#include "io.h"
#include "pp.h"
#include "pp-const.h"
#include "pp-sb.h"
#include "ar.h"

enum op_pattern_e op_pattern = OPPAT_UNDEF;
extern void script_init(void);
extern void manual_run_start(void);
static void op_pattern_read(void);
static void test_if_board(void);

/*------------------------------------------------------- 
 * MAIN
 *-------------------------------------------------------*/
void main(void)
{
  /* システム初期化 */
  System_Init();
  /* ウオッチドッグタイマ: 256 [mSec] */
  WDTCON0bits.WDTPS = 0x08; /* 0b01000 */
  CLRWDT();
  /* モータ出力初期化, PWM動作開始 */
  MOTOR_DIR_NONE();
  MOTOR_PWM_START();
  /* 低速ブースト初期化 */ 
  pp_sb_init();
  pp_sb_duty_set(0);
  /* インターフェースモジュール初期化 */
  pp_delay_ms(100);
  CLRWDT();
  if_init();
  CLRWDT();
  /* 走行パターン */
  op_pattern_read();
  /* 自動運転初期化 */
  auto_run_init();
  /* 割り込み許可 */ 
  GIE = 1;
  PEIE = 1;
  /* LED */
  LED_RUN_OFF();
  LED_IDLE_OFF();
  LED_SENS_OFF();
  /* DIP SW */
  switch (op_pattern) {
  default:
    break;
  case OPPAT_TEST_IF_BOARD: /* インターフェースボードのテスト */
    test_if_board();
    break;
  case OPPAT_EEPROMSCRIPT:
    script_init(); /* スクリプト実行機構初期化 */
    break;
  }
  /* 主ループ */
  for (;;) {
    CLRWDT();
    /* 停止 */
    pp_sb_duty_set(0);
    /* モーター＆常点灯Off */
    ar_motor_off(); 
    /* アクセサリ制御出力を全てオフ */
    if_accessary_off_all();
    /* 全ポイント切替完了待ち */
    while (if_toq_next(RUN_INTERVAL)) {
      pp_delay_ms(RUN_INTERVAL);
      CLRWDT();
    }
    /* 操作モード選択 */
    if (SW_MODE_AUTO()) { /* 自動運転 */
      auto_run_start();
    } else {              /* 手動運転 */
      manual_run_start();
    }
    pp_delay_ms(100); 
  }
}

/*-------------------------------------------------------
 * 速度ボリュームの定位置復帰を待機 
 *-------------------------------------------------------*/
void pp_home_position(void)
{
  while (!SW_MODE_AUTO()) { /* 手動 */
    CLRWDT();
    /* ボリューム読み込み */ 
    pp_param_read();
    if (p_speed == 0) { /* 定位置へ復帰 */
      break;
    }
    /* 未復帰: LEDを点滅 */
    LED_RUN_TOGGLE();
    pp_delay_ms(T_LED_WARNING);
  }
  LED_RUN_OFF();
}

/*-------------------------------------------------------
 * 走行パターン (設定 DIP-SW より)
 *-------------------------------------------------------*/
static void op_pattern_read(void)
{
  static const enum op_pattern_e oppat_table[16] = {
    /* DIP-SW設定              (SW1,SW2,SW3,SW4) */
    OPPAT_SHUTTLE,       /*  0 (OFF,OFF,OFF,OFF) */
    OPPAT_ENDLESS,       /*  1 (ON, OFF,OFF,OFF) */
    OPPAT_REVERSE,       /*  2 (OFF,ON, OFF,OFF) */
    OPPAT_UNDEF,         /*  3 (ON, ON, OFF,OFF) */
    OPPAT_UNDEF,         /*  4 (OFF,OFF,ON, OFF) */
    OPPAT_UNDEF,         /*  5 (ON, OFF,ON, OFF) */
    OPPAT_UNDEF,         /*  6 (OFF,ON, ON, OFF) */
    OPPAT_UNDEF,         /*  7 (ON, ON, ON, OFF) */
    OPPAT_UNDEF,         /*  8 (OFF,OFF,OFF,ON ) */
    OPPAT_UNDEF,         /*  9 (ON, OFF,OFF,ON ) */
    OPPAT_UNDEF,         /* 10 (OFF,ON, OFF,ON ) */
    OPPAT_UNDEF,         /* 11 (ON, ON, OFF,ON ) */
    OPPAT_UNDEF,         /* 12 (OFF,OFF,ON, ON ) */
    OPPAT_UNDEF,         /* 13 (ON, OFF,ON, ON ) */
    OPPAT_TEST_IF_BOARD, /* 14 (OFF,ON, ON, ON ) */
    OPPAT_EEPROMSCRIPT   /* 15 (ON, ON, ON, ON ) */
  };
  int8_t s1 = SW_OPPAT_1();
  int8_t s2 = SW_OPPAT_2();
  int8_t s3 = SW_OPPAT_3();
  int8_t s4 = SW_OPPAT_4();
  int8_t n = (s1 + (s2 << 1) + (s3 << 2) + (s4 << 3)) & 0x0F;
  op_pattern = oppat_table[(unsigned)n];
}

/* インターフェースボードのテスト */
static void test_if_board(void)
{
  for (;;) {
    CLRWDT();
    /* ポイント制御出力 */
    uint8_t p = 0;
    for (p = 1; p <= IF_MAX_TURNOUTS; p++) {
      /* 反位 */
      if_toq_set_reverse(p);
      while (!if_toq_is_done()) {
        pp_delay_ms(RUN_INTERVAL);
        CLRWDT();
        if_toq_next(RUN_INTERVAL);
      }
      /* 定位 */
      if_toq_set_normal(p);
      while (!if_toq_is_done()) {
        pp_delay_ms(RUN_INTERVAL);
        CLRWDT();
        if_toq_next(RUN_INTERVAL);
      }
    }
    /* アクセサリ制御出力 */
    uint8_t ac = 0;
    for (ac = 1; ac <= IF_MAX_ACCESSARIES; ac++) {
      /* オン */
      if (if_accessary_on(ac)) {
        pp_delay_ms(200);
      }
      /* オフ */
      if (if_accessary_off(ac)) {
        pp_delay_ms(200);
      }
    }
  }
}
