Господа! Срочно нужна ваша помощь!
Столкнулся с проблемой. Cоздаю робота для езды по линии (linefollower). Использую библиотеку AFMotor для управления 2 DC моторами.
Arduino Uno + Motor Shiled V3 + датчики линии amperka. Моторы подключены к управляющим каналам М1, М2.
При активации скетча еле крутится левый мотор, правый только пищит, при разовом срабатывании левого датчика, правый мотор пытается двигатся (но неудачно), при срабатывании правого датчика - левый мотор останавливается (правый никаких признаков жизни). При срабатывании обоих датчиков оба мотора не работают
Cобственно сам скетч:
#include <AFMotor.h>
AF_DCMotor motor1(1);
AF_DCMotor motor2(2);
int leftLinePin = 10;
int rightLinePin = 11;
void setup() {
Serial.begin(9600); // set up Serial library at 9600 bps//
pinMode(leftLinePin, INPUT);
pinMode(rightLinePin, INPUT);
motor1.setSpeed(255);
motor2.setSpeed(255);
}
void loop()
{
boolean whiteLeft = digitalRead(leftLinePin);
boolean whiteRight = digitalRead(rightLinePin);
if (whiteLeft && whiteRight) {
motor1.run(FORWARD);
motor2.run(FORWARD); }
else if (!whiteLeft && !whiteRight) {
motor1.run(BACKWARD);
motor2.run(BACKWARD); }
else if (whiteRight) {
motor1.run(FORWARD);
motor2.run(BACKWARD); }
else (whiteLeft); {
motor1.run(BACKWARD);
motor2.run(FORWARD); }
}
CРОЧНО НУЖНА ВАША ПОМОЩЬ!