Merge pull request #200 from ISSUIUC/feature/midas-b2b-en.

Add B2B Enable for MIDAS Mini

Author: MuhammadAli8209

MIDAS/src/hardware/main.cpp

@@ -86,6 +86,11 @@ void setup()
     digitalWrite(IMU_CS_PIN, HIGH);
     digitalWrite(MMC5983_CS, HIGH);
 
+    // b2b pins
+    pinMode(B2B_EN, OUTPUT);
+    pinMode(B2B_READY, INPUT);
+    digitalWrite(B2B_EN, HIGH); // Enables the B2B bus
+
     //configure output leds
     pinMode(LED_BLUE, OUTPUT);
     pinMode(LED_GREEN, OUTPUT);

MIDAS/src/systems.cpp

@@ -428,6 +428,13 @@ DECLARE_THREAD(cam, RocketSystems *arg)
     while (true)
     {
 
+        // Check the status of the B2B chip, if it's bad then we don't waste time with an I2C check.
+        if(digitalRead(B2B_READY) == LOW) {
+            THREAD_SLEEP(200);
+            continue;
+        }
+
+        // Check if CAM specifically is on the I2C bus
         Wire.beginTransmission(0x69);
         byte error = Wire.endTransmission();