/***********************************************
 * 速度計（通過センサ型）/ PIC16F18857
 * by Hirotsugu Kakugawa
 ************************************************/
#include <xc.h>
#include <stdint.h>
#include <stdio.h>
#include "mcr.h"
#include "adc.h"
#include "io.h"
#include "led7seg.h"
#include "speed-timer.h"
#include "config.h"
#include "defs.h"

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

/* センサ間距離 */
float  sensor_dist_cm  = 0;  /* 距離 [cm] */
char   sensor_dist_cm_str[LED7SEG_STR_SIZ_MAX];

/* 縮尺 */
struct scale_info_s {
  float       value;
  const char *str;
};
const struct scale_info_s scale_info[16] = {
  { 220.0, "220"   }, /* Zスケール */ 
  { 160.0, "160"   }, /* Nスケール(欧米) */
  { 150.0, "150"   }, /* Nゲージ(日) */
  { 148.0, "148"   }, /* Nゲージ(英) */
  { 120.0, "120"   }, /* TTスケール */
  {  87.1,  "87.1" }, /* H0スケール(欧) */
  {  87.0, " 87"   }, /* HOスケール(米) */
  {  80.0, " 80"   }, /* 16番(日) */
  {  76.0, " 76"   }, /* OOゲージ */
  {  64.0, " 64"   }, /* Sスケール */
  {  48.0, " 48"   }, /* 0番/Oスケール(米) */
  {  45.0, " 45"   }, /* 0番(日欧), OJ(日) */
  {  43.5,  "43.5" }, /* 0番/Oスケール(英) */
  {  32.0, " 32"   }, /* 1番(欧米) */
  {  30.5,  "30.5" }, /* 1番(英) */
  {  22.5,  "22.5" }  /* 2番 */
};
float        model_scale     = 0;
const char  *model_scale_str = "";

/*------------------------------------------------------- 
 * MAIN
 *-------------------------------------------------------*/
void main(void) 
{
  /* システム初期化 */
  System_Init();
  /* ウオッチドッグタイマ初期化: 2 [Sec] */
  WDTCON0bits.WDTPS = 0x0B; /* 0b01011 */
  CLRWDT();
  /* LED表示初期化 */
  led7seg_init();
  /* 計時初期化 */
  speed_timer_init();
  /* センサ距離設定ボリュームとスケール選択SWを読む */
  read_sensor_distance();
  read_scale();
  /* 計測のタイムアウト値 */
  uint16_t tmr_max =
    (uint16_t)(1000.0 * TIMEOUT_VALUE / SPEED_TMR_CYCLE);
  /* 割込許可 */
  GIE = 1;
  PEIE = 1;
  /* 設定モード */
  if (SW_CONF_PUSHED()) {
    config_set();
  }
  /* 設定値表示 */
 l_conf_disp:
  config_display();
  /* 主ループ */
 l_restart:
  led7seg_display_const("---");
  for (;;) {
    CLRWDT();
    uint16_t t = 0;
    /* センサ検出待ち */
    uint8_t sns = 0;
    for (;;) {
      CLRWDT();
      if (SENSOR_1_DET()) {
        sns = 1; 
        break;
      } else if (SENSOR_2_DET()) {
        sns = 2; 
        break;
      } 
      if (SW_CLR_PUSHED()) {  /* クリア */
        goto l_restart;
      } 
      if (SW_CONF_PUSHED()) { /* 設定値表示 */
        goto  l_conf_disp;
      } 
    }
    /* 計時開始 */
    uint8_t timeout = 0;
    uint16_t t_prg = 0;
    uint8_t i_prg = 0;
    speed_timer_start();
    for (;;) {
      CLRWDT();
      /* 計時完了の検査 */
      if ((sns == 1) && SENSOR_2_DET()) {
        break;
      } else if ((sns == 2) && SENSOR_1_DET()) {
        break;
      } 
      if (SW_CLR_PUSHED()) {  /* クリア(測定中断) */
        goto l_restart;
      } 
      if (SW_CONF_PUSHED()) { /* 設定値表示(測定中断) */
        goto  l_conf_disp;
      } 
      /* 計時経過時間が長いとタイムアウト */
      uint32_t tmr = speed_timer_read();
      if (tmr > tmr_max) {
        timeout = 1;
        break;
      }
      /* 計時中の LED 表示 */
      uint16_t t_prg_x = tmr >> 7;
      if (t_prg != t_prg_x) {
        t_prg = t_prg_x;
        switch (i_prg) {
        case 0: led7seg_display_const("   ");  i_prg++;
          break;
        case 1: led7seg_display_const("   ."); i_prg++;
          break;
        case 2: led7seg_display_const("  . "); i_prg++;
          break;
        case 3: led7seg_display_const(".  ");  i_prg = 0;
          break;
        }
      }
    }
    /* 計時終了 */
    uint16_t speed_km_h = speed_timer_end();
    /* 速度表示 */
    char speed_str[4];
    if (timeout == 1) {
      speed_km_h = 0;
    }
    sprintf(speed_str, "%3d", speed_km_h);
    for (t = 5; t != 0; t--) {
      CLRWDT();
      led7seg_display(speed_str);
      delay_ms(400);
      if (t != 1) {
        led7seg_display_const("   ");
        delay_ms(100);
      }
    }
    /* 列車編成全体の通過（と推測できるまで）を待つ.
     * 最後にセンサが検出してから十分時間が経過したら, 
     * 列車編成全体の通過したと判断する */
    t = 0;
    while (t != INSENSITIVE_PERIOD) {
      CLRWDT();
      t++;
      delay_ms(1);
      if (SENSOR_1_DET() || SENSOR_2_DET()) {  /* 通過中 */
        t = 0;
      } 
      if (SW_CLR_PUSHED()) {
        goto l_restart;
      } 
      if (SW_CONF_PUSHED()) {
        goto  l_conf_disp;
      } 
    } 
    /* 通過完了のインジケーション */
    for (t = 6; t != 0; t--) {
      CLRWDT();
      led7seg_display_const("   ");
      delay_ms(100);
      led7seg_display(speed_str);
      delay_ms(100);
    }
  }
}

/* センサ間距離の設定値を読み取る */
void read_sensor_distance(void)
{
  adc_val_t sd = ADC_Read(ADC_CH_SDIST);
  sensor_dist_cm = 5.0 + (45.0 * (float)sd / 1024.0);
  sprintf(sensor_dist_cm_str, "%4.1f", sensor_dist_cm);
}

/* スケールの設定値を読み取る */
void read_scale(void)
{
  uint8_t scale_selector = 0;
  if (SW_SCALE_1_ON()) {
    scale_selector += 0x01;
  }
  if (SW_SCALE_2_ON()) {
    scale_selector += 0x02;
  }
  if (SW_SCALE_3_ON()) {
    scale_selector += 0x04;
  }
  if (SW_SCALE_4_ON()) {
    scale_selector += 0x08;
  }
  model_scale     = scale_info[scale_selector].value;
  model_scale_str = scale_info[scale_selector].str;
}

void delay_ms(uint16_t t)
{
  while (t != 0) {
    t--;
    CLRWDT();
    __delay_ms(1);
  }
}
