         validateAck(sendByte(ackVal));
     }
 
+    //Serial.println("Current calibrated altitude: " + String(lastAltitude));
+
     bool altitudeAboveThreshold = isAltCalibrated && lastAltitude >= ALTITUDE_TARGET_THRESH_FEET;
     if (isCommHealthy && altitudeAboveThreshold)
-        setStatusLED(0, 0, 255);
+        setStatusLED(0, 255, 0); // Green
 
     else if (isCommHealthy)
-        setStatusLED(0, 255, 0);
+        setStatusLED(0, 0, 255); // Blue
 
     else
-        setStatusLED(255, 0, 0);
+        setStatusLED(255, 0, 0); // Red
 #else
     if (radio.available()) {
         byte recvByte = receiveByte();

            receiveData(&buffer, sizeof(buffer));

            // Dereference the data portion of the packet as a float
            float newAltitude = *(float*)(&(buffer[1]));
            if (isAltCalibrated)
                lastAltitude = newAltitude - rawCalibrationAltitude;
            else
                lastAltitude = newAltitude;

            Serial.println("Got altitude " + String(lastAltitude));
        }

float rawCalibrationAltitude = 0;
bool isAltCalibrated = false;
float lastAltitude = -1;
float rawLastAltitude = -1;

#else
#define TRIGGER_SERVO_ANGLE 90
#define RESET_SERVO_ANGLE 0
#define METERS_TO_FEET_RATIO (1250./381.)

// Should be a PWM pin
uint8_t servoPin = 5;
