/*------------------------------------------------------- 
 * 切替制御部
 *-------------------------------------------------------*/
#include <xc.h>
#include <stdint.h>
#include <stdio.h>
#include "mcr.h"
#include "io.h"
#include "defs.h"
#include "action.h"
#include "route.h"
#include "i2c.h"
#include "i2c-mcp23017.h"
#include "led7seg.h"

/* ポイントインターフェースボード(MCP23017)の接続の有無 */
uint8_t io_module_table[MAX_IO_MODULE];
/* ポイントインターフェースボード接続数 */
uint8_t io_nmodules = 0;

/* MCP23017のポートの出力値 */
static uint8_t gpa[MAX_IO_MODULE];
static uint8_t gpb[MAX_IO_MODULE]; 

/* ポイントインターフェースボードの接続を確認 */
uint8_t action_probe_device(void)
{
  io_nmodules = 0;
  /* 各アドレスに対して接続を確認 */
  uint8_t caddr = 0;
  for (caddr = 0; caddr < MAX_IO_MODULE; caddr++) {
    CLRWDT();
    io_module_table[caddr] = 0;
    if (I2C_Exist(I2C_MCP23017_CTLBYTE, caddr)) { /* 存在確認 */
      io_module_table[caddr] = 1;
      io_nmodules++;
    }
  }
  return io_nmodules;
}

/* 切替状態の初期化 */
void action_init(void)
{
  uint8_t caddr = 0;
  for (caddr = 0; caddr < MAX_IO_MODULE; caddr++) {
    CLRWDT();
    gpa[caddr] = 0x00;
    gpb[caddr] = 0x00;
    if (io_module_table[caddr] != 0) {
      /* MCP23017初期化 */
      i2c_mcp23017_init(caddr);
      i2c_mcp23017_a_write(caddr, gpa[caddr]);
      i2c_mcp23017_b_write(caddr, gpb[caddr]);
      i2c_mcp23017_a_dir_set(caddr, 0x00);
      i2c_mcp23017_b_dir_set(caddr, 0x00);
    }
  }
}

/* 全ポイントを定位へ切替 */
void action_exec_all_normal(void)
{
  uint8_t p = 1;
  for (p = 1; p <= MAX_N_TURNOUTS; p++) {
    /* まず反位に切替し, 次に定位に切替 */
    action_exec(ACTION_OPERATION, p, TURNOUT_DIR_REVERSE);
    action_exec(ACTION_OPERATION, p, TURNOUT_DIR_NORMAL);
  }
}

/* 切替実行 (実際の動作は引数 act で選択) */
void action_exec(enum action_e act,
                 uint16_t p,
                 enum turnout_dir_e tdir)
{
  uint8_t g = (unsigned)p - 1;  /* p=1,2,3,... => g=0,1,2,... */
  uint8_t caddr = ((unsigned)g >> 3) & 0x07; 
  uint8_t gpio  = (unsigned)g & 0x07;
  const uint8_t bit_mask[4] =    { 0x03, 0x0C, 0x30, 0xC0 };
  const uint8_t bit_normal[4] =  { 0x01, 0x04, 0x10, 0x40 };
  const uint8_t bit_reverse[4] = { 0x02, 0x08, 0x20, 0x80 };
  CLRWDT();
  switch(act) {
  default:
  case ACTION_VALIDATE: /* 検証 */
    break; /* 特に何もしない (常にデータチェックしているため) */
  case ACTION_DISPLAY: /* 表示のみ */
    /* MCP23017の接続の有無に関わらず表示 */
    display_turnout_and_dir(p, tdir);
    __delay_ms(1000);
    break;
  case ACTION_OPERATION: /* 切替実行 */
    /* MCP23017の出力ビットパターンを求める */
    if (gpio < 4) { /* GPIO A */
      uint8_t i = gpio;
      gpa[caddr] &= (unsigned)~bit_mask[i];
      if (tdir == TURNOUT_DIR_NORMAL) {
        gpa[caddr] |= bit_normal[i];
      } else {
        gpa[caddr] |= bit_reverse[i];
      }
    } else {        /* GPIO B */
      uint8_t i = (unsigned)gpio - 4;
      gpb[caddr] &= (unsigned)~bit_mask[i];
      if (tdir == TURNOUT_DIR_NORMAL) {
        gpb[caddr] |= bit_normal[i];
      } else {
        gpb[caddr] |= bit_reverse[i];
      }
    }
    /* MCP23017に出力(該当MCP23017の接続がある場合のみ) */
    if (io_module_table[caddr] != 0) {
      LED_SWITCHING_ON();
      display_turnout_and_dir(p, tdir);
      i2c_mcp23017_a_write(caddr, gpa[caddr]);
      i2c_mcp23017_b_write(caddr, gpb[caddr]);
      __delay_ms(ACTION_OP_TIME);
      LED_SWITCHING_OFF();
    }
    break;
  }
}
