Движение робота вперед, назад

Движение робота вперед, назад

В гнезда блока управления R-5 устанавливается контроллер Arduino Nano. Поэтому и в настройках среды разработки Arduino IDE необходимо выбрать именно этот контроллер с процессором AT mega 328.

2

 

3

Теперь уже приступаем непосредственно к программированию.

Программа для контроллера Ардуино обычно состоит из трёх частей.
 
В первой части, как в обычной математической задаче, описываются исходные данные. Мы присваиваем названия, назначение, функционал контактов контроллера. Записываем, какие библиотеки мы будем использовать в ходе выполнения программы.
 
Во второй части с названием Setup пишем уже непосредственно код программы. Но этот код исполняется только один раз за время работы программы. Это необходимо для того, чтобы запрограммировать выходы, входы контроллера на всё время действия программы.
 
И третья часть программы loop представляет собой команды, которые исполняются процессором в течение всего периода работы процессора.
 
Рассмотрим простой пример кода для движения робота.
 
В первой части кода мы определяем, какими контактами платы Arduino мы будем управлять драйвером и, соответственно, электромоторами, придумаем название команд, чтобы нам было понятно их назначение.

В блоке R-5 контакты Arduino жёстко подключены к входам драйвера.

Давайте посмотрим на рисунок ниже:


4

M_R_IN – вход драйвера, управляющий направлением вращения правого электромотора. Высокий уровень (HIGHT) – вращение вперед.

M_R_EN – вход драйвера, разрешающий вращение правого электромотора. Высокий уровень (HIGHT) разрешает вращение. При подаче на вход сигнала с широтно-импульсной модуляцией (ШИМ, PWM) вход управляет скоростью вращения.

M_L_IN – вход драйвера, управляющий направлением вращения левого электромотора. Высокий уровень (HIGHT) – вращение вперед.

M_L_IN – вход драйвера, разрешающий вращение левого электромотора. Высокий уровень (HIGHT) разрешает вращение. При подаче на вход сигнала с широтно-импульсной модуляцией (ШИМ, PWM) вход управляет скоростью вращения.

И у нас получается следующее:
Контакт Ардуино 2 – направление вращения правого мотора.
Контакт Арудино 3 – разрешение вращения правого мотора. При работе ШИМ – регулировка скорости вращения.
Контакт Ардуино 4 – направление вращения левого мотора.
Контакт Ардуино 5 – разрешение вращения левого мотора. При работе ШИМ – регулировка скорости вращения.
 
Пишем код. Код



Скопируйте текст программы и вставьте его в Arduino IDE.

После копирования обязательно проверьте, чтобы комментарии в каждой строчке начинались с двух символов //.

После проверки загрузите код в контроллер. Установите контроллер в блок R-5 и включите питание робота.


  IMG 0739

Наш робот, исполняя написанный выше скетч, должен в течение одной секунды ехать вперёд, затем на секунду остановиться и начать движение назад. И так как команда loop исполняется постоянно, то робот будет выполнять эти команды, пока включено питание.


Тэги: arduino



comments powered by Disqus