Anson/TVC-Test-Code
1
0
Fork 0
mirror of https://gitlab.com/lander-team/tvc-test-code.git synced 2025-06-17 07:26:51 +00:00
Code Releases Activity

fixed servos, still need to run full TVC test

Browse Source
This commit is contained in:
Brendan McGeeney 2021-11-21 17:29:09 -07:00
parent 0df5f1b39d
commit ff8f4cfec3
1 changed files with 8 additions and 5 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

13
src/main.cpp
View File

@ -22,8 +22,8 @@ void setup()
Serial.println("Remove Servo Horns and press enter."); Serial.println("Remove Servo Horns and press enter.");
read_float(); read_float();
yaw.write(yaw_conv(90)); yaw.write(90);
pitch.write(pitch_conv(90)); pitch.write(90);
Serial.println("Replace horns, level the TVC and press enter."); Serial.println("Replace horns, level the TVC and press enter.");
read_float(); read_float();
@ -37,14 +37,17 @@ void setup()
double yaw_pos = (pct / 100) * YAW_MAX; double yaw_pos = (pct / 100) * YAW_MAX;
double pitch_pos = (pct / 100) * PITCH_MAX; double pitch_pos = (pct / 100) * PITCH_MAX;
Serial.println(90 + yaw_conv(yaw_pos)); Serial.println(yaw_conv(yaw_pos));
Serial.println(90 + pitch_conv(pitch_pos)); Serial.println(pitch_conv(pitch_pos));
yaw.write(90 + yaw_conv(yaw_pos)); yaw.write(90 + yaw_conv(yaw_pos));
pitch.write(90 + pitch_conv(pitch_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: "); Serial.print("Please input the point height in millimeters: ");
zero_height = read_float(); zero_height = read_float();
delay(1000); delay(1000);