     radio.writeAckPayload(primaryPipeIndex, &ackVal, 1);
 
 #if ROLE == ROLE_GROUND
-    //pinMode(heartbeatLEDGreenPin, OUTPUT);
-    //pinMode(heartbeatLEDRedPin, OUTPUT);
+    pinMode(heartbeatLEDGreenPin, OUTPUT);
+    pinMode(heartbeatLEDBluePin, OUTPUT);
+    pinMode(heartbeatLEDRedPin, OUTPUT);
 #else
     actuationServo.attach(servoPin);
     actuationServo.write(RESET_SERVO_ANGLE);

    for (int i = 0; i < numBytes; i++)
    {
        Serial.print(((byte*)val)[i]);
        Serial.print(F(", "));
    }
    Serial.println(F("}"));



#if ROLE == ROLE_GROUND

// Smart switch utils
#include "~Switch.h"

