From ff8f4cfec3f2239845c6775a0a9671f9decd6b2d Mon Sep 17 00:00:00 2001 From: Brendan McGeeney Date: Sun, 21 Nov 2021 17:29:09 -0700 Subject: [PATCH] fixed servos, still need to run full TVC test --- src/main.cpp | 13 ++++++++----- 1 file changed, 8 insertions(+), 5 deletions(-) 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);