Робот на Arduino
Привет всем. Этот робот достигая препятствие издаёт звук (писк) и начинает сдавать назад, затем едет по свободному пути до нового препятствия.
Перейдём сразу к делу. Что нам нужно для этого робота:
- Разумеется Arduino, здесь используется «Leonardo», но вы можете использовать любой
- TB6612FNG H Бридж или другой
- Шасси для робота, например Дагу DG012-SV или ручной работы
- Ультразвуковой датчик
- Сервопривод
- 2 синих светодиода
- Зуммер
- Фоторезистор
- Резистор 1,2 к ?
- Макетная плата
- Провода, ленты, винты, батарейки
Шаг 1: Делаем шасси
Теперь пришло время поставить батарейки. Здесь используется коробка на 5 батареек АА, но если у вас большие моторы, то вам нужно больше батарей.
Шаг 2: Подключаем
Если у вас есть TB6612FNG H Бридж, то можно подключить его к Arduino, как указано ниже.
Для его подключения здесь используется макетная плата со 170 отверстиями, потому что это макетная плата маленькая и как раз подходит по размерам для Arduino.
1. Ультразвуковой датчик:
-Trig—> 2 контакт Arduino
-Echo—> 1 контакт Arduino
-VCC —> 5V Arduino
-GND —> GND Arduino
2. Сервопривод
-GND —> GND Arduino-VCC —> 5V Arduino-Data—> 9 контакт Arduino
3. Бридж
— вся масса (GND) к массе Arduino-VCC —> 5V Arduino-A01 —> Мотор 1 масса (-)-A02 —> Мотор 1 питания (+)-B02 —> Двигатель 2 масса (-)-B01 —> Двигатель2 масса (-)-VMOT —> VIN Arduino-PWMA —> 6-контакт Arduino-AIN1 —> 8-контакт Arduino-AIN2 —> 7 контакт Arduino-BIN2 —> 4-контакт Arduino-BIN1 —> 3-контакт Arduino-PWMB —> 5 контакт Arduino
4. Зуммер:
-GND (-) —> GND Arduino
-VCC (+) —> 11-контакт Arduino
5. Светодиоды:
ОБЕ VCC (+) от светодиодов к 10 контакту Arduino
ОБЕ землей (-) от светодиодов к GND Arduino
Длинные провода подвязали кусочком проволоки.
6. Фоторезистор:
На изображении можно увидеть, как это соединить. Резистор 1,2 к ?
Шаг 3:
Теперь нужно вс1 установить на шасси. Здесь использовали 4 винта M3, чтобы закрепить Arduino на шасси. Макетная плата расположена на Arduino.Ультразвуковой датчик приклеен при помощи двухсторонней ленты и сервопривод к шасси чёрной лентой.
Шаг 4: Программа
Код добавлен ниже.
Code
Шаг 5: Программа 2
Робот с этой программой может ездить в лабиринте. Конструкция та же самая, только код немного другой.
Code 2
Шаг 6: Готово. Можно тестировать
Во время теста убедились, что робот отлично выполняет свои задачи на обоих кодах.
Это всё. Всего доброго.