Anson/Lander-Embedded
1
0
Fork 0
mirror of https://gitlab.com/lander-team/lander-cpp.git synced 2025-08-17 02:24:50 +00:00
Code Releases Activity

More robust gimbal test function, delay based on step size of Sim

Browse Source
This commit is contained in:
bpmcgeeney
2021-11-14 17:10:58 -07:00
parent e6f7e4c160
commit 5a99508761
3 changed files with 19 additions and 5 deletions
Download Patch File Download Diff File Expand all files Collapse all files

15
include/teensy.h
View File

@@ -18,7 +18,6 @@ File dataFile;
void testGimbal(PWMServo &servo1, PWMServo &servo2) {
int servoTest = 0;
;
servo1.write(servoTest);
servo2.write(servoTest);
@@ -45,6 +44,20 @@ void testGimbal(PWMServo &servo1, PWMServo &servo2) {
delay(30);
}
delay(1000);
// Servo 1 & 2 Test
for (servoTest = 0; servoTest < 7; servoTest += 1) {
servo1.write(servoTest);
servo2.write(servoTest);
delay(30);
}
for (servoTest = 7; servoTest >= 1; servoTest -= 1) {
servo1.write(servoTest);
servo2.write(servoTest);
delay(30);
}
delay(30);
servo1.write(0);
servo2.write(0);