Ported CloseBottomServo to cpp