Anson/Lander-Embedded
1
0
Fork 0
mirror of https://gitlab.com/lander-team/lander-cpp.git synced 2025-07-23 14:41:25 +00:00
Code Releases Activity

Added test gimbal function

Browse Source
This commit is contained in:
bpmcgeeney
2021-11-14 14:23:28 -07:00
parent 8fa9dba55e
commit 82e43b1fe8
2 changed files with 40 additions and 4 deletions
Download Patch File Download Diff File Expand all files Collapse all files

35
include/teensy.h
View File

@@ -4,6 +4,7 @@
#include <SD.h>
#include <SPI.h>
void testGimbal(class PWMServo &, class PWMServo &);
double loadCellCalibrate();
void initFile();
void thrustInfo(struct Vehicle &);
@@ -15,6 +16,40 @@ void teensyAbort();
const int chipSelect = BUILTIN_SDCARD;
File dataFile;
void testGimbal(PWMServo &servo1, PWMServo &servo2) {
int servoTest = 0;
;
servo1.write(servoTest);
servo2.write(servoTest);
// Servo 1 Test
for (servoTest = 0; servoTest < 7; servoTest += 1) {
servo1.write(servoTest);
delay(30);
}
for (servoTest = 7; servoTest >= 1; servoTest -= 1) {
servo1.write(servoTest);
delay(30);
}
delay(1000);
// Servo 2 Test
for (servoTest = 0; servoTest < 7; servoTest += 1) {
servo2.write(servoTest);
delay(30);
}
for (servoTest = 7; servoTest >= 1; servoTest -= 1) {
servo2.write(servoTest);
delay(30);
}
delay(30);
servo1.write(0);
servo2.write(0);
}
void initFile() {
Serial.print("Initializing SD card...");