Anson/Lander-Embedded
1
0
Fork 0
mirror of https://gitlab.com/lander-team/lander-cpp.git synced 2025-06-15 22:56:53 +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
Show Stats 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...");

9
src/main.cpp
View File

@ -58,8 +58,8 @@ void setup() {
delay(5000);
Serial.println("Simulation Countdown:");
for (int i = 0; i < 15; i++) {
Serial.println(15 - i);
for (int i = 0; i < 10; i++) {
Serial.println(10 - i);
delay(1000);
}
@ -72,9 +72,10 @@ void setup() {
servo1.attach(pin_servo1);
servo2.attach(pin_servo2);
servo1.write(0);
servo2.write(0);
testGimbal(servo1, servo2);
Serial.println("Servos Tested");
delay(1000);
Serial.println("Simulated Vehicle Initalized");
// Determine when to burn