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

stm32f0: implement i2c_read endpoint 

Signed-off-by: Matt Baker <baker.matt.j@gmail.com>
This commit is contained in:
Matt Baker 2022-08-29 12:56:31 -07:00 committed by KevinOConnor
parent 5d9ff75d02
commit ec4ecd7a70
1 changed files with 20 additions and 1 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

21
src/stm32/stm32f0_i2c.c
View File

@ -84,5 +84,24 @@ 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 stm32");
I2C_TypeDef *i2c = config.i2c;
uint32_t timeout = timer_read_time() + timer_from_us(5000);
// Send start, address, reg
i2c->CR2 = (I2C_CR2_START | config.addr |
(reg_len << I2C_CR2_NBYTES_Pos));
while (reg_len--) {
i2c_wait(i2c, I2C_ISR_TXIS, timeout);
i2c->TXDR = *reg++;
}
i2c_wait(i2c, I2C_ISR_TC, timeout);
// send restart, read data
i2c->CR2 = (I2C_CR2_START | I2C_CR2_RD_WRN | config.addr |
(read_len << I2C_CR2_NBYTES_Pos) | I2C_CR2_AUTOEND);
while (read_len--) {
i2c_wait(i2c, I2C_ISR_RXNE, timeout);
*read++ = i2c->RXDR;
}
i2c_wait(i2c, I2C_ISR_STOPF, timeout);
}