arch/arm64/src/imx9/imx9_lpi2c.c: Add error recovery on timeout

Signed-off-by: Jukka Laitinen <[email protected]>
tiiuae · Sep 17, 2024 · ba2eea6 · ba2eea6
1 parent 18494f3
commit ba2eea6
Showing 1 changed file with 11 additions and 0 deletions.
diff --git a/arch/arm64/src/imx9/imx9_lpi2c.c b/arch/arm64/src/imx9/imx9_lpi2c.c
@@ -2077,6 +2077,17 @@ static int imx9_lpi2c_transfer(struct i2c_master_s *dev,
       ret = -ETIMEDOUT;
       i2cerr("ERROR: Timed out: MSR: status: 0x0%" PRIx32 "\n",
              priv->status);
+
+      /* Stop the ongoing transfer and clear the FIFOs */
+
+      imx9_lpi2c_stop_transfer(priv);
+
+      imx9_lpi2c_modifyreg(priv, IMX9_LPI2C_MCR_OFFSET, 0,
+                           LPI2C_MCR_RTF | LPI2C_MCR_RRF);
+
+      /* Clear any errors */
+
+      imx9_lpi2c_putreg(priv, IMX9_LPI2C_MSR_OFFSET, LPI2C_MSR_ERROR_MASK);
     }
 
   /* Check for error status conditions */