Skip to content

Приложение 4. Подключение и настройка устройств для управления полезной нагрузкой ​

Приложение рассматривает подключение к квадрокоптеру таких устройств, как сервопривод, электромагнит (бортовой модуль захвата груза) и игрушечный пистолет, а также настройку модулей для управления ими в автономном полете. Управление и взаимодействие с перечисленными устройствами происходит через Универсальный вычислительный модуль FC-ESP32-HAT. Обратим внимание, что сервопривод и игрушечный пистолет не входят в комплект поставки.

Использование данных устройств подтверждает концепцию образовательной среды, где базовый набор ARA-EDU служит фундаментом для интеграции внешних устройств, позволяющим масштабировать функционал системы под требования конкретных соревновательных и инженерных регламентов.

Отметим, что методы для работы с внешними устройствами доступны при использовании версии образа TrackingCam v3 не ниже 3.1.13.80. Проверить версию образа можно во вкладке «Обзор» управляющего интерфейса камеры.

image295

Проверка версии образа модуля во вкладке «Обзор»

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

Настройка универсального вычислительного модуля ​

Настройку вычислительного модуля FC-ESP32-HAT можно произвести двумя способами:

  1. Через среду разработки Arduino IDE.

  2. Через инструмент Applied Robotics Firmware Application. Установку ПО и алгоритм настройки платы можно найти по ссылке: https://wiki.appliedrobotics.ru/software/ARFA/card.html

Далее рассмотрен алгоритм настройки вычислительного модуля FC-ESP32-HAT через среду разработки Arduino IDE. Скачиваем приложение с официального сайта.

Процесс настройки состоит из трех этапов:

  1. Настройка среды разработки Arduino IDE;

  2. Установка библиотеки;

  3. Загрузка скетча в плату.

  4. Настройка среды разработки

Переходим во вкладку «File» (Файл) → «Preferences» (Настройки).

image296

Расположение вкладки «Preferences» (Настройки)

В поле «Additional Boards Manager URLs» («Дополнительные ссылки для Менеджера плат») вводим строку:

https://raw.githubusercontent.com/espressif/arduino-esp32/gh-pages/package_esp32_index.json

image297

Настройка поля «Additional Boards Manager URLs» в окне «Preferences» (Настройки)

Для сохранения нажимаем «ОК».

Переходим в «Tools» (Инструменты) → «Board» (Плата) → «Board Managers» (Менеджер плат). Также в «Board Managers» можно попасть, нажав на выделенную иконку:

image298

Расположение настройки «Board Managers» (Менеджер плат)

В открывшемся окне выполняем поиск ESP32, понадобится плата «esp32 by Espressif Systems». В версии обязательно выбираем 3.2.0. Нажимаем на кнопку «INSTALL» («Установка»).

image299

Окно установки «esp32 by Espressif Systems»

Требуется убедиться в том, что есть активное интернет-соединение и дождаться окончания загрузки. Этот процесс может занять до нескольких минут и зависит от скорости интернет-соединения. По завершению загрузки в «Output» отобразится следующее:

image300

Окно «Output»

По завершению загрузки закрываем окно «Board Managers» (Менеджер плат), нажав на значок.

Теперь, перейдя в «Tools» (Инструменты) → «Board» (Плата), esp32 станет доступна. Для прошивки FC-ESP32-HAT выбираем «ESP32 Wrover Module».

image301

Расположение выбора платы «ESP32 Wrover Module».

Устанавливаем в «Flash Mode» параметр «DIO».

image302

Расположение настройки «Flash Mode»

В «Partition Scheme» устанавливаем «Huge APP (3MB No OTA/1MB SPIFFS)».

image303\

Расположение настройки «Partition Scheme»

  1. Установка библиотеки

Переходим во вкладку «Tools» → «Manage Library» или нажимаем на выделенную иконку.

image304

Расположение инструмента «Manage Library»

В открывшемся меню в поиске вводим «ESP32Servo» и устанавливаем библиотеку «ESP32Servo by Kevin Harrington, John K. Bennett» версии 3.2.0

image305

Установка библиотеки «ESP32Servo»

После установки в «Output» отобразится следующее:

image306

Вывод в окне «Output» после установки библиотеки

  1. Загрузка скетча

Скачиваем скетч по ссылке:

https://github.com/AppliedRobotics/ARA-EDU/blob/main/drone-control-api_en/esp_control/DeviceControlESP.ino

cpp
#include <ESP32Servo.h>
Servo servo;

const int ledPin = 33;
const int universalPin = 32;
const int servoPin = 26;

void setup() {
  // Serial.begin(115200);
  Serial1.begin(115200, SERIAL_8N1, 2, 4);

  servo.attach(servoPin);

  pinMode(ledPin, OUTPUT);
  pinMode(universalPin, OUTPUT);

  digitalWrite(universalPin, LOW);
  digitalWrite(ledPin, HIGH); delay(500);
  digitalWrite(ledPin, LOW);  delay(500);
  digitalWrite(ledPin, HIGH); delay(500);
  digitalWrite(ledPin, LOW);
}

