โค๊ดหุ่นยนต์ แบบ 4 ล้อ /////////////////////////////////////////////////
#include <Servo.h>
#include <AFMotor.h>
AF_DCMotor motor1(1);
AF_DCMotor motor2(2);
AF_DCMotor motor3(3);
AF_DCMotor motor4(4);
void setup()
{
}
void loop()
{
//GG();
ST();
}
void GG()
{
motor1.run(FORWARD);//หน้าขวา
motor1.setSpeed(250);
motor2.run(FORWARD);
motor2.setSpeed(250);//หลังขวา
motor3.run(FORWARD);
motor3.setSpeed(250); //หลังซ้าย
motor4.run(FORWARD);
motor4.setSpeed(250); //หน้าซ้าย
delay(500);
}
void ST()
{
motor1.run(FORWARD);//หน้าขวา
motor1.setSpeed(0);
motor2.run(FORWARD);
motor2.setSpeed(0);//หลังขวา
motor3.run(FORWARD);
motor3.setSpeed(0); //หลังซ้าย
motor4.run(FORWARD);
motor4.setSpeed(0); //หน้าซ้าย
delay(1000);
}
//////////////////////////////////////////////////////////