0902 motor vperd nazad

Материал из УМКИwiki
Перейти к навигации Перейти к поиску
 //////////////////////////////////////////////
 //     2019.07.19 woronin,  umkiedu@gmail.com
 //     работа с двумя моторами езда вперед
 //     Robot UMKI controller  K6_3
 //     самостоятельно сделать моторы вращались вперед 5 сек и потом назад 5 сек
 //////////////////////////////////////////////
 int motorR1 = 2; // 2-й контакт определяет направление вращения  первого правого мотора
 int motorL1 = 4; // 4-й контакт определяет направление вращения  первого левого мотора
 int mLspeed = 3; // 3-й управляет вращением  левого мотора
 int mRspeed = 5; // 5-й управляет вращением  правого мотора

void setup()
{
  pinMode(mLspeed, OUTPUT); // конфигурим контакты как работающие на выход
  pinMode(mRspeed, OUTPUT);
  pinMode(motorR1, OUTPUT);
  pinMode(motorL1, OUTPUT);
}

void loop()
{
  digitalWrite (motorR1, HIGH);// Команда digitalWrite устанавливает на контакте 2 высокий уровень
  digitalWrite (motorL1, HIGH);
  digitalWrite (mRspeed, HIGH); //  включаем вращение моторов
  digitalWrite (mLspeed, HIGH);
  delay(1000); // Вращаем 1 сек
 // Низкий уровень запрещает вращение моторов
  digitalWrite (mRspeed, LOW);
  digitalWrite (mLspeed, LOW);
  delay(1000); //останов 1 сек.
  digitalWrite (motorR1, LOW);// Команда digitalWrite устанавливает на контакте 2 низкий уровень
  digitalWrite (motorL1, LOW);
  digitalWrite (mRspeed, HIGH); //  включаем вращение моторов
  digitalWrite (mLspeed, HIGH);
  delay(1000); // Вращаем 1 сек
 // Низкий уровень запрещает вращение моторов
  digitalWrite (mRspeed, LOW);
  digitalWrite (mLspeed, LOW);
  delay(1000); //останов 1 сек.
  digitalWrite (motorR1, LOW);// Команда digitalWrite устанавливает на контакте 2 низкий уровень
  digitalWrite (motorL1, HIGH);
  digitalWrite (mRspeed, HIGH); //  включаем вращение моторов
  digitalWrite (mLspeed, HIGH);
  delay(1000); // Вращаем 1 сек
 // Низкий уровень запрещает вращение моторов
  digitalWrite (mRspeed, LOW); 
  digitalWrite (mLspeed, LOW);
  delay(1000); //останов 1 сек.
  digitalWrite (motorR1, HIGH);// Команда digitalWrite устанавливает на контакте 2 высокий уровень
  digitalWrite (motorL1, LOW);
  digitalWrite (mRspeed, HIGH); //  включаем вращение моторов
  digitalWrite (mLspeed, HIGH);
  delay(1000); // Вращаем 1 сек
 // Низкий уровень запрещает вращение моторов
  digitalWrite (mRspeed, LOW); 
  digitalWrite (mLspeed, LOW);
  delay(1000); //останов 1 сек.
}