void loop() {
  if (Serial1.available()) {
    String data = Serial1.readStringUntil('\n');
    float x, y, z;
    int parsed = sscanf(data.c_str(), "%f,%f,%f", &x, &y, &z);

    if (parsed == 3) {
      //магнит
      if(y > 0.9f){
        digitalWrite(ledPin, HIGH);
        digitalWrite(universalPin, HIGH);
      }
      else{
        digitalWrite(ledPin, LOW);
        digitalWrite(universalPin, LOW);
      }
      //cерво
      z = constrain(z, 0.0f, 3.14f);
      int servoAngle = map((int)(z * 100), 0, 314, 0, 180);
      servo.write(servoAngle);

      //пистолет
      if(x > 0.01f){
        digitalWrite(ledPin, HIGH);
        digitalWrite(universalPin, HIGH);
        delay((int)(x * 1000));
        digitalWrite(ledPin, LOW);
        digitalWrite(universalPin, LOW);

      }

      // Serial.printf("x=%.2f, y=%.2f, z=%.2f\n", x, y, z);
    }
  }
}

Переходим во вкладку «File» (Файл) → «Open…» («Открыть…»). В открывшемся проводнике выбираем ранее скачанный скетч.

image307

Выбор команды «Open…» («Открыть…»)

После того, как скетч открылся, убеждаемся, что среда разработки Arduino IDE настроена, установлена необходимая библиотека.

Подключаем вычислительный модуль FC-ESP32-HAT к компьютеру с помощью провода micro-USB. Далее выбираем порт подключения.

image308

Выбор COM-порта для подключения FC-ESP32-HAT

Чтобы выбрать правильный порт, переходим в Диспетчер устройств компьютера, разворачиваем список «Порты (COM и LPT)» и ищем надпись «USB-SERIAL CH340 (COM X)», где Х – номер порта. Номер COM-порта может быть любым (в примере это порт 13).

image309

Расположение портов в диспетчере устройств

Если FC-ESP32-HAT не определяется как «USB-SERIAL CH340», скорее всего при скачивании Arduino IDE не установился драйвер CH340, тогда необходимо скачать его из открытых источников и установить на компьютер.

Обращаем внимание на плату.

  • При наличии двух конденсаторов (отмечены красным) перед загрузкой скетча следует нажать кнопку, отмеченную желтым.

  • При наличии одного конденсатора (отмечен зеленым) для загрузки скетча извлекаем все подключения (DXL и UART подключения) или подключаем аккумулятор и отключаем провод, соединяющий полетный контроллер и вычислительный модуль по UART-порту.

Для загрузки скетча нажимаем «Upload» и ожидаем окончания загрузки.

image310

Кнопка «Upload»

После того, как скетч будет загружен, появится сообщение «Done uploading» («Загрузка завершена»).

image311

Уведомление о завершении загрузки скетча

Затем перезагружаем FC-ESP32-HAT. Отключаем от него питание (отключаем аккумулятор от дрона и провод micro-USB от компьютера), ожидаем несколько секунд, а затем снова подаем питание. Данный шаг необходим для сохранения программы в памяти вычислительного модуля.

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

image312

Уведомление об ошибке

Подключение устройств ​

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

Перед подачей питания на дрон рекомендуется повторно проверить правильность подключения.

Подключение FC-ESP32-HAT к TrackingCam v3 ​

Необходимо подключить модуль FC-ESP32-HAT к модулю TrackingCam v3 при помощи трех дюпон-проводов типа «папа–мама».

image313

Схема подключения модулей FC-ESP32-HAT и TrackingCam v3

Первый провод подключается в разъем TX2 на TrackingCam v3 и к пину 2 на Универсальном вычислительном модуле.

Второй провод подключается в разъем 5V на TrackingCam v3 и идет в линию 5V на FC-ESP32-HAT.

Третий провод подключается в разъем GND на TrackingCam v3 и идет в линию GND на FC-ESP32-HAT.

Подключение внешних устройств к FC-ESP32-HAT ​

Электромагнит ​

Магнит подключается к FC-ESP32-HAT с помощью двух проводов:

  1. Один провод должен быть подключен к пину K32.

  2. Второй подключается к линии 5V.

image314

Схема подключения электромагнита

Сервопривод ​

Сервопривод подключается к FC-ESP32-HAT с помощью трех проводов:

  1. Управляющий провод (оранжевый), подключается к пину 26.

  2. Второй провод (красный) подключается к линии 5V.

  3. Третий провод (коричневый) подключается к линии GND.

image315

Схема подключения сервопривода

Игрушечный пистолет ​

Для работы игрушечного пистолета Minigun Glock с мягкими пулями дополнительно необходим драйвер L298N.

image316

Схема подключения игрушечного пистолета через драйвер L298N

