/***********************************************
 * 線路電圧極性検出モジュール / PIC16F18326
 * by Hirotsugu Kakugawa
 ************************************************/
#include <xc.h>
#include <stdint.h>
#include "mcr.h"
#include "io.h"

/* ----------------------------------------------------- */

/* 電圧検出 */
enum vdet_e {
  VDET_FWD = 0,  /* 順方向(右プラス) */
  VDET_REV,      /* 逆方向(左プラス) */
  VDET_MAX
};

/* 線路電圧極性の検出状態 */
struct detect_state_s {
  int8_t   detected; /* 線路電圧検出有り */ 
  uint8_t  hyscnt;   /* ヒステリシス特性用カウンタ */
};

/* 状態変化のヒステリシス特性実現用の定数 */
#define HYS_THRESHOLD      4

/* 検出状態 */
struct detect_state_s detect_state[VDET_MAX];

void detect_state_init(enum vdet_e vd);
void detect_state_read(enum vdet_e vd);

/*------------------------------------------------------- 
 * MAIN
 *-------------------------------------------------------*/

void main(void) 
{
  /* システム初期化 */
  System_Init();
  /* ウオッチドッグタイマ 256 [mSec] typ. */
  WDTCONbits.WDTPS = 0b01000;
  CLRWDT();
  /* 初期化 */
  detect_state_init(VDET_FWD);
  detect_state_init(VDET_REV);
  /* 主ループ */
  for (;;) {
    __delay_ms(25);
    CLRWDT();
    /* 線路電圧の読取 */
    detect_state_read(VDET_FWD);
    detect_state_read(VDET_REV);
    /* 出力値決定(検出モードに従う) */
    int8_t det_fwd = 0; /* 順方向(右プラス)を検出 */
    int8_t det_rev = 0; /* 逆方向(左プラス)を検出 */
    if (CONF_SW_MODESEL_CONSERVATIVE()) {
      /* 保守的判断: 正極性を検出したときのみ */
      det_fwd = detect_state[VDET_FWD].detected;
      det_rev = detect_state[VDET_REV].detected;
    } else {
      /* 楽観的判断: 逆極性を検出しないときのみ */
      det_fwd = !detect_state[VDET_REV].detected; 
      det_rev = !detect_state[VDET_FWD].detected;
    }
    /* 検出結果の出力 */
    if (CONF_SW_OUT_NONINV()) { /* 非反転出力 */
      if (det_fwd) {
        OUT_FWD_LOW();
      } else {
        OUT_FWD_HIZ();
      }
      if (det_rev) {
        OUT_REV_LOW();
      } else {
        OUT_REV_HIZ();
      }
    } else {                   /* 反転出力 */
      if (det_fwd) {
        OUT_FWD_HIZ();
      } else {
        OUT_FWD_LOW();
      }
      if (det_rev) {
        OUT_REV_HIZ();
      } else {
        OUT_REV_LOW();
      }
    }
  }
}

/* 検出状態初期化 */
void detect_state_init(enum vdet_e vd)
{
  detect_state[vd].detected = 0; 
  detect_state[vd].hyscnt = 0;
}

/* 検出状態更新 */
void detect_state_read(enum vdet_e vd)
{
  /* コンパレータ出力の読取 */
  int8_t det = 0;
  switch (vd) {
  default:
  case VDET_FWD:
    det = CMP_FWD_DETECTED();
    CMP_FWD_CLEAR();
    break;
  case VDET_REV:
    det = CMP_REV_DETECTED();
    CMP_REV_CLEAR();
    break;
  }
  /* 検出状態の更新 (ヒステリシス特性) */
  switch (detect_state[vd].detected) {
  default:
  case 0: /* 現在出力: 電圧検出なし */
    if (!det) { /* 電圧検出なし */
      detect_state[vd].hyscnt = HYS_THRESHOLD;
    } else {    /* 電圧検出あり */
      if (detect_state[vd].hyscnt != 0) {
        detect_state[vd].hyscnt--;
      } else { /* 出力切替 */
        detect_state[vd].detected = 1;
        detect_state[vd].hyscnt = HYS_THRESHOLD;
      }
    }
    break;
  case 1: /* 現在出力: 電圧検出あり */
    if (det) { /* 電圧検出あり */
      detect_state[vd].hyscnt = HYS_THRESHOLD;
    } else {   /* 電圧検出なし */
      if (detect_state[vd].hyscnt != 0) { /* ヒステリシス特性 */
        detect_state[vd].hyscnt--;
      } else { /* 出力切替 */
        detect_state[vd].detected = 0;
        detect_state[vd].hyscnt = HYS_THRESHOLD;
      }
    }
    break;
  }
}
