Advertisement
Not a member of Pastebin yet?
Sign Up,
it unlocks many cool features!
- #include <AFMotor.h>
- int motorSpeed = 100;
- int count = 0;
- AF_DCMotor motor1(1);
- AF_DCMotor motor2(2);
- AF_DCMotor motor3(3);
- AF_DCMotor motor4(4);
- void setup() {
- count = 0;
- motor1.setSpeed(motorSpeed);
- motor2.setSpeed(motorSpeed);
- motor3.setSpeed(motorSpeed);
- motor4.setSpeed(motorSpeed);
- motor1.run(RELEASE);
- motor2.run(RELEASE);
- motor3.run(RELEASE);
- motor4.run(RELEASE);
- }
- void loop() {
- if (count < 3) {
- count++;
- FRONT();
- delay(1000);
- BACKWARDS();
- delay(1000);
- }
- else{
- STOPP();
- }
- /* LEFTT();
- delay(2000);
- RIGHTT();
- delay(2000);*/
- }
- void FRONT() {
- motor1.run(FORWARD);
- motor2.run(FORWARD);
- motor3.run(FORWARD);
- motor4.run(FORWARD);
- }
- void BACKWARDS() {
- motor1.run(BACKWARD);
- motor2.run(BACKWARD);
- motor3.run(BACKWARD);
- motor4.run(BACKWARD);
- }
- void LEFTT() {
- motor1.run(FORWARD);
- motor2.run(BACKWARD);
- motor4.run(FORWARD);
- motor3.run(BACKWARD);
- }
- void RIGHTT() {
- motor1.run(BACKWARD);
- motor2.run(FORWARD);
- motor4.run(BACKWARD);
- motor3.run(FORWARD);
- }
- void STOPP() {
- motor1.run(RELEASE);
- motor2.run(RELEASE);
- motor4.run(RELEASE);
- motor3.run(RELEASE);
- }
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement