/***********************************************
 * MCP23017
 * Microchip Technology
 * I2C 16-bit I/O Extender
 ************************************************/
#include <xc.h>
#include <stdint.h>
#include "i2c.h"
#include "i2c-mcp23017.h"

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

enum i2c_mcp23017_rw_e {
  I2C_MCP23017_WR = 0,
  I2C_MCP23017_RD = 1,
};

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

/* 制御バイト送出 */
static enum i2c_ack_type_e
i2c_mcp23017_send_ctl_byte(enum i2c_mcp23017_rw_e r_w,
                           uint8_t caddr)
{
  return
    I2C_Write(/* 制御バイト */
              I2C_MCP23017_CTLBYTE
              /* A2,A1,A0: チップ選択ビット */
              | (((unsigned)caddr & 0x07) << 1)
              /* 読み/書き */
              | ((r_w == I2C_MCP23017_RD) ? 0x01 : 0x00)); 
}

/* 初期化 */
void i2c_mcp23017_init(uint8_t caddr)
{
  ;
}

/* レジスタへの書き込み */
void i2c_mcp23017_reg_write(uint8_t caddr,
                            uint8_t reg, uint8_t data)
{
retry:
  I2C_Start();
  if (i2c_mcp23017_send_ctl_byte(I2C_MCP23017_WR, caddr)
      != I2C_ACKTYPE_ACK) {
    goto retry;
  }
  I2C_Write(reg);
  I2C_Write(data);
  I2C_Stop();
}

/* レジスタの読み出し */
uint8_t i2c_mcp23017_reg_read(uint8_t caddr, uint8_t reg)
{
 retry:
  I2C_Start();
  if (i2c_mcp23017_send_ctl_byte(I2C_MCP23017_WR, caddr)
      != I2C_ACKTYPE_ACK) {
    goto retry;
  }
  I2C_Write(reg);
  I2C_Repstart();
  if (i2c_mcp23017_send_ctl_byte(I2C_MCP23017_RD, caddr)
      != I2C_ACKTYPE_ACK) {
    goto retry;
  }
  uint8_t data = I2C_Read(I2C_ACKTYPE_NOACK);
  I2C_Stop();
  return data;
}

/* PORT A I/O 方向設定 */
void i2c_mcp23017_a_dir_set(uint8_t caddr, uint8_t dir)
{
  i2c_mcp23017_reg_write(caddr, I2C_MCP23017_REG_IODIRA, dir);
}

/* PORT B I/O 方向設定 */
void i2c_mcp23017_b_dir_set(uint8_t caddr, uint8_t dir)
{
  i2c_mcp23017_reg_write(caddr, I2C_MCP23017_REG_IODIRB, dir);
}

/* PORT A 書き込み */
void i2c_mcp23017_a_write(uint8_t caddr, uint8_t data)
{
  i2c_mcp23017_reg_write(caddr, I2C_MCP23017_REG_GPIOA, data);
}

/* PORT B 書き込み */
void i2c_mcp23017_b_write(uint8_t caddr, uint8_t data)
{
  i2c_mcp23017_reg_write(caddr, I2C_MCP23017_REG_GPIOB, data);
}

/* PORT A 読み出し */
uint8_t i2c_mcp23017_a_read(uint8_t caddr)
{
  return i2c_mcp23017_reg_read(caddr, I2C_MCP23017_REG_GPIOA);
}

/* PORT B 読み出し */
uint8_t i2c_mcp23017_b_read(uint8_t caddr)
{
  return i2c_mcp23017_reg_read(caddr, I2C_MCP23017_REG_GPIOB);
}
