1 files changed, 49 insertions, 0 deletions
diff --git a/src/drivers/DebugPins.cpp b/src/drivers/DebugPins.cpp
new file mode 100644
index 00000000..5a12fd86
--- /dev/null
+++ b/src/drivers/DebugPins.cpp
@@ -0,0 +1,49 @@
+#include <hal/nrf_gpio.h>
+#include "DebugPins.h"
+
+#ifdef USE_DEBUG_PINS
+void debugpins_init() {
+  nrf_gpio_cfg_output(DebugPin0);
+  nrf_gpio_pin_clear(DebugPin0);
+
+  nrf_gpio_cfg_output(DebugPin1);
+  nrf_gpio_pin_clear(DebugPin1);
+
+  nrf_gpio_cfg_output(DebugPin2);
+  nrf_gpio_pin_clear(DebugPin2);
+
+  nrf_gpio_cfg_output(DebugPin3);
+  nrf_gpio_pin_clear(DebugPin3);
+
+  nrf_gpio_cfg_output(DebugPin4);
+  nrf_gpio_pin_clear(DebugPin4);
+}
+void debugpins_set(debugpins_pins pin) {
+  nrf_gpio_pin_set((uint32_t)(pin));
+}
+
+void debugpins_clear(debugpins_pins pin) {
+  nrf_gpio_pin_clear((uint32_t)(pin));
+}
+
+void debugpins_pulse(debugpins_pins pin) {
+  nrf_gpio_pin_set((uint32_t)(pin));
+  nrf_gpio_pin_clear((uint32_t)(pin));
+}
+#else
+void debugpins_init() {
+
+}
+void debugpins_set(debugpins_pins pin) {
+
+}
+
+void debugpins_clear(debugpins_pins pin) {
+
+}
+
+void debugpins_pulse(debugpins_pins pin) {
+
+}
+
+#endif
+\ No newline at end of file