X-Git-Url: https://git.gag.com/?p=fw%2Faltos;a=blobdiff_plain;f=src%2Fstm%2Fao_i2c_stm.c;h=c205706d37669390bfec37081031abfd6bd61b6f;hp=d82342db14e500631850729adec5cb061e401ad8;hb=97317d332f21c42860747c4ecde633bd0228ef52;hpb=64e2e66a5239541b15f43172655cfb3560bec79b

diff --git a/src/stm/ao_i2c_stm.c b/src/stm/ao_i2c_stm.c
index d82342db..c205706d 100644
--- a/src/stm/ao_i2c_stm.c
+++ b/src/stm/ao_i2c_stm.c
@@ -362,8 +362,12 @@ void
 ao_i2c_channel_init(uint8_t index)
 {
 	struct stm_i2c	*stm_i2c = ao_i2c_stm_info[index].stm_i2c;
+	int i;
 
 	/* Turn I2C off while configuring */
+	stm_i2c->cr1 = (1 << STM_I2C_CR1_SWRST);
+	for (i = 0; i < 100; i++)
+		asm("nop");
 	stm_i2c->cr1 = 0;
 	stm_i2c->cr2 = AO_STM_I2C_CR2;