competition_codes/state/sunprarie_state_main.py

@@ -26,7 +26,7 @@ drive_base.use_gyro(True)
 """
 Debugging helps
 """
-DEBUG = 0  # Enable when you want to show logs
+DEBUG = 1  # Enable when you want to show logs
 # Example conversion function (adjust min/max values as needed for your hub)
 async def get_battery_percentage(voltage_mV:float):
     max_voltage = 8400.0  # max battery level https://assets.education.lego.com/v3/assets/blt293eea581807678a/bltb87f4ba8db36994a/5f8801b918967612e58a69a6/techspecs_techniclargehubrechargeablebattery.pdf?locale=en-us
@@ -511,3 +511,26 @@ async def main():
             await Run11()  
         elif color == "Light_Blue":
             print("Running Mission 2_1")
+            await Run12()
+        else:
+            print(f"Unknown color detected (Hue: {h}, Sat: {s}, Val: {v})")
+            #pass
+
+        # Show battery % for debugging 
+        if Button.BLUETOOTH in pressed: # using bluetooth button here since away from color sensor
+            # Get the battery voltage in millivolts (mV)
+            battery_voltage_mV = hub.battery.voltage()
+            # Use the function with your voltage reading
+            percentage = await get_battery_percentage(float(battery_voltage_mV))
+            if DEBUG:
+                print(f"Battery voltage: {battery_voltage_mV} mV")
+                print(f"Battery level: {percentage:.3f}%")
+                print("FLL Robot System Ready!")
+                await hub.display.text(f"{percentage:.0f}")
+            break
+        elif pressed == None:
+            continue 
+
+        await wait(10)
+# Run the main function
+run_task(main())