         else if (recvByte == ackVal) {
             Serial.println(F("Heartbeat byte received"));
 
-            // TODO: Stop using 9 as the hard-coded altitude
-            float altitude = 9;
+            float altitude = getAltitude();
 
             byte packetData[sizeof(float) + 1] = { heightInitialVal };
             float* packetFloatPortion = (float*)&packetData[1];

// Should be a PWM pin
uint8_t servoPin = 5;
Servo actuationServo;
#endif

void setup()

    display.setCursor(0, 1);

    if (millis() - lastTriggerSignalTime < DISPLAY_TIME_MILLIS)
        display.print(lastTriggerType ? "Sent TRIGGER" : "Sent RESET       ");
    else
        display.print("ALTITUDE: " + String(lastAltitude) + "        ");
#endif
