diff --git a/src/i2c.c b/src/i2c.c
--- a/src/i2c.c
+++ b/src/i2c.c
@@ -36,6 +36,13 @@ void i2c_init(void)
 }
 
 
+void i2c_deinit(void)
+{
+    HAL_I2C_DeInit(&hi2c1);
+    __I2C1_CLK_DISABLE();
+}
+
+
 // Get pointer to I2C port
 I2C_HandleTypeDef* i2c_get(void)
 {