/***********************************************
 * タイマ動作型の色灯式信号機（2~6灯）/ PIC16F18346
 * by Hirotsugu Kakugawa
 ************************************************/
#include <xc.h>
#include <stdint.h>
#include "mcr.h"
#include "adc.h"
#include "io.h"
#include "aspect.h"
#include "light-fsm.h"
#include "led.h"
#include "incr-exp.h"

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

/* 周期実行間隔: 25 [mSec] (=1/40 [Sec]) */
#define RUN_INTERVAL_MSEC  25

/* フリッカー点灯での点滅間隔: 15 (15*2*25=0.75) */
/*   点滅回数は 80 [回/分] = 80/60 [回/Sec] なので
 *   1周期は 60/80 = 0.75 [Sec] */
#define FLICKER_INTERVAL   15

/* スイッチで選択した信号の灯式の番号 
 * (aspect_patterns[i][j]の添字i) */
uint8_t ap_number = 0;

/* タイマ動作に基づく信号の現示 
 * (aspect_patterns[i][j]の添字j) */
uint8_t ap_index = 0;

/* 実際の表示内容 (ap_indexに強制停止現示やフリッカーを加味) */
uint8_t displayed_lpi = 0;

static uint8_t  sw_aspect_pattern_number(void);
static void     flush_led(void);
static uint16_t get_aspect_change_interval(void);

/*------------------------------------------------------- 
 * MAIN
 *-------------------------------------------------------*/
void main(void) 
{
  /* システム初期化 */
  System_Init();
  /* ウオッチドッグタイマ初期化: 2 [Sec] */
  WDTCONbits.WDTPS = 0x0B; /* 0b01011 */
  CLRWDT();
  /* 現示切替タイマ(切替までの残り周期回数) */
  uint16_t timer_aspect = 0;
  /* フリッカー点灯用タイマ(切替までの残り周期回数) */
  uint8_t  timer_flikcer = 0;
  /* フリッカー点灯状態 (0: 消灯, 1: 点灯) */
  int8_t   state_flicker = 0;
  /* 信号の灯式の番号(スイッチでの選択)読み取り */ 
  for (;;) {
    ap_number = sw_aspect_pattern_number();
    /* 登録済みの現示パターンとなるまではLED点滅してエラー表示 */
    if (ap_number < ASPECT_N_PATTERNS) {
      break;
    }
    flush_led();
  } 
  /* 全LEDをGPIO制御で消灯 */
  led_gpio_set(0x00);
  led_pwm_steer_mode_set(0x00);  
  led_gpio_set(0x00);
  /* ライト輝度制御用の状態機械を初期化 */
  light_fsm_init();
  /* 「進行」現示のap_indexを探す (LIGHT_END印) */
  ap_index = 0; 
  while ((aspect_patterns[ap_number][ap_index]
          & LIGHT_END) == 0) {
    ap_index++;
  }
  displayed_lpi = ap_index;
  /* 進行現示 */
  led_gpio_set(aspect_patterns[ap_number][displayed_lpi]);
  /* 主ループ */
  for (;;) {
    __delay_ms(RUN_INTERVAL_MSEC);
    CLRWDT();
    /* 信号の灯式の番号の変更があればリセットして再始動 */ 
    if (ap_number != sw_aspect_pattern_number()) {
      RESET();
    }
    /* センサによる車両検出 */
    if (CAR_DETECT_PORT() || CAR_DETECT_IOC()) {
      CAR_CLEAR_IOC();
      /* 現示を「停止」に変更 */
      ap_index = AP_INDEX_RED;
      /* 次の現示切替の時間にむけて時間計測開始 */
      timer_aspect = get_aspect_change_interval();
    }
    /* 現示を一定時間間隔で切替 */
    if ((aspect_patterns[ap_number][ap_index] & LIGHT_END) == 0) {
      if (timer_aspect != 0) {
        timer_aspect--;
      } else { /* 現示切替実行 */ 
        /* 次の現示に変更 */
        ap_index++;
        /* フリッカー現示用の状態機械の制御 */
        if ((aspect_patterns[ap_number][ap_index]
             & LIGHT_FLICKER) != 0) {
          /* フリッカ点灯用を開始 */
          state_flicker = 1;
          timer_flikcer = FLICKER_INTERVAL;
        }
        /* 次の現示切替の時に向けて時間計測を再始動 */
        timer_aspect = get_aspect_change_interval();
      }
    }
    /* 次の表示内容を displayed_lpi_next に求める */
    uint8_t displayed_lpi_next = ap_index;
    /* フリッカー処理  */
    if (timer_flikcer != 0) {
      timer_flikcer--;
    } else {
      /* 点灯状態の切替 */
      state_flicker = 1 - state_flicker; /* 0 <-> 1 */
      timer_flikcer = FLICKER_INTERVAL;
    }
    if (((aspect_patterns[ap_number][displayed_lpi_next] 
          & LIGHT_FLICKER) != 0) && 
        (state_flicker == 0)) {
      /* 消灯 */
      displayed_lpi_next = AP_INDEX_ALL_OFF;
    } 
    /* 強制停止現示 (出発禁止,ポイント不開通等) */
    if (FORCE_RED()) {
      /* 「停止」を現示 */
      displayed_lpi_next = AP_INDEX_RED;
    }
    /* ライト輝度制御用の状態機械 */
    if (light_fsm_is_idle() && 
        (displayed_lpi != displayed_lpi_next)) {
      /* 現在の点灯から変更有: 表示変更を開始 */
      light_fsm_start(displayed_lpi, displayed_lpi_next);
      displayed_lpi = displayed_lpi_next;
    }
    /* 現示切替/輝度制御用の状態機械 */
    if (SW_LIGHT_MODE_BULB()) { /* 電球(BULB)風 */
      light_fsm_bulb_run();
    } else {                    /* LED風 */
      light_fsm_led_run();
    }
  }
}

/*------------------------------------------------------- 
 * 信号現示パターン選択用の設定スイッチを読む
 *-------------------------------------------------------*/
static uint8_t sw_aspect_pattern_number(void)
{
  uint8_t apn = 0;
  /* 設定スイッチそれぞれの重みを加算 */
  if (SW_PATTERN_NUMBER_1()) {
    apn += 1;
  }
  if (SW_PATTERN_NUMBER_2()) {
    apn += 2;
  }
  if (SW_PATTERN_NUMBER_3()) {
    apn += 4;
  }
  if (SW_PATTERN_NUMBER_4()) {
    apn += 8;
  }
  return apn;
}

/* LEDを1回点滅(エラー表示用) */
static void flush_led(void)
{
  led_pwm_steer_mode_set(0x00);
  CLRWDT();
  led_gpio_set(0x3F); /*点灯*/
  __delay_ms(900); 
  led_gpio_set(0x00); /*消灯*/
  __delay_ms(100); 
}

/*------------------------------------------------------- 
 * 現示切替の時間間隔をボリューム設定より得る
 *   タイマの1周期が1単位時間   
 *-------------------------------------------------------*/
static uint16_t get_aspect_change_interval(void)
{
  /* 現示切替時間の計算 
   *    タイマ1周期 T = RUN_INTERVAL = 25 [mSec]
   *   (40 + x/2) * T [mSec],  0 <= x <= 1023
   *     = 1.0 [Sec]  ..  13.8 [Sec] 
   */
  uint16_t t = ADC_Read(ADC_CH_TIME);
  return (uint16_t) 40 + (t >> 1);
}
