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