diff --git a/src/main.cpp b/src/main.cpp index 9880511..c81d091 100644 --- a/src/main.cpp +++ b/src/main.cpp @@ -17,17 +17,25 @@ void setup() { yaw.attach(9); // CHANGE MEEEEEEEEEEEEEEEEEEEEEEEEEEEEEEEEEEE pitch.attach(10); // CHANGE MEEEEEEEEEEEEEEEEEEEEEEEEEEEEEEEEEEE - Serial.println("Level the TVC and press enter."); + Serial.println("Remove Servo Horns and press enter."); + read_float(); + yaw.write(0); + pitch.write(0); + + Serial.println("Replace horns, level the TVC and press enter."); read_float(); + Serial.println("Testing Servos"); + // Do a full range of movement of the servos - for (double pct = -100.0; pct <= 100.0; pct += 1.0) { + for (double pct = -100.0; pct <= 100.0; pct += 10.0) { + Serial.print("."); double yaw_pos = pct * YAW_MAX; double pitch_pos = pct * PITCH_MAX; yaw.write(yaw_pos); pitch.write(pitch_pos); - delay(15); + delay(100); } Serial.print("Please input the point height in millimeters: ");