0901 motor vperd

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

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

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