From a16d1ea44905bcc89a81d1744575b8f157088fe4 Mon Sep 17 00:00:00 2001
From: Anne Stijns <anne@thetubes.net>
Date: Wed, 1 Mar 2023 16:16:40 +0100
Subject: [PATCH] turn yellow led on where the code goes wrong

---
 src/mpu/sensor.rs | 8 ++++++--
 1 file changed, 6 insertions(+), 2 deletions(-)

diff --git a/src/mpu/sensor.rs b/src/mpu/sensor.rs
index f5effef..1f6809a 100644
--- a/src/mpu/sensor.rs
+++ b/src/mpu/sensor.rs
@@ -8,6 +8,7 @@ use crate::time::delay_ms_assembly;
 use core::marker::PhantomData;
 use core::time::Duration;
 use embedded_hal::blocking::i2c::{Write, WriteRead};
+use crate::led::Led::Yellow;
 
 const MPU6050_ADDRESS: u8 = 0x68;
 
@@ -66,8 +67,11 @@ where
         bytes: &[u8],
         response: &mut [u8],
     ) -> Result<(), Error<I2c>> {
-        i2c.write_read(MPU6050_ADDRESS, bytes, response)
-            .map_err(|e| Error::WriteRead(e))
+        Yellow.on();
+        let result = i2c.write_read(MPU6050_ADDRESS, bytes, response)
+            .map_err(|e| Error::WriteRead(e));
+        Yellow.off();
+        result
     }
 
     pub(crate) fn write(&mut self, i2c: &mut I2c, bytes: &[u8]) -> Result<(), Error<I2c>> {
-- 
GitLab