Сначала следует запитать драйвер с помощью трех проводов:

  1. Силовой провод аккумулятора (+16В) подключается в разъем драйвера 12В.

  2. Силовой провод аккумулятора (–) подключается в разъем драйвера GND.

  3. Разъем для питания логики драйвера (+5В) подключается в разъем 5В на пятивольтовой линии FC-ESP32-HAT.

Также необходимо убрать джампер (перемычку), для отдельного питания логики драйвера.

image317

Подача питания на драйвер L298N

Для управления драйвером необходимо подключить его к вычислительному модулю с помощью двух проводов:

  1. Пин IN3 на драйвере соединить с линией 5V на FC-ESP32-HAT.

  2. Пин IN4 на драйвере соединить с пином K32 на FC-ESP32-HAT.

image318

Подключение драйвера к FC-ESP32-HAT

Далее к драйверу необходимо подключить мотор игушечного пистолета:

  1. К разъему OUT3 провод питания.

  2. К разъему OUT4 провод земли.

image319

Подключение мотора игрушечного пистолета к драйверу

Проверка работы устройств полезной нагрузки ​

После того, как устройства были подключены, а универсальный вычислительный модуль настроен, выполняем проверку работы устройств. Целью данной проверки является подтверждение корректности подключения, проверка работоспособности всех устройств и обеспечение готовности системы к дальнейшей эксплуатации.

Перед проверкой снимаем пропеллеры и подключаем питание к квадрокоптеру. Запуск программ, рассмотренных ниже, не отличается от запуска примеров Blockly и Python API, рассмотренных в главах 3 и 4 соответственно. Скачиваем примеры по ссылкам:

Для Blockly:

https://github.com/AppliedRobotics/ARA-EDU/tree/main/drone-control-api/esp_control/Test_Blockly

Для Python API:

https://github.com/AppliedRobotics/ARA-EDU/tree/main/drone-control-api/esp_control/Test_Python

Электромагнит ​

Запускаем программу и контролируем работу электромагнита: при подаче команды он должен включиться и удерживать металлический объект, а затем отключиться через 10 секунд.

Blockly (Magnet.json):

image320

Программа для проверки работы электромагнита в Blockly

Python (Magnet.py):

python
from drone_control_api import Drone
import time

ip = "10.42.0.1"
port = "1233"

client = Drone()

print("connected?", client.connect(ip, port), "\n")

print("setMagnet?", client.setMagnet(True), "\n") # Включение магнита
time.sleep(10.0)
print("setMagnet?", client.setMagnet(False), "\n") # Выключение магнита через 10 секунд
time.sleep(2.0)

client.disconnect()

Сервопривод ​

Запускаем программу и контролируем работу сервопривода: при подаче команд он должен последовательно поворачиваться на заданные углы (0°, 90° и 180° / 0, 1.57 и 3.14 радиан) с паузами в две секунды между переключениями.

Blockly (Servo.json):

image321

Программа для проверки работы сервопривода в Blockly

Python (Servo.py):

python
from drone_control_api import Drone
import time

ip = "10.42.0.1"
port = "1233"

client = Drone()

print("connected?", client.connect(ip, port), "\n")

print("setServoAngle?", client.setServoAngle(0.0), "\n") # Поворот на 0 градусов
time.sleep(2.0)
print("setServoAngle?", client.setServoAngle(1.57), "\n") # Поворот на 90 градусов через 2 секунды
time.sleep(2.0)
print("setServoAngle?", client.setServoAngle(3.14), "\n") # Поворот на 180 градусов через 2 секунды
time.sleep(2.0)

client.disconnect()

Игрушечный пистолет ​

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

Следует учитывать, что значение, достаточное для одиночного выстрела (например, 0,15), может быть недостаточным при выполнении нескольких последовательных. Если наблюдается, что мягкие пули не выстреливаются или выстреливаются с недостаточной силой, рекомендуется увеличить значение времени выстрела. Для совершения одного выстрела требуется от 0.1 до 0.2 секунд.

Blockly (Shoot.json):

image322

Программа для проверки работы игрушечного пистолета в Blockly

Python (Shoot.py):

Для совершения десяти выстрелов подряд необходимо раскомментировать строки 23–25 данной программы и закомментировать 15–20 строки включительно.

python
from drone_control_api import Drone
import time

ip = "10.42.0.1"
port = "1233"

client = Drone()

print("connected?", client.connect(ip, port), "\n")

client.setShoot(0.15) # Одиночный выстрел
time.sleep(5.0)
client.setShoot(0.15) # Одиночный выстрел через 5 секунд
time.sleep(5.0)
client.setShoot(0.15) # Одиночный выстрел через 5 секунд
time.sleep(2.0)

# # 10 одиночных выстрелов через каждые 2 секунды
# for _ in range(10):
#     client.setShoot(0.15)
#     time.sleep(2.0)

client.disconnect()

Все этапы пройдены, можно переходить к эксплуатации устройств.