diff --git a/src/main.cpp b/src/main.cpp
index 60ae7e0..8d87ee0 100644
--- a/src/main.cpp
+++ b/src/main.cpp
@@ -22,8 +22,8 @@ void setup()
 
   Serial.println("Remove Servo Horns and press enter.");
   read_float();
-  yaw.write(yaw_conv(90));
-  pitch.write(pitch_conv(90));
+  yaw.write(90);
+  pitch.write(90);
 
   Serial.println("Replace horns, level the TVC and press enter.");
   read_float();
@@ -37,14 +37,17 @@ void setup()
     double yaw_pos = (pct / 100) * YAW_MAX;
     double pitch_pos = (pct / 100) * PITCH_MAX;
 
-    Serial.println(90 + yaw_conv(yaw_pos));
-    Serial.println(90 + pitch_conv(pitch_pos));
+    Serial.println(yaw_conv(yaw_pos));
+    Serial.println(pitch_conv(pitch_pos));
 
     yaw.write(90 + yaw_conv(yaw_pos));
     pitch.write(90 + pitch_conv(pitch_pos));
-    delay(500);
+    delay(50);
   }
 
+  yaw.write(90);
+  pitch.write(90);
+
   Serial.print("Please input the point height in millimeters: ");
   zero_height = read_float();
   delay(1000);