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:
parent
0df5f1b39d
commit
ff8f4cfec3
13
src/main.cpp
13
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);
|
||||
|
Loading…
x
Reference in New Issue
Block a user