mirror of
https://github.com/CopterExpress/clover.git
synced 2026-05-28 05:59:32 +00:00
107 lines
3.2 KiB
Markdown
107 lines
3.2 KiB
Markdown
Управление коптером с Arudino
|
||
===
|
||
|
||
Для взаимодействия с ROS-топиками и сервисами на Raspberry Pi можно использовать библиотеку [rosserial_arduino](http://wiki.ros.org/rosserial_arduino).
|
||
|
||
Основной туториал: http://wiki.ros.org/rosserial_arduino/Tutorials
|
||
|
||
Arudino необходимо установить на Клевер и подключить по USB-порту.
|
||
|
||
Настройка Aruino IDE
|
||
---
|
||
|
||
Необходимо скачать и скопировать [библиотеку ROS-сообщений Клевера](https://github.com/CopterExpress/clever_bundle/blob/master/deploy/clever_arudino.tar.gz?raw=true) (`ros_lib`) в `<папку скетчей>/libraries`.
|
||
|
||
Настройка Raspberry Pi
|
||
---
|
||
|
||
Необходимо убедиться, что в launch-файле Клевера (`~/catkin_ws/src/clever/clever/clever.launch`) включен запуск Arduino rosserial:
|
||
|
||
```xml
|
||
<arg name="arduino" default="true"/>
|
||
```
|
||
|
||
При изменении launch-файла необходимо перезапустить пакет `clever`:
|
||
|
||
```bash
|
||
sudo systemctl restart clever
|
||
```
|
||
|
||
Работа с Клевером
|
||
---
|
||
|
||
Набор сервисов и топиков аналогичен обычному набору в `simple_offboard` и `mavros`.
|
||
|
||
Пример программы, контролирующей коптер по позиции, с использованием сервисов `set_position` и `set_mode`:
|
||
|
||
```cpp
|
||
// Подключение библиотек для работы с rosseral
|
||
#include <ros.h>
|
||
|
||
// Подключение заголовочных файлов сообщений пакета Clever и MAVROS
|
||
#include <clever/SetPosition.h>
|
||
#include <mavros_msgs/SetMode.h>
|
||
|
||
using namespace clever;
|
||
using namespace mavros_msgs;
|
||
|
||
ros::NodeHandle nh;
|
||
|
||
// Объявление сервисов
|
||
ros::ServiceClient<SetPosition::Request, SetPosition::Response> setPosition("/set_position");
|
||
ros::ServiceClient<SetMode::Request, SetMode::Response> setMode("/mavros/set_mode");
|
||
|
||
void setup()
|
||
{
|
||
// Инициализация rosserial
|
||
nh.initNode();
|
||
|
||
// Инициализация сервисов
|
||
nh.serviceClient(setPosition);
|
||
nh.serviceClient(setMode);
|
||
|
||
// Ожидание подключение к Raspberry Pi
|
||
while(!nh.connected()) nh.spinOnce();
|
||
nh.loginfo("Startup complete");
|
||
|
||
// Пользовательская настройка
|
||
// <...>
|
||
|
||
// Тестовая программа
|
||
SetPosition::Request sp_req;
|
||
SetPosition::Response sp_res;
|
||
SetMode::Request sm_req;
|
||
SetMode::Response sm_res;
|
||
|
||
// Взлет на 2 метра:
|
||
nh.loginfo("Take off");
|
||
sp_req.yaw = 0;
|
||
sp_req.x = 0;
|
||
sp_req.y = 0;
|
||
sp_req.z = 2;
|
||
sp_req.frame_id = "fcu_horiz";
|
||
setPosition.call(sp_req, sp_res);
|
||
|
||
// Ждем 5 секунд
|
||
delay(5000);
|
||
|
||
// Пролет вперед на 3 метра:
|
||
nh.loginfo("Fly forward");
|
||
sp_req.x = 3;
|
||
sp_req.y = 0;
|
||
sp_req.z = 0;
|
||
setPosition.call(sp_req, sp_res);
|
||
|
||
// Ждем 5 секунд
|
||
delay(5000);
|
||
|
||
// Посадка
|
||
nh.loginfo("Land");
|
||
sm_req.custom_mode = "OFFBOARD";
|
||
setMode.call(sm_req, sm_res);
|
||
}
|
||
|
||
void loop()
|
||
{
|
||
}
|
||
``` |