Initialize to Off

rzblue · Dec 21, 2023 · 3d865a1 · 3d865a1
1 parent 5d0c542
commit 3d865a1
Show file tree

Hide file tree

Showing 5 changed files with 15 additions and 0 deletions.
diff --git a/hal/src/main/native/athena/HAL.cpp b/hal/src/main/native/athena/HAL.cpp
@@ -83,6 +83,7 @@ void InitializeHAL() {
   InitializeFRCDriverStation();
   InitializeI2C();
   InitializeInterrupts();
+  InitializeLEDs();
   InitializeMain();
   InitializeNotifier();
   InitializeCTREPDP();

diff --git a/hal/src/main/native/athena/HALInitializer.h b/hal/src/main/native/athena/HALInitializer.h
@@ -40,6 +40,7 @@ extern void InitializeFRCDriverStation();
 extern void InitializeHAL();
 extern void InitializeI2C();
 extern void InitializeInterrupts();
+extern void InitializeLEDs();
 extern void InitializeMain();
 extern void InitializeNotifier();
 extern void InitializeCTREPDP();

diff --git a/hal/src/main/native/athena/LEDs.cpp b/hal/src/main/native/athena/LEDs.cpp
@@ -11,6 +11,14 @@
 #include "hal/Errors.h"
 #include "hal/LEDS.h"
 
+namespace hal::init {
+
+void InitializeLEDs() {
+  int32_t status = 0;
+  HAL_SetRadioLEDState(HAL_RadioLED_kOff, &status);
+}
+}  // namespace hal::init
+
 static const fs::path radioLEDGreenFilePath =
     "/sys/class/leds/nilrt:wifi:primary/brightness";
 static const fs::path radioLEDRedFilePath =

diff --git a/hal/src/main/native/include/hal/HAL.h b/hal/src/main/native/include/hal/HAL.h
@@ -25,6 +25,7 @@
 #include "hal/HALBase.h"
 #include "hal/I2C.h"
 #include "hal/Interrupts.h"
+#include "hal/LEDs.h"
 #include "hal/Main.h"
 #include "hal/Notifier.h"
 #include "hal/PWM.h"

diff --git a/hal/src/main/native/sim/LEDs.cpp b/hal/src/main/native/sim/LEDs.cpp
@@ -6,6 +6,10 @@
 
 #include "hal/simulation/RoboRioData.h"
 
+namespace hal::init {
+void InitializeLEDs() {}
+}  // namespace hal::init
+
 void HAL_SetRadioLEDState(HAL_RadioLEDState state, int32_t* status) {
   HALSIM_SetRoboRioRadioLEDState(state);
 }