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

started outlining test

Browse Source
This commit is contained in:
Anson Biggs 2021-11-03 15:47:08 -07:00
parent df0f021473
commit 4fee260ed2
1 changed files with 26 additions and 13 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

39
src/main.cpp
View File

@ -4,20 +4,33 @@
Servo yaw;
Servo pitch;
double YAW_MAX = 7;
double PITCH_MAX = 7;
double zero_height;
double point_height(double TVC_angle) { return sin(TVC_angle) + zero_height; }
void setup() {
yaw.attach(9); // CHANGE MEEEEEEEEEEEEEEEEEEEEEEEEEEEEEEEEEEEEEE
yaw.attach(9); // CHANGE MEEEEEEEEEEEEEEEEEEEEEEEEEEEEEEEEEEE
pitch.attach(10); // CHANGE MEEEEEEEEEEEEEEEEEEEEEEEEEEEEEEEEEEE
Serial.println("Level the TVC and press enter.");
Serial.readString();
// Do a full range of movement of the servos
for (double pct = -100.0; pct <= 100.0; pct += 1.0) {
double yaw_pos = pct * YAW_MAX;
double pitch_pos = pct * PITCH_MAX;
yaw.write(yaw_pos);
pitch.write(pitch_pos);
delay(15);
}
Serial.print("Please input the point height in millimeters: ");
String zero_string = Serial.readString();
zero_height = zero_string.toFloat();
}
void loop() {
for (int pos = 0; pos <= 180; pos += 1) {
yaw.write(pos);
pitch.write(pos);
delay(15);
}
for (int pos = 180; pos >= 0; pos -= 1) {
yaw.write(pos);
pitch.write(pos);
delay(15);
}
}
void loop() {}