diff options
author | Arksine <arksine.code@gmail.com> | 2020-01-09 19:24:51 -0500 |
---|---|---|
committer | KevinOConnor <kevin@koconnor.net> | 2020-01-13 22:29:50 -0500 |
commit | 5fe9dd5a5036e528d6180ef629d38d454e4744a3 (patch) | |
tree | 0035f22aecab0f7e1db3968218fb306274216698 /src/avr/i2c.c | |
parent | b28df43b26e395e2b0d81d50edbd848fc710e060 (diff) | |
download | kutter-5fe9dd5a5036e528d6180ef629d38d454e4744a3.tar.gz kutter-5fe9dd5a5036e528d6180ef629d38d454e4744a3.tar.xz kutter-5fe9dd5a5036e528d6180ef629d38d454e4744a3.zip |
avr: implement i2c_read
Signed-off-by: Eric Callahan <arksine.code@gmail.com>
Diffstat (limited to 'src/avr/i2c.c')
-rw-r--r-- | src/avr/i2c.c | 19 |
1 files changed, 18 insertions, 1 deletions
diff --git a/src/avr/i2c.c b/src/avr/i2c.c index 4632497e..370582cc 100644 --- a/src/avr/i2c.c +++ b/src/avr/i2c.c @@ -85,6 +85,14 @@ i2c_send_byte(uint8_t b, uint32_t timeout) } static void +i2c_receive_byte(uint8_t *read, uint32_t timeout, uint8_t send_ack) +{ + TWCR = (1<<TWEN) | (1<<TWINT) | ((send_ack?1:0)<<TWEA); + i2c_wait(timeout); + *read = TWDR; +} + +static void i2c_stop(uint32_t timeout) { TWCR = (1<<TWEN) | (1<<TWINT) | (1<<TWSTO); @@ -106,5 +114,14 @@ void i2c_read(struct i2c_config config, uint8_t reg_len, uint8_t *reg , uint8_t read_len, uint8_t *read) { - shutdown("i2c_read not supported on avr"); + uint32_t timeout = timer_read_time() + timer_from_us(5000); + i2c_start(timeout); + i2c_send_byte(config.addr, timeout); + while (reg_len--) + i2c_send_byte(*reg++, timeout); + i2c_start(timeout); + i2c_send_byte(config.addr | 0x1, timeout); + while (read_len--) + i2c_receive_byte(read++, timeout, read_len); + i2c_stop(timeout); } |