mirror of
https://github.com/qmk/qmk_firmware.git
synced 2024-11-29 22:45:51 +00:00
39 lines
1.2 KiB
C
39 lines
1.2 KiB
C
|
#include "sx60.h"
|
||
|
#include "i2cmaster.h"
|
||
|
|
||
|
|
||
|
bool i2c_initialized = 0;
|
||
|
uint8_t mcp23018_status = 0x20;
|
||
|
|
||
|
uint8_t init_mcp23018(void) {
|
||
|
mcp23018_status = 0x20;
|
||
|
|
||
|
/* I2C subsystem */
|
||
|
|
||
|
if (i2c_initialized == 0) {
|
||
|
i2c_init(); // on pins D(1,0)
|
||
|
i2c_initialized = true;
|
||
|
_delay_ms(1000);
|
||
|
}
|
||
|
|
||
|
/* B Pins are Row, A pins are Columns
|
||
|
Set them to output */
|
||
|
mcp23018_status = i2c_start(I2C_ADDR_WRITE); if (mcp23018_status) goto out;
|
||
|
mcp23018_status = i2c_write(IODIRA); if (mcp23018_status) goto out;
|
||
|
mcp23018_status = i2c_write(0b11111111); if (mcp23018_status) goto out;
|
||
|
/* Now write to IODIRB */
|
||
|
mcp23018_status = i2c_write(0b00000000); if (mcp23018_status) goto out;
|
||
|
i2c_stop();
|
||
|
|
||
|
mcp23018_status = i2c_start(I2C_ADDR_WRITE); if (mcp23018_status) goto out;
|
||
|
mcp23018_status = i2c_write(GPPUA); if (mcp23018_status) goto out;
|
||
|
mcp23018_status = i2c_write(0b11111111); if (mcp23018_status) goto out;
|
||
|
/* Now write to GPPUB */
|
||
|
mcp23018_status = i2c_write(0b00000000); if (mcp23018_status) goto out;
|
||
|
|
||
|
out:
|
||
|
i2c_stop();
|
||
|
|
||
|
return mcp23018_status;
|
||
|
}
|