Group 2

You might also like

Download as txt, pdf, or txt
Download as txt, pdf, or txt
You are on page 1of 2

#include "src/Motor.

h"
#define DirectionPin 4
#define BaudRate 115200
int velocity1 = 85;
int velocity2 = -85;
void setup() {
// put your setup code here, to run once:
Motor.begin(BaudRate, DirectionPin, &Serial2);
}

void loop() {
// put your main code here, to run repeatedly:
Motor.turnWheel(1,LEFT,0);
Motor.turnWheel(2,RIGHT,0);
delay(1000);
///////////////////////////////////////////////
Motor.turnWheel(1,LEFT,velocity1);
Motor.turnWheel(2,RIGHT,velocity1);
delay(1500);
Motor.turnWheel(1,LEFT,0);
Motor.turnWheel(2,RIGHT,0);
delay(100);
/////////////////////////////////////////////เดินตรง
Motor.turnWheel(1,LEFT,-45);
Motor.turnWheel(2,RIGHT,45);
delay(1600);
Motor.turnWheel(1,LEFT,0);
Motor.turnWheel(2,RIGHT,0);
delay(100);
///////////////////////////////////////////////เลี้ยวซ้าย
Motor.turnWheel(1,RIGHT,velocity1);
Motor.turnWheel(2,LEFT,velocity1);
delay(1400);
Motor.turnWheel(1,LEFT,0);
Motor.turnWheel(2,RIGHT,0);
delay(100);
////////////////////////////////////////////////ถอยหลั ง
Motor.turnWheel(1,LEFT,velocity1);
Motor.turnWheel(2,RIGHT,velocity1);
delay(1400);
Motor.turnWheel(1,LEFT,0);
Motor.turnWheel(2,RIGHT,0);
delay(100);
////////////////////////////////////////////////////
Motor.turnWheel(1,LEFT,45);
Motor.turnWheel(2,RIGHT,0);
delay(1640);
Motor.turnWheel(1,LEFT,0);
Motor.turnWheel(2,RIGHT,0);
delay(100);
////////////////////////////////////////////////////////
Motor.turnWheel(1,LEFT,velocity1);
Motor.turnWheel(2,RIGHT,velocity1);
delay(1000);
Motor.turnWheel(1,LEFT,0);
Motor.turnWheel(2,RIGHT,0);
delay(1000);
////////////////////////////////////////////////////////
Motor.turnWheel(1,RIGHT,velocity1);
Motor.turnWheel(2,LEFT,velocity1);
delay(1300);
Motor.turnWheel(1,LEFT,0);
Motor.turnWheel(2,RIGHT,0);
delay(100);
/////////////////////////////////////////////
Motor.turnWheel(1,LEFT,-45);
Motor.turnWheel(2,RIGHT,45);
delay(1600);
Motor.turnWheel(1,LEFT,0);
Motor.turnWheel(2,RIGHT,0);
delay(100);
///////////////////////////////////////////////เลี้ยว
Motor.turnWheel(1,LEFT,velocity1);
Motor.turnWheel(2,RIGHT,velocity1);
delay(900);
Motor.turnWheel(1,LEFT,0);
Motor.turnWheel(2,RIGHT,0);
delay(100);
/////////////////////////////////////////////////
Motor.turnWheel(1,LEFT,45);
Motor.turnWheel(2,RIGHT,0);
delay(950);
Motor.turnWheel(1,LEFT,0);
Motor.turnWheel(2,RIGHT,0);
delay(100);
//////////////////////////////////////////////////////โคง้
Motor.turnWheel(1,LEFT,25);
Motor.turnWheel(2,RIGHT,60);
delay(4600);
Motor.turnWheel(1,LEFT,0);
Motor.turnWheel(2,RIGHT,0);
delay(100);
//////////////////////////////////////////////////////////
Motor.turnWheel(1,LEFT,velocity1);
Motor.turnWheel(2,RIGHT,velocity1);
delay(900);
Motor.turnWheel(1,LEFT,0);
Motor.turnWheel(2,RIGHT,0);
delay(1000000000000);
}

You might also like