Skip to content
Snippets Groups Projects
Commit c2a87cdb authored by Aaron John Sabu's avatar Aaron John Sabu
Browse files

Added Serial print commands to motor basic test

parent 7d1c5197
Branches
No related merge requests found
// Motor Test Code - Aaron
// Motor Basic Test Code - Aaron
#include <Wire.h>
#include <Adafruit_MotorShield.h>
......@@ -11,37 +11,51 @@ Adafruit_DCMotor *motorVL = AFMS.getMotor(1);
Adafruit_DCMotor *motorVR = AFMS.getMotor(2);
Adafruit_DCMotor *motorHL = AFMS.getMotor(3);
Adafruit_DCMotor *motorHR = AFMS.getMotor(4);
void setup() {
Serial.begin(115200);
AFMS.begin();
}
void loop() {
Serial.println("-- START LOOP ---");
Serial.println();
Serial.println(" Vertical Left - Forward Fast");
motorHR->setSpeed(0);
motorVL->setSpeed(largeVal);
motorVL->run(FORWARD);
delay(5000);
delay(2000);
Serial.println(" Vertical Left - Backward Slow");
motorVL->setSpeed(smallVal);
motorVL->run(BACKWARD);
delay(5000);
delay(2000);
Serial.println(" Vertical Right - Forward Fast");
motorVL->setSpeed(0);
motorVR->setSpeed(largeVal);
motorVR->run(FORWARD);
delay(5000);
delay(2000);
Serial.println(" Vertical Right - Backward Slow");
motorVR->setSpeed(smallVal);
motorVR->run(BACKWARD);
delay(5000);
delay(2000);
Serial.println(" Horizontal Left - Forward Fast");
motorVR->setSpeed(0);
motorHL->setSpeed(largeVal);
motorHL->run(FORWARD);
delay(5000);
delay(2000);
Serial.println(" Horizontal Left - Backward Slow");
motorHL->setSpeed(smallVal);
motorHL->run(BACKWARD);
delay(5000);
delay(2000);
Serial.println(" Horizontal Right - Forward Fast");
motorHL->setSpeed(0);
motorHR->setSpeed(largeVal);
motorHR->run(FORWARD);
delay(5000);
delay(2000);
Serial.println(" Horizontal Right - Backward Slow");
motorHR->setSpeed(smallVal);
motorHR->run(BACKWARD);
delay(5000);
delay(2000);
Serial.println();
Serial.println();
}
0% or .
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment