/*------------------------------------------------------- 
 * アクセサリ制御出力 (アクセサリインターフェースボード)
 *-------------------------------------------------------*/
#include <xc.h>
#include <stdint.h>
#include "mcr.h"
#include "io.h"
#include "ar.h"
#include "if-toq.h"
#include "if.h"
#include "i2c.h"
#include "i2c-mcp23017.h"

static int8_t if_accessary_action(if_ac_id ac,
                                  uint8_t action);

/*-------------------------------------------------------
 * 初期化
 *-------------------------------------------------------*/
void if_accessary_init(void)
{
  ACC_1_OFF();
  ACC_2_OFF();
  uint8_t caddr = 7;
  for ( ; caddr < IF_MAX_MODULES_TYPE_B; caddr--) {
    /*(ポート割付依存)*/
    if_wr_gpa[caddr] = (unsigned)if_wr_gpa[caddr] & ~0xFF; 
    if_wr_gpb[caddr] = (unsigned)if_wr_gpb[caddr] & ~0xFF;
  }
}

/*-------------------------------------------------------
 * 出力On 
 *-------------------------------------------------------*/
int8_t if_accessary_on(if_ac_id ac)
{
  return if_accessary_action(ac, 1);
}

/*-------------------------------------------------------
 * 出力Off 
 *-------------------------------------------------------*/
int8_t if_accessary_off(if_ac_id ac)
{
  return if_accessary_action(ac, 0);
}

void if_accessary_off_all(void)
{
  if_ac_id ac = 0;
  for (ac = 1; ac <= IF_MAX_ACCESSARIES; ac++) {
    if_accessary_action(ac, 0);
  }
}

/*-------------------------------------------------------
 * アクセサリ出力制御 (action=1:On, action=0:Off) 
 *-------------------------------------------------------*/
static int8_t if_accessary_action(if_ac_id ac,
                                  uint8_t action)
{
  if ((ac == IF_AC_NULL) || (IF_MAX_ACCESSARIES < ac)) {
    return 0;
  }
  /* 出力*/
  int8_t physically_done = 1;
  if (ac <= N_ACCESSARIES_BUILTIN) {
    /* 出力はメインボード上で */
    switch (ac) {
    case 1:
      if (action == 1) { /* On  */
        ACC_1_ON();
      } else {           /* Off */
        ACC_1_OFF();
      }
      break;
    case 2:
      if (action == 1) { /* On  */
        ACC_2_ON();
      } else {           /* Off */
        ACC_2_OFF();
      }
      break;
    default:
      physically_done = 0;
      break;
    }
  } else {
    /* 出力はインターフェースボード上で */
    uint8_t xac = (uint8_t)(ac - N_ACCESSARIES_BUILTIN);
    /* 該当のインターフェースボード番号とポート番号 
     * caddr := (xac-1) / N_ACCESSARIES_PER_MOD 
     *     g := (xac-1) % N_ACCESSARIES_PER_MOD */ 
    uint8_t caddr = 7;
    uint8_t g = (unsigned)xac - 1;
    while (g >= N_ACCESSARIES_PER_MOD) {
      g -= N_ACCESSARIES_PER_MOD;
      caddr--;
    }
    /* アクセサリ制御出力の更新 (ポート割付依存) */
    const uint8_t bit_table[16] = {
      0x01, 0x02, 0x04, 0x08, 0x10, 0x20, 0x40, 0x80,
      0x01, 0x02, 0x04, 0x08, 0x10, 0x20, 0x40, 0x80 };
    if (action == 1) { /* On  */
      if (g < 8) {
        if_wr_gpa[caddr] |= (unsigned) bit_table[g];
      } else {
        if_wr_gpb[caddr] |= (unsigned) bit_table[g];
      }
    } else {           /* Off */
      if (g < 8) {
        if_wr_gpa[caddr] &= (unsigned)~bit_table[g];
      } else {
        if_wr_gpb[caddr] &= (unsigned)~bit_table[g];
      }

    }
    /* 出力 */
    if (if_module[caddr] != 0) {
      i2c_mcp23017_a_write(caddr, if_wr_gpa[caddr]);
      i2c_mcp23017_b_write(caddr, if_wr_gpb[caddr]);
    } else {
      physically_done = 0;
    }
  }
  /* 返り値: 実際にインターフェースボード接続があるか否か */
  return physically_done;
}
