/*------------------------------------------------------- 
 * インターフェースモジュール
 *-------------------------------------------------------*/
#include <xc.h>
#include <stdint.h>
#include "mcr.h"
#include "io.h"
#include "ar.h"
#include "fatal.h"
#include "if-toq.h"
#include "if.h"
#include "i2c.h"
#include "i2c-mcp23017.h"

/* インターフェースボードの接続の有無 */
uint8_t if_module[IF_MAX_MODULES];
/* ポートA,ポートBの書き込み値 */
uint8_t if_wr_gpa[IF_MAX_MODULES];
uint8_t if_wr_gpb[IF_MAX_MODULES]; 
/* ポートA,ポートBの読み出し値 */
uint8_t if_rd_gpa[IF_MAX_MODULES];
uint8_t if_rd_gpb[IF_MAX_MODULES]; 

/*-------------------------------------------------------
 * インターフェースボード初期化
 *-------------------------------------------------------*/
void if_init(void)
{
  uint8_t nif = 0;
  uint8_t caddr = 0;
  /* 書き込み値/読み出し値 */ 
  for (caddr = 0; caddr < IF_MAX_MODULES; caddr++) {
    if_wr_gpa[caddr] = 0x00;
    if_wr_gpb[caddr] = 0x00; 
    if_rd_gpa[caddr] = 0x00;
    if_rd_gpb[caddr] = 0x00;
  }
  /* 初期化*/
  if_sensor_init();
  if_toq_init();
  if_turnout_init();
  if_accessary_init();
  /* 各I2Cアドレスに対してMCP23017の接続を確認し初期化 */
  for (caddr = 0; caddr < IF_MAX_MODULES; caddr++) {
    CLRWDT();
    if (!I2C_Exist(I2C_MCP23017_CTLBYTE, caddr)) {
      /* このアドレスに接続無し */
      if_module[caddr] = 0;
    } else {
      /* このアドレスに接続有り */
      if_module[caddr] = 1;
      nif++;
      /* 初期化 */
      i2c_mcp23017_init(caddr);
      if (caddr < IF_MAX_MODULES_TYPE_A) {
        /* センサ・ポイントインターフェースボード */
        /* IOCON: 設定 / INTCC=1: INTCAP読み出しでクリア */
        i2c_mcp23017_reg_write(caddr,
                               I2C_MCP23017_REG_IOCON, 0x01);
        /* DEFVAL: 比較値 / 通常はHで, Lへの変化を検出 */
        i2c_mcp23017_reg_write(caddr,
                               I2C_MCP23017_REG_DEFVALA, 0xFF);
        i2c_mcp23017_reg_write(caddr,
                               I2C_MCP23017_REG_DEFVALB, 0xFF);
        /* INTCON: 比較対象 / DEFVALとの比較 */
        i2c_mcp23017_reg_write(caddr,
                               I2C_MCP23017_REG_INTCONA, 0xFF);
        i2c_mcp23017_reg_write(caddr,
                               I2C_MCP23017_REG_INTCONB, 0xFF);
        /* IODIR: I/O方向 (ポート割付依存) */
        i2c_mcp23017_a_dir_set(caddr, 0xFF);
        i2c_mcp23017_b_dir_set(caddr, 0x03);
      } else {
        /* アクセサリインターフェースボード */
        /* IODIR: I/O方向 (ポート割付依存) */
        i2c_mcp23017_a_dir_set(caddr, 0x00);
        i2c_mcp23017_b_dir_set(caddr, 0x00);
      }
      /* ポート初期値書き込み */
      i2c_mcp23017_a_write(caddr, if_wr_gpa[caddr]);
      i2c_mcp23017_b_write(caddr, if_wr_gpb[caddr]);
      /* INTCAP 空読み*/
      i2c_mcp23017_reg_read(caddr, I2C_MCP23017_REG_INTCAPA);
      i2c_mcp23017_reg_read(caddr, I2C_MCP23017_REG_INTCAPB);
    }
  }
  if (nif == 0) {
    fatal(AR_ERROR_NO_IFBOARD);
  }
}
