Можете проверить скечь?
Я хочу его в тему WiFi робота добавить
PHP код:
#include <AFMotor.h> // Подключаем библиотеку для управления двигателями
AF_DCMotor motor1(1); //создаем мотор №1
AF_DCMotor motor2(2); //создаем мотор №2
AF_DCMotor motor3(3); //создаем мотор №1
AF_DCMotor motor4(4); //создаем мотор №2
int inByte; //в этой переменной храним поступившие данные
int speedgo; //переменная для хранения скорости движения
void setup()
{
Serial.begin(57600); //включаем передачу данных на скорости 9600 бит/c
motor1.setSpeed(255); //Скорость движка №1
motor2.setSpeed(255); //Скорость движка №2
motor3.setSpeed(255); //Скорость движка №1
motor4.setSpeed(255); //Скорость движка №2
}
void loop()
{
if (Serial.available()) //если что то пришло
{
inByte = Serial.read();
switch (inByte) //смотрим какая команда пришла
{
case 'x': //стор
robot_stop();
break;
case 'W': //вперед
robot_go();
break;
case 'D': //лево
robot_left();
break;
case 'A': //право
robot_right();
break;
case 'S': //назад
robot_back();
break;
}
}
}
void robot_go()
{
motor1.run(FORWARD); //движемся вперед
motor2.run(FORWARD); //движемся вперед
motor3.run(FORWARD); //движемся вперед
motor4.run(FORWARD); //движемся вперед
}
void robot_back()
{
motor1.run(BACKWARD); //движемся назад
motor2.run(BACKWARD); //движемся назад
motor3.run(BACKWARD); //движемся назад
motor4.run(BACKWARD); //движемся назад
}
void robot_left()
{
motor2.run(FORWARD); //Повернем влево
motor3.run(FORWARD); //Повернем влево
}
void robot_right()
{
motor1.run(FORWARD); //Повернем вправо
motor4.run(FORWARD); //Повернем вправо
}
void robot_stop()
{
motor1.run(RELEASE); //Останавливаем колеса
motor2.run(RELEASE); //Останавливаем колеса
motor3.run(RELEASE); //Останавливаем колеса
motor4.run(RELEASE); //Останавливаем колеса
}