/********************************************************
 * プログラマブル式ポイント一括切替器 / PIC16F18857
 * by Hirotsugu Kakugawa
 ********************************************************/
#include <xc.h>
#include <stdint.h>
#include <stdio.h>
#include "mcr.h"
#include "io.h"
#include "defs.h"
#include "route.h"
#include "action.h"
#include "led7seg.h"
#include "rotenc.h"
#include "fatal.h"
#include "i2c.h"
#include "i2c-mcp23017.h"
#include "mem.h"

/*------------------------------------------------------- 
 * MAIN
 *-------------------------------------------------------*/
void main(void) 
{
  /* システム初期化 */
  System_Init();
  /* 周辺モジュール初期化 */
  I2C_Init(I2C_BAUD_RATE_SSPxADD_1MHZ(_XTAL_FREQ));
  /* ウオッチドッグタイマ初期化: 2 [Sec] */
  WDTCON0bits.WDTPS = 0x0B; /* 0b01011 */
  CLRWDT();
  /* LED表示初期化 */
  led7seg_init();
  /* 割込許可 */
  GIE = 1;
  PEIE = 1;
  /* I2C EEPROMメモリの接続を確認 */
  __delay_ms(100);
  CLRWDT();
  if (!mem_probe_device()) { 
    fatal(ERR_NO_MEMORY); /* EEPROM非存在 */
  }
  mem_init(MEM_TYPE_24FC64);
  /* EEPROM中の経路登録情報の検査 */
  route_read(ACTION_VALIDATE, ROUTE_ID_NULL);
  /* ポイントインターフェースボードを探索 */
  if (action_probe_device() == 0) {
    fatal(ERR_NO_MCP20317); /* ポイントインターフェースボード非存在 */
  }
  /* 切替制御部初期化 */
  action_init();
  /* 経路番号初期化 */
  uint16_t route_id = 0;
  display_number(route_id);
  /* 主ループ */
  for (;;) {
    CLRWDT();
    /* ロータリーエンコーダ入力(経路番号選択) */
    __delay_us(200);
    int8_t d = rotenc_scan();
    if (d != 0) {
      /* 入力あり */
      if (d > 0) { /* 1増加 */
        if (route_id >= n_routes) {
          route_id = 0;
        } else {
          route_id++;
        }
      } else if (d < 0) { /* 1減少 */
        if (route_id == 0) {
          route_id = n_routes;
        } else {
          route_id--;
        }
      }
      /* 表示更新 */
      display_number(route_id);
    }
    /* 動作: 切替を行うポイント番号を表示 (切替は実行しない) */
    if (SW_ROUTE_DISP()) {
      if (route_id != 0) {
        led7seg_display_const("  ");
        CLRWDT();
        __delay_ms(1000);
        route_read(ACTION_DISPLAY, route_id);
        led7seg_display_const("  ");
        CLRWDT();
        __delay_ms(1000);
        display_number(route_id);
      }
      while (SW_ROUTE_DISP()) {
        CLRWDT();
      }
    }
    /* 動作: ポイント切替を実行 */
    if (SW_ROUTE_EXEC()) { 
      CLRWDT();
      led7seg_display_const("  ");
      __delay_ms(500);
      if (route_id != 0) {
        /* 指定経路番号のポイント切替 */
        route_read(ACTION_OPERATION, route_id);
      } else {
        /* 全ポイントを定位へ */
        action_exec_all_normal();
      }
      CLRWDT();
      led7seg_display_const("  ");
      __delay_ms(500);
      display_number(route_id);
      while (SW_ROUTE_EXEC()) {
        CLRWDT();
      }
    }
  }
}

/* 7セグメントLEDに数値を表示 */
void display_number(uint16_t n)
{
  char str[8];
  sprintf(str, "%02d", n);
  led7seg_display(str);
}

/* 7セグメントLEDに経路番号と分岐方向を表示 */
void display_turnout_and_dir(uint16_t p,
                             enum turnout_dir_e tdir)
{
  char strp[8];
  char strx[8];
  uint8_t i = 0; 
  uint8_t j = 0; 
  switch (tdir) {
  default:
  case TURNOUT_DIR_NORMAL:
    /* 定位は小数点の消灯により表す*/
    sprintf(strx, "%02d", p);
    break;
  case TURNOUT_DIR_REVERSE:
    /* 反位は小数点の点灯により表す*/
    sprintf(strp, "%02d", p);
    for (i = 0; strp[i] != '\0'; i++) {
      strx[((unsigned)i << 1) + 0] = strp[i];
      strx[((unsigned)i << 1) + 1] = '.';
    }
    break;
  }
  led7seg_display(strx);
}
