h3n3/klipper
1
0
Fork 0
Code Issues Pull Requests Packages Projects Releases Wiki Activity

i2c: handle errors at i2ccmds

Browse Source 
Signed-off-by: Timofey Titovets <nefelim4ag@gmail.com>
This commit is contained in:
Timofey Titovets
2024-10-21 14:19:56 +02:00
committed by KevinOConnor
parent 08a85ba869
commit a4aa2a9002
20 changed files with 123 additions and 49 deletions
Download Patch File Download Diff File Expand all files Collapse all files

9
src/avr/i2c.c
View File

@@ -11,6 +11,7 @@
#include "gpio.h" // i2c_setup
#include "internal.h" // GPIO
#include "sched.h" // sched_shutdown
#include "i2ccmds.h" // I2C_BUS_SUCCESS
DECL_ENUMERATION("i2c_bus", "twi", 0);
@@ -94,7 +95,7 @@ i2c_stop(uint32_t timeout)
TWCR = (1<<TWEN) | (1<<TWINT) | (1<<TWSTO);
}
void
int
i2c_write(struct i2c_config config, uint8_t write_len, uint8_t *write)
{
uint32_t timeout = timer_read_time() + timer_from_us(5000);
@@ -104,9 +105,11 @@ i2c_write(struct i2c_config config, uint8_t write_len, uint8_t *write)
while (write_len--)
i2c_send_byte(*write++, timeout);
i2c_stop(timeout);
return I2C_BUS_SUCCESS;
}
void
int
i2c_read(struct i2c_config config, uint8_t reg_len, uint8_t *reg
, uint8_t read_len, uint8_t *read)
{
@@ -120,4 +123,6 @@ i2c_read(struct i2c_config config, uint8_t reg_len, uint8_t *reg
while (read_len--)
i2c_receive_byte(read++, timeout, read_len);
i2c_stop(timeout);
return I2C_BUS_SUCCESS;
}