/***********************************************
 * モータ式ポイント切替コントローラ / PIC16F18313
 * by Hirotsugu Kakugawa
 ************************************************/
/* 
 * 対象：自己停止形DCモータ式 - Fulgrex等
 * 
 * ※ソレノイド式(Kato, Tomix, Peco 等)には使用禁止
 *   (コイル焼損となる)
 */
#include <xc.h>
#include <stdint.h>
#include "mcr.h"
#include "io.h"
#include "turnout.h"

/* (擬似)切替完了時間 [サイクル数] */
#define T_TO_FINISH  300 

/* 有限状態機械(開通方向出力制御用) */
enum e_state {
  STATE_IDLE = 0,   /* 待機中 */
  STATE_A,          /* 定位へ切替動作中 */
  STATE_B,          /* 反位へ切替動作中 */
};

void move_to_a(void);
void move_to_b(void);

/*------------------------------------------------------- 
 * MAIN
 *-------------------------------------------------------*/
void main(void)
{
  /* システム初期化 */
  System_Init();
  /* モーター出力の初期化 */
  OUT_TURNOUT_A_OFF();
  OUT_TURNOUT_B_OFF();
  /* 開通方向出力 */
  OUT_OD_DIR_A_LOW(); /* 定位: 非開通 */
  OUT_OD_DIR_B_LOW(); /* 反位: 非開通 */
  /* リセット要因がウオッチドックタイマなら, 
   * 安全性のため無限ループに入る. (ソフトウエアの重大バク、
   * またはハードウエア障害と考えられるため.) */
  if (STATUSbits.nTO == 0) {
    for (;;) {
      ;
    }
  }
  /* ウオッチドッグタイマ初期化: 512 [mSec] */
  WDTCONbits.WDTPS = 0x09; /* 0b01001 */
  CLRWDT();
  /* 入力(=SWあるいは他機器の出力)の安定を待機 (1[Sec]) */
  uint8_t t_wakeup = 100;
  while (t_wakeup != 0) { 
    t_wakeup--;
    __delay_ms(10);
    CLRWDT();
  }
  /* 切替完了残り予想時間 */
  uint16_t t = 0;
  /* 入力状態の初期化 */
  instate_init();
  /* 開通方向出力制御の状態 */
  enum e_state state = STATE_IDLE;
  /* 主ループ */
  for (;;) {
    __delay_ms(T_CYCLE);
    CLRWDT();
    /* ポイント制御入力を読む */
    enum e_movereq movereq = instate_next();
    /* 開通方向出力の制御 */
    switch (state) {
    case STATE_IDLE:   /* 待機中 */
      switch (movereq) {
      case MOVEREQ_NONE:
        break;
      case MOVEREQ_A: /* 定位への切替要求 */ 
        state = STATE_A;
        t = T_TO_FINISH;
        move_to_a();
        break;
      case MOVEREQ_B: /* 反位への切替要求 */ 
        state = STATE_B;
        t = T_TO_FINISH;
        move_to_b();
      }
      break;
    case STATE_A: /* 定位へ切替動作中 */
      /* タイマ */
      t = t - 1;
      if (t == 0) { /* 切替完了 */
        state = STATE_IDLE;
        /* 開通方向出力 */
        OUT_OD_DIR_A_Z();   /* 定位: 開通 */
        OUT_OD_DIR_B_LOW(); /* 反位: 非開通 */
      } else {      /* 切替中 */ 
        switch (movereq) {
        case MOVEREQ_NONE:
          break;
        case MOVEREQ_A: /* 定位への切替要求 */ 
          break;
        case MOVEREQ_B: /* 反位への切替要求 */ 
          state = STATE_B;
          t = T_TO_FINISH;
          move_to_b();
          break;
        }
      }
      break;
    case STATE_B: /* 反位へ切替動作中 */
      /* タイマ */
      t = t - 1;
      if (t == 0) { /* 切替完了 */
        state = STATE_IDLE;
        OUT_OD_DIR_A_LOW(); /* 定位: 非開通 */
        OUT_OD_DIR_B_Z();   /* 反位: 開通 */
      } else {      /* 切替中 */
        switch (movereq) {
        case MOVEREQ_NONE:
          break;
        case MOVEREQ_A: /* 定位への切替要求 */ 
          state = STATE_A;
          t = T_TO_FINISH;
          move_to_a();
          break;
        case MOVEREQ_B: /* 反位への切替要求 */ 
          break;
        }
      }
      break;
    }
  }
}

/* 定位に向けて切替動作を開始 */
void move_to_a(void)
{
  /* 開通方向出力 */
  OUT_OD_DIR_A_LOW(); /* 定位: 非開通 */
  OUT_OD_DIR_B_LOW(); /* 反位: 非開通 */
  /* 通電 */
  OUT_TURNOUT_A_ON();
  OUT_TURNOUT_B_OFF();
}

/* 反位に向けて切替動作を開始 */
void move_to_b(void)
{
  /* 開通方向を出力 */
  OUT_OD_DIR_A_LOW(); /* 定位: 非開通 */
  OUT_OD_DIR_B_LOW(); /* 反位: 非開通 */
  /* 通電 */
  OUT_TURNOUT_A_OFF();
  OUT_TURNOUT_B_ON();
}
