1
0
mirror of https://gitlab.com/lander-team/tvc-test-code.git synced 2025-06-16 15:06:56 +00:00

fixed servos, still need to run full TVC test

This commit is contained in:
Brendan McGeeney 2021-11-21 17:29:09 -07:00
parent 0df5f1b39d
commit ff8f4cfec3

View File

@ -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);