Публикация данных одометрии в ROS………………………………………………………………………………….. 232
Издатель сообщений о преобразованиях одометрии…………………………………………………… 234
Дальнейшее отслеживание перемещений робота и его локализация в пространстве………. 236
Инструмент для коррекции позы вручную…………………………………………………………………….. 236
Фидуциальные маркеры………………………………………………………………………………………………………….. 237
Локализация с помощью лазерного сканера………………………………………………………………………… 238
GPS и GNSS……………………………………………………………………………………………………………………………….. 239
Системы локализации на основе радиомаяков…………………………………………………………………….. 239
Заключение………………………………………………………………………………………………………………………………. 240
Вопросы……………………………………………………………………………………………………………………………………. 240
Глава 12. Автономное движение…………………………………………………………… 241
Общие сведения……………………………………………………………………………………………………………………….. 241
Обзор движения роботов в ROS……………………………………………………………………………………………… 241
Контроллер двигателя — simple_diff_drive.cpp……………………………………………………………………. 242
Шаги по созданию контроллера двигателя simple_diff_drive……………………………………… 243
Код контроллера двигателя дифференциального рулевого привода,
представленный в общем виде………………………………………………………………………………………… 244
Код контроллера двигателя дифференциального рулевого привода…………………………. 245
Контроллер привода — simple_drive_controller.cpp……………………………………………………………… 251
Шаги по созданию контроллера привода……………………………………………………………………… 251
Заключение………………………………………………………………………………………………………………………………. 256
Вопросы……………………………………………………………………………………………………………………………………. 256
Глава 13. Автономное планирование маршрута…………………………………… 257
Общие сведения……………………………………………………………………………………………………………………….. 257
Методы планирования маршрута и сопутствующие проблемы…………………………………………. 257
Проблемы………………………………………………………………………………………………………………………….. 258
Методы планирования маршрута………………………………………………………………………………….. 258
Увеличение границ вокруг препятствий………………………………………………………………………… 259
Карты затрат (costmap)…………………………………………………………………………………………………… 260
Пакет costmap_2d…………………………………………………………………………………………………………….. 260
Планирование маршрута с помощью алгоритма A*……………………………………………………. 263
Как работает алгоритм А*……………………………………………………………………………………………… 264
Пошаговый разбор алгоритма A*………………………………………………………………………………….. 266
Разбор процедуры А*………………………………………………………………………………………………………. 268
Написание программы A* как узла ROS……………………………………………………………………………….. 273
Стандартные вещи, вспомогательные функции и main()……………………………………………… 274
Сердце узла A*: функция find_path()……………………………………………………………………………… 284
Заключение………………………………………………………………………………………………………………………………. 289
Вопросы……………………………………………………………………………………………………………………………………. 289
Часть IV. Интерпретация данных,
поступающих с датчиков……………………………………………………….. 291
Глава 14. Колесные энкодеры для одометрии………………………………………. 293
Общие сведения……………………………………………………………………………………………………………………….. 293
Колесные энкодеры…………………………………………………………………………………………………………………. 293
Оптические энкодеры………………………………………………………………………………………………………………. 294
Энкодеры на датчиках Холла………………………………………………………………………………………………… 294
Подключение энкодеров…………………………………………………………………………………………………………. 295
Издатель сообщений об импульсах: tick_publisher.cpp………………………………………………………… 297
Код издателя сообщений об импульсах энкодера……………………………………………………………….. 298
Заключение………………………………………………………………………………………………………………………………. 302
Вопросы……………………………………………………………………………………………………………………………………. 302
Глава 15. Ультразвуковые датчики расстояния……………………………………. 303
Общие сведения……………………………………………………………………………………………………………………….. 303
Основная информация об ультразвуковом дальномере HC-SR04………………………………………. 304
Считывание показаний HC-SR04…………………………………………………………………………………… 304
Подключение HC-SR04…………………………………………………………………………………………………………… 304
Издатель данных ультразвукового измерения расстояния: ultrasonic_publisher.cpp………… 305
Издатель сообщений об ультразвуковом измерении расстояния:
пошаговый разбор……………………………………………………………………………………………………………. 305
Обзор кода издателя сообщений об ультразвуковом измерении расстояния…………….. 306
Использование данных ультразвукового измерения расстояния при обнаружении объектов 309
Заключение………………………………………………………………………………………………………………………………. 310
Вопросы……………………………………………………………………………………………………………………………………. 311
Глава 16. Инерциальные измерительные блоки (IMU) — акселерометры, гироскопы и магнитометры…………………………………………………………………………………………………………….. 312
Общие сведения……………………………………………………………………………………………………………………….. 312
Акселерометры………………………………………………………………………………………………………………………… 313
Недостатки акселерометра…………………………………………………………………………………………….. 314
Публикация данных IMU в ROS……………………………………………………………………………………… 314
Тип данных sensor_msgs::Imu в ROS………………………………………………………………………………. 315
Код издателя сообщений IMU………………………………………………………………………………………… 316
Гироскопы………………………………………………………………………………………………………………………………… 320
Недостатки гироскопа…………………………………………………………………………………………………….. 321
Добавление данных гироскопа в узел IMU…………………………………………………………………… 321
Магнитометры…………………………………………………………………………………………………………………………. 322
Недостатки магнитометра………………………………………………………………………………………………. 322
Добавление данных магнитометра………………………………………………………………………………… 323
Установка IMU………………………………………………………………………………………………………………………… 325
Заключение………………………………………………………………………………………………………………………………. 325
Вопросы……………………………………………………………………………………………………………………………………. 326
Глава 17. GPS и системы на основе внешних радиомаяков………………….. 327
Общие сведения……………………………………………………………………………………………………………………….. 327
Как работают системы на основе радиомаяков…………………………………………………………………… 327
Основные сведения о GPS и GNSS………………………………………………………………………………………….. 329
Точность GPS/GNSS…………………………………………………………………………………………………………. 329
Определение местоположения с помощью GPS/GNSS-RTK с точностью до 2 см……… 330
Ограничения GPS/GNSS…………………………………………………………………………………………………… 331
Данные GPS/GNSS……………………………………………………………………………………………………………. 332
Строки с данными NMEA………………………………………………………………………………………………… 332
Некоторые основные представления данных о широте и долготе……………………………… 334
Публикация данных GPS/GNSS в ROS…………………………………………………………………………………… 335
Пакет ROS: nmea_navsat_driver……………………………………………………………………………………… 335
Установка пакета nmea_navsat_driver…………………………………………………………………………… 336
Изучение документации к пакетам ROS………………………………………………………………………… 337
Запуск узла nmea_serial_driver с параметрами……………………………………………………………. 338
Заключение………………………………………………………………………………………………………………………………. 339
Вопросы……………………………………………………………………………………………………………………………………. 339
Глава 18. Устройства LIDAR и данные, которые они предоставляют…… 340
Общие сведения……………………………………………………………………………………………………………………….. 340
Основные сведения об устройствах LIDAR………………………………………………………………………….. 340
Ограничения LIDAR………………………………………………………………………………………………………………… 341
Типы LIDAR……………………………………………………………………………………………………………………………… 342
Однонаправленный (одноточечный) LIDAR…………………………………………………………………. 342
2D-LIDAR………………………………………………………………………………………………………………………….. 343
3D-LIDAR………………………………………………………………………………………………………………………….. 344
LIDAR, установленный на роботе-пылесосе………………………………………………………………… 344
Критерии выбора LIDAR………………………………………………………………………………………………………… 346
Данные LIDAR: сообщение sensor_msgs::LaserScan……………………………………………………………. 347
Факторы, которые необходимо учитывать при монтаже устройств LIDAR……………………… 349
Установка, запуск и испытание распространенной модели LIDAR…………………………………… 350
Действия по настройке RPLIDAR…………………………………………………………………………………… 351
Визуализация сообщения LaserScan……………………………………………………………………………………… 353
Заключение………………………………………………………………………………………………………………………………. 356
Вопросы……………………………………………………………………………………………………………………………………. 356
Глава 19. Реальное зрение с помощью видеокамер………………………………. 357
Общие сведения……………………………………………………………………………………………………………………….. 357
Что такое изображение?………………………………………………………………………………………………………….. 358
Атрибуты изображения…………………………………………………………………………………………………… 359
Координаты пиксела……………………………………………………………………………………………………….. 359
Проверка наличия или установка необходимого программного обеспечения………………….. 360
ROS Kinetic………………………………………………………………………………………………………………………… 360
ROS Melodic………………………………………………………………………………………………………………………. 361
Тестирование OpenCV в ROS………………………………………………………………………………………………….. 362
Программное обеспечение для обработки изображений (OpenCV) и ROS………………………… 363
Шаг 1. Публикация изображений в ROS………………………………………………………………………………… 364
Установка usb_cam_node………………………………………………………………………………………………… 364
Запуск usb_cam_node………………………………………………………………………………………………………. 364
Тестирование выходного сигнала камеры…………………………………………………………………….. 366
Шаг 2. Подпишитесь на сообщение об изображении в другом узле…………………………………… 367
Создайте свой пакет ROS для видеонаблюдения………………………………………………………….. 367
Написание кода для подписчика на сообщения с изображением……………………………….. 368
Шаг 3. С помощью cv-bridge преобразуйте изображение RGB, которое использует ROS, в изображение BGR, с которым может работать OpenCV…………………………………………………………………………………………………………………….. 369
Шаг 4. Выполните необходимые операции с изображением………………………………………………. 369
Шаг 5. Публикуйте любые данные, не относящиеся к изображению,
в виде отдельного сообщения ROS…………………………………………………………………………………………. 370
Шаг 6. Преобразуйте измененное изображение обратно в формат RGB…………………………… 370
Шаг 7. Опубликуйте итоговое изображение в отдельном топике……………………………………….. 371
Еще немного про обработку изображений……………………………………………………………………………. 371
Ядра, диафрагмы и блоки……………………………………………………………………………………………….. 371
Важность работы с копиями вместо оригинальных изображений……………………………… 372
Несколько слов об освещении………………………………………………………………………………………… 373
Ревизия шага 4 с включением большего количества операций OpenCV……………………………. 373
Преобразование цветового формата: cvtColor()…………………………………………………………… 374
Размытие изображений: blur(), medianBlur(), GaussianBlur()……………………………………….. 374
Выделение краев: Canny()……………………………………………………………………………………………….. 375
От определения краев на изображении к числовым значениям: HoughLinesP()………… 376
Маскирование изображения: bitwise_and()…………………………………………………………………… 380
Фильтрация по цвету: cvtColor() и inRange()………………………………………………………………………… 383
Полезные инструменты ROS…………………………………………………………………………………………………… 387
Расширенные функции OpenCV и не только…………………………………………………………………………. 387
Распознавание изображений с помощью облачных технологий………………………………………… 388
Заключение………………………………………………………………………………………………………………………………. 389
Вопросы……………………………………………………………………………………………………………………………………. 389
Глава 20. Совместное использование различных датчиков………………….. 390
Общие сведения……………………………………………………………………………………………………………………….. 390
Доступно о совместном использовании датчиков………………………………………………………………… 391
Датчик абсолютной ориентации Bosch BN0055………………………………………………………………….. 391
Предоставляемые данные……………………………………………………………………………………………….. 392
Улучшенная одометрия…………………………………………………………………………………………………… 392
Интеграция BN0055: оборудование и издатель ROS……………………………………………………. 393
Интеграция BN0055: узел одометрии…………………………………………………………………………….. 394
Шаг 1. Подписаться на сообщение IMU………………………………………………………………………… 395
Шаг 2. Проверить, что поле ориентации не помечено как “do not use” (не использовать) 395
Шаг 3. Преобразовать кватернионы в углы Эйлера…………………………………………………….. 396
Шаг 4. Сохранить информацию о смещении, если это первое сообщение IMU………… 396
Шаг 5.1. Если это НЕ первое сообщение IMU, сохранить курс IMU………………………….. 397
Шаг 5.2. Передать новое значение курса IMU в функцию расчета параметров одометрии 397
Комплексный подход к совместному использованию датчиков…………………………………………. 398
Фильтр Калмана………………………………………………………………………………………………………………. 398
Ковариационная матрица……………………………………………………………………………………………….. 401
Ковариационные матрицы в сообщениях ROS……………………………………………………………… 402
Узел robot_pose_ekf node………………………………………………………………………………………………………… 403
Установка robot_pose_ekf……………………………………………………………………………………………….. 404
Запуск robot_pose_ekf……………………………………………………………………………………………………… 404
Последнее замечание о преобразованиях и roslaunch………………………………………………….. 405
Заключение………………………………………………………………………………………………………………………………. 406
Вопросы……………………………………………………………………………………………………………………………………. 406
Часть V. Разработка автономного робота…………………………. 407
Глава 21. Сборка и программирование автономного робота………………… 409
Общие сведения……………………………………………………………………………………………………………………….. 409
Раздел 1. Создание физической платформы для робота……………………………………………………… 410
Платформа для робота: общий обзор и список деталей……………………………………………………… 411
Модули, объединяющие в себе колесо и двигатель……………………………………………………… 413
Драйвер(ы) двигателя………………………………………………………………………………………………………. 414
Ролик (третье колесо робота)………………………………………………………………………………………….. 414
Аккумуляторы и зарядное устройство…………………………………………………………………………… 414
Шасси/основание…………………………………………………………………………………………………………….. 415
Компьютеры……………………………………………………………………………………………………………………… 416
LIDAR или другой датчик расстояния…………………………………………………………………………… 416
Колесные энкодеры…………………………………………………………………………………………………………. 417
IMU (инерциальный измерительный блок)……………………………………………………………………. 417
Преобразователь напряжения для компьютера……………………………………………………………. 417
Коммутационная плата для колодки GPIO……………………………………………………………………. 418
Видеокамера…………………………………………………………………………………………………………………….. 418
Вольтметр для контроля напряжения аккумулятора……………………………………………………. 419
Различные материалы……………………………………………………………………………………………………… 420
Сборка платформы для робота………………………………………………………………………………………………. 420
Подготовьте компьютер…………………………………………………………………………………………………… 421
Подготовьте колесные модули……………………………………………………………………………………….. 421
Продумайте схему расположения компонентов…………………………………………………………… 422
Подготовьте шасси…………………………………………………………………………………………………………… 422
Установите колесные модули и ролик…………………………………………………………………………… 422
Установите драйвер двигателя, клеммные колодки и источник питания для компьютера……….. 424
Подготовьте коммутационную плату для колодки GPIO…………………………………………….. 424
Установите компьютер, коммутационную плату для колодки GPIO и IMU………………. 424
Соедините все блоки проводами и установите аккумулятор………………………………………. 425
Установите LIDAR и видеокамеру…………………………………………………………………………………. 425
Еще несколько советов……………………………………………………………………………………………………………. 427
Раздел 2. Программирование робота…………………………………………………………………………………….. 428
Программирование: общие замечания…………………………………………………………………………… 428
Программирование робота: подробная инструкция…………………………………………………….. 429
- Создать папку проекта……………………………………………………………………………………….. 430
- Получить данные датчиков для публикации……………………………………………………. 430
- Настроить управление платформой с помощью пульта ДУ…………………………… 432
- Отслеживать перемещение робота и публиковать данные о местоположении 435
- Обеспечить перемещение робота по путевым точкам
(без обхода препятствий)……………………………………………………………………………………….. 436
- Составьте карту окружения робота………………………………………………………………….. 438
- Загрузить сохраненную карту с помощью файлов запуска……………………………. 439
- Добиться автономной навигации робота в пределах карты…………………………… 440
Запуск автономного робота!………………………………………………………………………………………………….. 441
Некоторые советы по устранению неполадок………………………………………………………………. 441
Что дальше?……………………………………………………………………………………………………………………………… 442
Обход динамических препятствий…………………………………………………………………………………. 442
ПИД-регуляторы………………………………………………………………………………………………………………. 443
Главный контроллер, который управляет различными процедурами или задачами.. 443
Реализация преобразования map в odom (полная локализация)………………………………… 443
Следите за новостями в Интернете…………………………………………………………………………………. 443
Заключение………………………………………………………………………………………………………………………………. 444
Приложение. Описание электронного архива………………………………………. 445
Предметный указатель…………………………………………………………………………. 446