qmk-dactyl-manuform-a/keyboards/hotdox/left.c

131 lines
2.4 KiB
C

#include "action.h"
#include "left.h"
#include "wait.h"
bool i2c_initialized = false;
void left_config(void);
uint8_t left_write(uint8_t reg, uint8_t data);
uint8_t left_read(uint8_t reg, uint8_t *data);
uint8_t init_mcp23017(void)
{
i2c_initialized = false;
if (i2c_initialized == 0)
{
i2c_init(); // on pins D(1,0)
_delay_ms(1000);
}
return 0;
}
void left_init(void)
{
init_mcp23017();
left_scan();
#if 0
while (1)
{
print("wait\n");
wait_us(1000000);
}
#endif
}
void left_scan(void)
{
uint8_t ret = i2c_start(I2C_ADDR_WRITE, HOTDOX_I2C_TIMEOUT);
if (ret == 0)
{
i2c_stop(HOTDOX_I2C_TIMEOUT);
if (!i2c_initialized)
{
i2c_initialized = true;
left_config();
clear_keyboard();
print("mcp23017 attached!!!\n");
}
}
else
{
if (i2c_initialized)
{
i2c_initialized = false;
clear_keyboard();
print("mcp23017 deattached!!!\n");
}
}
return;
}
uint8_t left_read_cols(void)
{
uint8_t data = 0;
left_read(MCP23017_B0_GPIOA, &data);
return data;
}
void left_unselect_rows(void)
{
left_write(MCP23017_B0_IODIRB, 0x3F);
}
void left_select_row(uint8_t row)
{
left_write(MCP23017_B0_IODIRB, ~(1 << row));
}
void left_config(void)
{
left_write(MCP23017_B0_IODIRA, 0x7F);
left_write(MCP23017_B0_IPOLA, 0x7F);
left_write(MCP23017_B0_GPPUA, 0x7F);
left_write(MCP23017_B0_IODIRB, 0xFF);
left_write(MCP23017_B0_GPIOB, 0xC0);
}
uint8_t left_write(uint8_t reg, uint8_t data)
{
if (!i2c_initialized)
{
return 0;
}
uint8_t ret;
ret = i2c_start(I2C_ADDR_WRITE, HOTDOX_I2C_TIMEOUT); if (ret) goto out;
ret = i2c_write(reg, HOTDOX_I2C_TIMEOUT); if (ret) goto out;
ret = i2c_write(data, HOTDOX_I2C_TIMEOUT);
out:
i2c_stop(HOTDOX_I2C_TIMEOUT);
return ret;
}
uint8_t left_read(uint8_t reg, uint8_t *data)
{
if (!i2c_initialized)
{
return 0;
}
uint8_t ret = 0;
ret = i2c_start(I2C_ADDR_WRITE, HOTDOX_I2C_TIMEOUT); if (ret) goto out;
ret = i2c_write(reg, HOTDOX_I2C_TIMEOUT); if (ret) goto out;
ret = i2c_start(I2C_ADDR_READ, HOTDOX_I2C_TIMEOUT); if (ret) goto out;
*data = i2c_read_nack(HOTDOX_I2C_TIMEOUT);
out:
i2c_stop(HOTDOX_I2C_TIMEOUT);
return ret;
}