Господа! Срочно нужна ваша помощь! Столкнулся с проблемой. 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РОЧНО НУЖНА ВАША ПОМОЩЬ!
|