Алгоритм планирования движения мобильной платформы

Анализ алгоритмов построения пути движения для колесной платформы. Математическая обработка результатов измерения датчиков, маршрута движения к финишу. Обработка данных и написание программного кода для МК. Алгоритм самостоятельной оценки препятствия.

Рубрика Программирование, компьютеры и кибернетика
Вид статья
Язык русский
Дата добавления 29.11.2018
Размер файла 257,7 K

Отправить свою хорошую работу в базу знаний просто. Используйте форму, расположенную ниже

Студенты, аспиранты, молодые ученые, использующие базу знаний в своей учебе и работе, будут вам очень благодарны.

Размещено на http://www.allbest.ru/

Алгоритм планирования движения мобильной платформы

Введение

В рамках проводимой кафедрой М6-КФ «Мехатроника и робототехника» научно-исследовательской работы по исследованию мобильных колесных роботов были исследованы алгоритмы построения пути движения для колесной платформы. Данная мехатронная система представляет собой 6 колесо-моторных пар, закрепленных на акриловой раме, которые питаются от аккумуляторной батареи и управляются контроллером ArduinoMega 2560. Передние и задние колесо-моторные пары закреплены на сервоприводах, что позволяет регулировать угол наклона. Скорость движения и дистанция, которую проехал робот, определяются путем считывания данных с энкодеров на средней оси. Также на мобильной платформе установлен датчик расстояния SHARP 2Y0A21. Установка данного датчика позволяет платформе оценить расстояние до некоторого объекта, который находится впереди, а также оценить возможность преодоления его.

При постановке эксперимента были решены следующие задачи:

1. Математическая обработка результатов измерения датчиков.

2. Математическое прокладывание маршрута движения к финишу.

3. Обработка данных и написание программного кода для МК.

4. Разработка алгоритма самостоятельной оценки препятствия.

1. Постановка эксперимента и обработка данных

Планирование перемещения робота является основной проблемой функционирования мобильной платформы. Для решения таких типов задач охватываются такие научные области как вычислительная геометрия, искусственный интеллект, компьютерное моделирование и т.д.. Основная цель планирования траектории является обеспечение желаемого движения мобильной платформы. Используя энкодеры, можно получить график разгона и торможения платформы. Данные графики позволяют оценить время разгона или полного торможения и погрешность реального результата от желаемого. График разгона мобильной платформы без дополнительных нагрузок показан на рис. 1.

Рис. 1. График разгона мобильной платформы.

Планирование траектории движения. Будем считать, что мобильная платформа всегда начинает движения из точки старта. Для удобства точку старта совместим с началом координат, следовательно X=0, Y=0. Координаты финиша пользователь задает самостоятельно. Предположим, пользователь задал координаты X=0.6, Y=1.2. Мобильная платформа, получив данные от оператора, просчитывает угол, на который ему надо повернуться и какое расстояние надо проехать.

Рис.2. Структура алгоритма управления

Мобильная платформа при получении от оператора координат финиша, как упоминалось ранее : X=0.6, Y=1.2, высчитывает угол Q:

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

Расстояние, на которое надо проехать, чтобы достичь нужной точки, высчитывается по теореме Пифагора:

Тем самым, робот самостоятельно доедет до точки, которую задал оператор при условии, что перед ним не возникнут препятствия. Если на пути мобильного робота возникнет препятствие, которое можно преодолеть, траектория движения не изменится, однако, платформа будет знать, что расстояние увеличилось, и надо проехать большее расстояние. В ином случае, когда машинка, оценив габариты препятствия, подаст знак, что надо объезжать, мобильный робот полностью пересчитает траекторию своего движения. Алгоритм перерасчета довольно простой, мобильный робот запоминает, какое расстояние он успел уже проехать за это время до встречи с препятствием (d2), высчитывает разность и получает расстояние, которое надо проехать для достижения финиша.

