// Adafruit Motor shield library
// copyright Adafruit Industries LLC, 2009
// this code is public domain, enjoy!
#include <AFMotor.h>
AF_DCMotor motor4(4);
AF_DCMotor motor1(1);
void setup() {
Serial.begin(2400); //波特率 set up Serial library at 9600 bps
Serial.println("Motor test!"); //速率
motor1.setSpeed(200);
motor1.run(RELEASE);
motor4.setSpeed(200);
motor4.run(RELEASE);
}
void loop()
{
moveForward(255); //速度
}
void moveForward(int speed){ //马达方向
motor1.run(FORWARD);
motor4.run(BACKWARD);
motor1.setSpeed(speed);
motor4.setSpeed(speed);
}
void moveBackward(int speed){ //马达方向
motor1.run(BACKWARD);
motor4.run(FORWARD);
motor1.setSpeed(speed);
motor4.setSpeed(speed);
}
void turnLeft(){ //考虑到转向速度差;有两个电机速率减低;后期实验可以进行修改
motor1.run(BACKWARD);
motor4.run(BACKWARD);
motor1.setSpeed(120);
motor4.setSpeed(120);
}
void runRelease(){
motor1.run(RELEASE);
motor4.run(RELEASE);
}