1503 linee diskr 2motora: различия между версиями
Перейти к навигации
Перейти к поиску
Woronin (обсуждение | вклад) Нет описания правки |
Woronin (обсуждение | вклад) Нет описания правки |
||
(не показана 1 промежуточная версия этого же участника) | |||
Строка 6: | Строка 6: | ||
// включаем правый и левый мотор регулируя скорость и путь, при езде по датчикам линии | // включаем правый и левый мотор регулируя скорость и путь, при езде по датчикам линии | ||
////////////////////////////////////////////// | ////////////////////////////////////////////// | ||
int DR; // Переменная для правого датчика | |||
int DL; // Переменная для левого датчика | int DL; // Переменная для левого датчика | ||
int motorR = 2; // направление вращения первого правого мотора | int motorR = 2; // направление вращения первого правого мотора | ||
int motorL = 4; // направление вращения первого левого мотора | int motorL = 4; // направление вращения первого левого мотора | ||
Строка 28: | Строка 28: | ||
// Основной бесконечный цикл | // Основной бесконечный цикл | ||
void loop() { | void loop() { | ||
DL = digitalRead( | DR = digitalRead(A0); | ||
DL = digitalRead(A1); // считываем значение из порта в переменную | |||
if ((DL == 0) && (DR == 0)) { // если оба датчика видят белый | if ((DL == 0) && (DR == 0)) { // если оба датчика видят белый | ||
digitalWrite(motorR, HIGH ); // правый мотор вперед | digitalWrite(motorR, HIGH ); // правый мотор вперед |
Текущая версия от 23:17, 9 января 2023
//////////////////////////////////////////////
// 2023.01.10 woronin, umkiedu@gmail.com
// Датчик линии цифровой сигнал, тестируем движение робота дискретно с регулировкой
// Robot UMKI controller K6_3
// включаем правый и левый мотор регулируя скорость и путь, при езде по датчикам линии
//////////////////////////////////////////////
int DR; // Переменная для правого датчика
int DL; // Переменная для левого датчика
int motorR = 2; // направление вращения первого правого мотора
int motorL = 4; // направление вращения первого левого мотора
int mRspeed = 3; // управляет скоростью вращения правого мотора
int mLspeed = 5; // управляет скоростью вращения левого мотора
int V = 130; // Задаем скорость вращения колес (от 0 до 255)
int timeM = 80; // время включения моторов в млсек
void setup() // Задаем параметры инициализации переменных
{
pinMode(A0, INPUT);// настраиваем порт на вход
pinMode(A1, INPUT);
pinMode(mLspeed, OUTPUT); // настраиваем порт на выход
pinMode(mRspeed, OUTPUT);
pinMode(motorR, OUTPUT);
pinMode(motorL, OUTPUT);
}
// Основной бесконечный цикл
void loop() {
DR = digitalRead(A0);
DL = digitalRead(A1); // считываем значение из порта в переменную
if ((DL == 0) && (DR == 0)) { // если оба датчика видят белый
digitalWrite(motorR, HIGH ); // правый мотор вперед
analogWrite (mRspeed, V); // старт правого мотора с заданной скоростью
digitalWrite(motorL, HIGH ); // левый мотор вперед
analogWrite (mLspeed, V); // старт левого мотора с заданной скоростью
delay(timeM); // время включения в млсек
}
if ((DL == 1) && (DR == 0)) { // если левый датчик видит черный
digitalWrite(motorR, HIGH ); // правый мотор вперед
analogWrite (mRspeed, V); //
digitalWrite(motorL, LOW ); // левый мотор Назад
analogWrite (mLspeed, V); //
delay(timeM);
}
if ((DL == 0) && (DR == 1)) { // если правый датчик видит черный
digitalWrite(motorR, LOW ); // правый мотор Назад
analogWrite (mRspeed, V); //
digitalWrite(motorL, HIGH ); // левый мотор вперед
analogWrite (mLspeed, V); //
delay(timeM);
}
if ((DL == 1) && (DR == 1)) { // если оба датчика видит черный
digitalWrite(motorR, LOW ); // правый мотор Назад
analogWrite (mRspeed, V); //
digitalWrite(motorL, LOW ); // левый мотор Назад
analogWrite (mLspeed, V); //
delay(timeM);
}
digitalWrite(mRspeed, LOW); // Останов, чтоб не потерять линию
digitalWrite(mLspeed, LOW); // скорость левого мотора стоп
delay(timeM);
}