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

/* ソレノイドに電流を流す期間 */
#define T_ON         5   /* [サイクル数] */
/* 通電期間１サイクルの重み(コイル加熱防止用) */
#define H_W         10
/* 通電期間重みの蓄積上限値(コイル加熱防止用) */
#define H_MAX      500 
/* 切替禁止期間(コイル加熱防止用) */
#define T_COOL    1000   /* [サイクル数] */

/* 有限状態機械(通電時間制御用) */
enum e_state {
  STATE_IDLE = 0,   /* 待機状態 */
  STATE_ON,         /* 通電状態 */
  STATE_COOL,       /* 冷却状態 */
};

/*------------------------------------------------------- 
 * 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] typ.) */
  WDTCONbits.WDTPS = 0b01001;
  CLRWDT();
  /* 入力(=SWあるいは他機器の出力)の安定を待機 (1[Sec]) */
  uint8_t t_wakeup = 100;
  while (t_wakeup != 0) { 
    t_wakeup--;
    __delay_ms(10);
    CLRWDT();
  }
  /* 制御状態の初期化 */
  enum e_state state     = STATE_IDLE;
  enum e_turnout_dir dir = TURNOUT_DIR_NONE;
  uint16_t t_on   = 0;  /* 通電残り時間 */
  uint16_t t_cool = 0;  /* 冷却残り時間 */
  uint16_t heat = 0;  /* 通電による熱の量 */
  /* 入力状態の初期化 */
  instate_init();
  /* 主ループ */
  for (;;) {
    __delay_ms(T_CYCLE);
    /* (ここでウオッチドッグタイマはクリアしない) */
    /* ポイント切替のための有限状態機械 */
    switch (state) {
    case STATE_IDLE: /* 待機状態 */
      CLRWDT();
      OUT_TURNOUT_A_OFF();
      OUT_TURNOUT_B_OFF();
      if (heat != 0) {
        heat--;
      }
      /* ポイント制御入力を読む */
      enum e_movereq movereq = instate_next();
      /* ポイント切替要求 */ 
      switch (movereq) {
      default:
      case MOVEREQ_NONE:
        break;
      case MOVEREQ_A: /* 定位への切替要求 */ 
        state = STATE_ON;
        dir = TURNOUT_DIR_A;
        /* 開通方向を出力(双方向非開通) */
        OUT_OD_DIR_A_LOW();
        OUT_OD_DIR_B_LOW();
        /* 通電開始 */
        OUT_TURNOUT_A_ON();
        OUT_TURNOUT_B_OFF();
        t_on = T_ON;
        break;
      case MOVEREQ_B: /* 反位への切替要求 */ 
        state = STATE_ON;
        dir = TURNOUT_DIR_B;
        /* 開通方向を出力(双方向非開通) */
        OUT_OD_DIR_A_LOW();
        OUT_OD_DIR_B_LOW();
        /* 通電開始 */
        OUT_TURNOUT_A_OFF();
        OUT_TURNOUT_B_ON();
        t_on = T_ON;
        break;
      }
      break;
    case STATE_ON: /* 通電状態 */
      if (t_on != 0) { /* 通電の継続 */
        t_on = t_on - 1; /* 残り時間 */
        heat = heat + H_W; /* 通電蓄積時間 */
      } else {      /* 通電の終了 */
        CLRWDT();
        state = STATE_IDLE;
        OUT_TURNOUT_A_OFF();
        OUT_TURNOUT_B_OFF();
        /* 開通方向を出力 */
        if (dir == TURNOUT_DIR_A) {
          OUT_OD_DIR_A_Z();
          OUT_OD_DIR_B_LOW();
        } else if (dir == TURNOUT_DIR_B) {
          OUT_OD_DIR_A_LOW();
          OUT_OD_DIR_B_Z();
        }
        /* 必要に応じて冷却期間に入る */
        if (heat >= H_MAX) {
          /* 通電蓄積時間が一定値を超過: 冷却状態へ */
          state = STATE_COOL;
          t_cool = T_COOL;
          heat = 0;
        }
      }
      break;
    case STATE_COOL: /* 冷却状態 */
      CLRWDT();
      if (t_cool != 0) { /* 冷却期間の継続 */
        t_cool--; /* 残り時間 */
      } else {           /* 冷却期間の終了 */
        state = STATE_IDLE;
      }
      break;
    }
  }
}