Затем платформа совершает поворот на угол 900 и начинает движение на некоторое расстояние b, после чего, зная сколько ей не хватало и сколько проехала, рассчитывается новое расстояние до нужной цели (а).

Далее производится расчет параметров для поворота на нужный угол.

Траектория обхода препятствия показана на рис. 3.

Рис. 3. Траектория обхода препятствия.

Выводы

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

Список литературы

математический колесный платформа алгоритм

1. Мартыненко Ю.Г., Охицимский Д.Е. Новые задачи динамики управления движением мобильных колесных роботов.-М.:"Московский государственный университет им. Ломоносова"- 48с.

2. Евстифеев А.В. Микроконтроллеры AVR семейства Mega. Руководство пользователя. - М.: Издательский дом «Додэка - XXI», 2007. - 592 с.: ил. (Серия «Программируемые системы»).

Размещено на Allbest.ru


Подобные документы

  • Классификация колесных наземных мобильных роботов. Обзор приводов мобильных платформ. Особенности стабилизации скорости мобильной платформы Rover 5 с дифференциальным приводом. Разработка алгоритмов управления на основе микроконтроллера Arduino.

    курсовая работа [1,3 M], добавлен 04.05.2017

  • Проектирование и реализация мобильной версии приложения учета и движения товаров на базе платформы Android и языка программирования Java. Создание таблиц базы данных. Взаимодействие объектов и экранные формы. Способы идентификации классов анализа.

    дипломная работа [1,8 M], добавлен 01.09.2016

  • Представление о системе Arduino. Структура платформы Android. Выбор средств разработки. Разработка структур данных и алгоритмов. Характеристика Bluetooth модуля, блок реле, резисторов, диодов. Графический интерфейс приложения. Написание кода программы.

    дипломная работа [4,0 M], добавлен 19.01.2017

  • Определение вращательного движения твердого тела в среде системы MathCAD. Математическая модель объекта или процесса. Алгоритм решения задачи. Составление текста программы в среде Delphi. Таблица идентификаторов. Разработка программного приложения.

    курсовая работа [547,4 K], добавлен 25.03.2015

  • Обзор существующих технологий разработки программного обеспечения. Описание платформы NET Framework. Принцип работы платформы: компиляция исходного кода; процесс загрузки и исполнения кода; IL-код и верификация. Новые возможности платформы NET Framework.

    реферат [30,7 K], добавлен 01.03.2011

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

    курсовая работа [65,4 K], добавлен 21.11.2013

  • Описание и особенности некоторых алгоритмов архивации. Построение кода Хаффмана. Динамический алгоритм построения кода Хаффмана. Обратное восстановление текста. Способы двухступенчатого кодирования информации. Практическая реализация алгоритма LZ77.

    курсовая работа [51,7 K], добавлен 24.12.2012

  • Физическая и математическая модели уравнения движения материальной точки. Блок-схема алгоритма основной программы для решения задачи Коши и получения результатов с фиксированным количеством отрезков разбиения. Разработка программы для ЭВМ, ее листинг.

    курсовая работа [212,3 K], добавлен 24.11.2014

  • Реализация линейных списков в языке программирования C++. Основные операции при работе с ними. Разработка интерфейса и алгоритмов. Описание работы программы на псевдокоде. Составление программного кода. Тестирование, отладка и результат работы программы.

    курсовая работа [1,1 M], добавлен 07.01.2014

  • Методика разработки программы "Обработка результатов экзаменационной сессии", ее содержание и требования. Алгоритм выполнения задач для работы с файлами, взаимодействие с пакетом MS Office, работа с таблицами и проверка правильности входной информации.

    курсовая работа [1016,7 K], добавлен 05.01.2013

Работы в архивах красиво оформлены согласно требованиям ВУЗов и содержат рисунки, диаграммы, формулы и т.д.
PPT, PPTX и PDF-файлы представлены только в архивах.
Рекомендуем скачать работу.