/*------------------------------------------------------- 
 * ポイント切替動作キュー
 *-------------------------------------------------------*/
#include <xc.h>
#include <stdint.h>
#include "mcr.h"
#include "io.h"
#include "if.h"
#include "if-toq.h"

/* 切替動作キュー */
struct if_toq_s {
  if_to_id              p;
  enum if_turnout_dir_e d;
};
static struct if_toq_s queue[IF_MAX_TURNOUTS];
static uint8_t qnitems = 0;
static uint8_t qhead = 0;
static uint8_t qtail = 0;

/* 切替間隔タイマ */
static uint16_t sw_tmr = 0;

/*-------------------------------------------------------
 * 初期化
 *-------------------------------------------------------*/
void if_toq_init(void)
{
  /* 切替動作キュー初期化 */
  qnitems = 0;
  qhead = 0;
  qtail = 0;
  sw_tmr = 0;
  /* インターフェースボード初期化 */
  if_turnout_init();
}

/*-------------------------------------------------------
 * 切替動作のエンキュー 
 *-------------------------------------------------------*/

static void if_toq_set(if_to_id p,
                       enum if_turnout_dir_e d)
{
  if (qnitems == IF_MAX_TURNOUTS) {
    return; /* 失敗(満杯) */
  }
  qnitems++;
  queue[qhead].p = p;
  queue[qhead].d = d;
  qhead++;
  if (qhead == IF_MAX_TURNOUTS) {
    qhead = 0;
  }
}

void if_toq_set_normal(if_to_id p)
{
  if_toq_set(p, TURNOUT_DIR_NORMAL);
}

void if_toq_set_reverse(if_to_id p)
{
  if_toq_set(p, TURNOUT_DIR_REVERSE);
}

/*-------------------------------------------------------
 * 切替動作の設定(全ポイント) 
 *-------------------------------------------------------*/

static void if_toq_set_all(enum if_turnout_dir_e d)
{
  if_to_id p = 1;
  for (p = 1; p <= IF_MAX_TURNOUTS; p++) {
    if_toq_set(p, d);
  }
}

void if_toq_set_all_normal(void)
{
  if_toq_set_all(TURNOUT_DIR_NORMAL);
}

void if_toq_set_all_reverse(void)
{
  if_toq_set_all(TURNOUT_DIR_REVERSE);
}

/*-------------------------------------------------------
 * 切替動作はすべて完了したか否か 
 *-------------------------------------------------------*/
int8_t if_toq_is_done(void)
{
  return (qnitems == 0);
}

/*-------------------------------------------------------
 * 切替動作をデキューして実行 
 *-------------------------------------------------------*/
int8_t if_toq_next(uint16_t tcyc)
{
  /* 前回の切替から一定時間以上が経過したか */
  if (sw_tmr < IF_TURNOUT_TIME) { /* していない */
    sw_tmr += tcyc;
  } else {                        /* した */
    if (if_toq_is_done()) { /* すべて完了 */
      return 0; /* 次はない */
    } else {                    /* 次の切替を行う */
      /* インターフェースボード接続あり: 実際に切替動作の完了を待機 */
      /* インターフェースボード接続なし: 待機せずに次の切替へ */
      qnitems--;
      if (if_turnout_action(queue[qtail].p, queue[qtail].d)) { 
        sw_tmr = 0; 
      }
      qtail++; 
      if (qtail == IF_MAX_TURNOUTS) {
        qtail = 0;
      }
    }
  }
  return 1; /* 次がある */
}
