Описание движения мобильного робота

движение робота

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

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

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

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

  • скорость или ускорение движения
  • точность позиционирования (повторяемость)
  • гибкость и робастность (надежность) при различных условиях
  • эффективность (низкое энергопотребление)

 

Система координат

Для того чтобы математически описать движение мобильного робота нам потребуется определить системы координат. Я введу две системы координат —  мировую систему координат W (буду считать что он неподвижна в пространстве), и система координат робота R, которая перемещается в пространстве и остается неподвижной относительно самого робота.

Системы координат

Системы координат

Нам необходимо определить местоположение робота, то есть мы хотим знать, как преобразовывать координаты между W и R.

 

Степени свободы движения

Число степеней свободы определяет минимальное количество независимых переменных (обобщённых координат), необходимых для полного описания движения механической системы.

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

Твердое тело, которое перемещается и вращается на плоскости имеет 3 степени свободы: 2 поступательных и 1 вращательную. Пример: наземный робот.

Твердое тело, которое перемещается и вращается в 3D-объеме имеет 6 степеней свободы: 3 поступательных и 3 вращательных. Пример: летающий робот.

Всенаправленное колесо

Всенаправленное колесо

Особый случай — это так называемый голономный робот, который способен перемещаться мгновенно в любом направлении в пространстве его степеней свободы (робот является голономным если число управляемых степеней свободы равно полному числу степеней свободы). Голономные роботы существуют, но требуют множество моторов и необычный конструктив, что зачастую очень непрактично. Однако, наземные голономные роботы могут быть реализованы с использованием всенаправленных колес (omni-wheels).

На видео показан пример четырехколесного робота со всенаправленными колесами.


 

Конфигурации колесных роботов

Существует множество различных конфигураций мобильных роботов.

Есть те, которые применяются реже, например, двухколесная платформа сигвей (segway) с динамическим балансом обладает хорошей высотой при малой площади и достаточно большим ускорением.

segway_platform

Или марсоход Opportunity, который имеет колеса на штангах для преодоления больших препятсвий.

mars_rover

Но чаще применяются другие типы конфигураций.

Это простые, надежные, прочные механизмы, пригодные для роботов, которые в основном передвигаются по плоскости.

Все эти роботы неголономны (используется два двигателя, но три степени свободы движения). Например, автомобилеподобный робот не может мгновенно двигаться в сторону.

Стандартный колесные конфигурации

Стандартный колесные конфигурации

 

Робот с дифференциальным приводом

Дифференциальный привод

Дифференциальный привод

Такая конфигурация используется в роботах-пылесосах.

Робот с дифференциальным приводом имеет два мотора, по одному на каждое колесо (на рисунке — это большие колеса). Изменение направления движения достигается за счет разных скоростей (отсюда и название — дифференциальный).

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

криволинейный путь робота с дифференциальным приводом

Движение по дуге

Обозначим скорости колес (линейные скорости с которыми они «покрывают» поверхность)

*** QuickLaTeX cannot compile formula:
V_L
*** Error message:
Cannot connect to QuickLaTeX server: SSL certificate problem: certificate has expired
Please make sure your server/PHP settings allow HTTP requests to external resources ("allow_url_fopen", etc.)
These links might help in finding solution:
http://wordpress.org/extend/plugins/core-control/
http://wordpress.org/support/topic/an-unexpected-http-error-occurred-during-the-api-request-on-wordpress-3?replies=37
 и
*** QuickLaTeX cannot compile formula:
V_R

*** Error message:
Cannot connect to QuickLaTeX server: SSL certificate problem: certificate has expired
Please make sure your server/PHP settings allow HTTP requests to external resources ("allow_url_fopen", etc.)
These links might help in finding solution:
http://wordpress.org/extend/plugins/core-control/
http://wordpress.org/support/topic/an-unexpected-http-error-occurred-during-the-api-request-on-wordpress-3?replies=37
 - для левого и правого колес, соответственно, и
*** QuickLaTeX cannot compile formula:
W

*** Error message:
Cannot connect to QuickLaTeX server: SSL certificate problem: certificate has expired
Please make sure your server/PHP settings allow HTTP requests to external resources ("allow_url_fopen", etc.)
These links might help in finding solution:
http://wordpress.org/extend/plugins/core-control/
http://wordpress.org/support/topic/an-unexpected-http-error-occurred-during-the-api-request-on-wordpress-3?replies=37

расстояние между колесами.

  • Прямолинейное движение, если
    *** QuickLaTeX cannot compile formula:
    V_L = V_R
    *** Error message:
    Cannot connect to QuickLaTeX server: SSL certificate problem: certificate has expired
    Please make sure your server/PHP settings allow HTTP requests to external resources ("allow_url_fopen", etc.)
    These links might help in finding solution:
    http://wordpress.org/extend/plugins/core-control/
    http://wordpress.org/support/topic/an-unexpected-http-error-occurred-during-the-api-request-on-wordpress-3?replies=37
  • Разворот на месте, если 
    *** QuickLaTeX cannot compile formula:
    V_L = - V_R
    *** Error message:
    Cannot connect to QuickLaTeX server: SSL certificate problem: certificate has expired
    Please make sure your server/PHP settings allow HTTP requests to external resources ("allow_url_fopen", etc.)
    These links might help in finding solution:
    http://wordpress.org/extend/plugins/core-control/
    http://wordpress.org/support/topic/an-unexpected-http-error-occurred-during-the-api-request-on-wordpress-3?replies=37
  • В более общем случае — движение по дуге

Для того, чтобы найти радиус

*** QuickLaTeX cannot compile formula:
R
*** Error message:
Cannot connect to QuickLaTeX server: SSL certificate problem: certificate has expired
Please make sure your server/PHP settings allow HTTP requests to external resources ("allow_url_fopen", etc.)
These links might help in finding solution:
http://wordpress.org/extend/plugins/core-control/
http://wordpress.org/support/topic/an-unexpected-http-error-occurred-during-the-api-request-on-wordpress-3?replies=37
криволинейного пути, рассмотрим период движения
*** QuickLaTeX cannot compile formula:
\Delta t

*** Error message:
Cannot connect to QuickLaTeX server: SSL certificate problem: certificate has expired
Please make sure your server/PHP settings allow HTTP requests to external resources ("allow_url_fopen", etc.)
These links might help in finding solution:
http://wordpress.org/extend/plugins/core-control/
http://wordpress.org/support/topic/an-unexpected-http-error-occurred-during-the-api-request-on-wordpress-3?replies=37
, в течении которого робот движется вдоль дуги окружности, имеющей угол 
*** QuickLaTeX cannot compile formula:
\Delta \theta

*** Error message:
Cannot connect to QuickLaTeX server: SSL certificate problem: certificate has expired
Please make sure your server/PHP settings allow HTTP requests to external resources ("allow_url_fopen", etc.)
These links might help in finding solution:
http://wordpress.org/extend/plugins/core-control/
http://wordpress.org/support/topic/an-unexpected-http-error-occurred-during-the-api-request-on-wordpress-3?replies=37

.

  • Левое колесо: пройденное расстояние =
    *** QuickLaTeX cannot compile formula:
    V_L \Delta t
    *** Error message:
    Cannot connect to QuickLaTeX server: SSL certificate problem: certificate has expired
    Please make sure your server/PHP settings allow HTTP requests to external resources ("allow_url_fopen", etc.)
    These links might help in finding solution:
    http://wordpress.org/extend/plugins/core-control/
    http://wordpress.org/support/topic/an-unexpected-http-error-occurred-during-the-api-request-on-wordpress-3?replies=37
    ; радиус дуги = 
    *** QuickLaTeX cannot compile formula:
    R - \frac{W}{2}
    
    *** Error message:
    Cannot connect to QuickLaTeX server: SSL certificate problem: certificate has expired
    Please make sure your server/PHP settings allow HTTP requests to external resources ("allow_url_fopen", etc.)
    These links might help in finding solution:
    http://wordpress.org/extend/plugins/core-control/
    http://wordpress.org/support/topic/an-unexpected-http-error-occurred-during-the-api-request-on-wordpress-3?replies=37
  • Правое колесо: пройденное расстояние =
    *** QuickLaTeX cannot compile formula:
    V_R \Delta t
    *** Error message:
    Cannot connect to QuickLaTeX server: SSL certificate problem: certificate has expired
    Please make sure your server/PHP settings allow HTTP requests to external resources ("allow_url_fopen", etc.)
    These links might help in finding solution:
    http://wordpress.org/extend/plugins/core-control/
    http://wordpress.org/support/topic/an-unexpected-http-error-occurred-during-the-api-request-on-wordpress-3?replies=37
    ; радиус дуги = 
    *** QuickLaTeX cannot compile formula:
    R - \frac{W}{2}
    
    *** Error message:
    Cannot connect to QuickLaTeX server: SSL certificate problem: certificate has expired
    Please make sure your server/PHP settings allow HTTP requests to external resources ("allow_url_fopen", etc.)
    These links might help in finding solution:
    http://wordpress.org/extend/plugins/core-control/
    http://wordpress.org/support/topic/an-unexpected-http-error-occurred-during-the-api-request-on-wordpress-3?replies=37
  • Обе колесные дуги имеют в основании один и тот же угол 
    *** QuickLaTeX cannot compile formula:
    \Delta \theta
    *** Error message:
    Cannot connect to QuickLaTeX server: SSL certificate problem: certificate has expired
    Please make sure your server/PHP settings allow HTTP requests to external resources ("allow_url_fopen", etc.)
    These links might help in finding solution:
    http://wordpress.org/extend/plugins/core-control/
    http://wordpress.org/support/topic/an-unexpected-http-error-occurred-during-the-api-request-on-wordpress-3?replies=37
*** QuickLaTeX cannot compile formula:
\[\Delta\theta = \frac{V_L\Delta t}{R-\frac{W}{2}} = \frac{V_R \Delta t}{R + \frac{W}{2}}\]
*** Error message:
Cannot connect to QuickLaTeX server: SSL certificate problem: certificate has expired
Please make sure your server/PHP settings allow HTTP requests to external resources ("allow_url_fopen", etc.)
These links might help in finding solution:
http://wordpress.org/extend/plugins/core-control/
http://wordpress.org/support/topic/an-unexpected-http-error-occurred-during-the-api-request-on-wordpress-3?replies=37
*** QuickLaTeX cannot compile formula:
\[\Rightarrow \frac{W}{2} (V_L+V_R) = R(V_R - V_L)\]
*** Error message:
Cannot connect to QuickLaTeX server: SSL certificate problem: certificate has expired
Please make sure your server/PHP settings allow HTTP requests to external resources ("allow_url_fopen", etc.)
These links might help in finding solution:
http://wordpress.org/extend/plugins/core-control/
http://wordpress.org/support/topic/an-unexpected-http-error-occurred-during-the-api-request-on-wordpress-3?replies=37
*** QuickLaTeX cannot compile formula:
\[\Rightarrow R = \frac{W(V_R+V_L)}{2(V_R-V_L}~~~~~ \Delta\theta = \frac{(V_R-V_L)\Delta t}{W}\]
*** Error message:
Cannot connect to QuickLaTeX server: SSL certificate problem: certificate has expired
Please make sure your server/PHP settings allow HTTP requests to external resources ("allow_url_fopen", etc.)
These links might help in finding solution:
http://wordpress.org/extend/plugins/core-control/
http://wordpress.org/support/topic/an-unexpected-http-error-occurred-during-the-api-request-on-wordpress-3?replies=37

 

Автомобиль/Трицикл/Реечно-зубчатый привод

Такой тип роботов имеет два мотора — один для движения, другой для рулежки.

  • Не может нормально развернуться на месте.
  • При постоянной скорости и угле поворота движется по дуге окружности.
  • В четырехколесной схеме необходим задний дифференциал и переменная связь («Принцип Аккермана») на рулевые колеса.

Круговой путь автомобилеподобного трехколесного робота

Круговое движение трехколесного робота

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

*** QuickLaTeX cannot compile formula:
\[R = \frac{L}{\tan s}\]
*** Error message:
Cannot connect to QuickLaTeX server: SSL certificate problem: certificate has expired
Please make sure your server/PHP settings allow HTTP requests to external resources ("allow_url_fopen", etc.)
These links might help in finding solution:
http://wordpress.org/extend/plugins/core-control/
http://wordpress.org/support/topic/an-unexpected-http-error-occurred-during-the-api-request-on-wordpress-3?replies=37

Радиус траектории, которую описывают задние колеса:

*** QuickLaTeX cannot compile formula:
\[R_d = \frac{L}{\sin s}\]
*** Error message:
Cannot connect to QuickLaTeX server: SSL certificate problem: certificate has expired
Please make sure your server/PHP settings allow HTTP requests to external resources ("allow_url_fopen", etc.)
These links might help in finding solution:
http://wordpress.org/extend/plugins/core-control/
http://wordpress.org/support/topic/an-unexpected-http-error-occurred-during-the-api-request-on-wordpress-3?replies=37

За время

*** QuickLaTeX cannot compile formula:
\Delta t
*** Error message:
Cannot connect to QuickLaTeX server: SSL certificate problem: certificate has expired
Please make sure your server/PHP settings allow HTTP requests to external resources ("allow_url_fopen", etc.)
These links might help in finding solution:
http://wordpress.org/extend/plugins/core-control/
http://wordpress.org/support/topic/an-unexpected-http-error-occurred-during-the-api-request-on-wordpress-3?replies=37
расстояние вдоль этой дуги окружности, пройденное приводными колесами равно
*** QuickLaTeX cannot compile formula:
v\Delta t

*** Error message:
Cannot connect to QuickLaTeX server: SSL certificate problem: certificate has expired
Please make sure your server/PHP settings allow HTTP requests to external resources ("allow_url_fopen", etc.)
These links might help in finding solution:
http://wordpress.org/extend/plugins/core-control/
http://wordpress.org/support/topic/an-unexpected-http-error-occurred-during-the-api-request-on-wordpress-3?replies=37
, поэтому угол
*** QuickLaTeX cannot compile formula:
\Delta \theta

*** Error message:
Cannot connect to QuickLaTeX server: SSL certificate problem: certificate has expired
Please make sure your server/PHP settings allow HTTP requests to external resources ("allow_url_fopen", etc.)
These links might help in finding solution:
http://wordpress.org/extend/plugins/core-control/
http://wordpress.org/support/topic/an-unexpected-http-error-occurred-during-the-api-request-on-wordpress-3?replies=37

на который повернется робот:

*** QuickLaTeX cannot compile formula:
\[\Delta \theta = \frac{V\Delta t}{R_d} = \frac{V \Delta t \sin s}{L}\]
*** Error message:
Cannot connect to QuickLaTeX server: SSL certificate problem: certificate has expired
Please make sure your server/PHP settings allow HTTP requests to external resources ("allow_url_fopen", etc.)
These links might help in finding solution:
http://wordpress.org/extend/plugins/core-control/
http://wordpress.org/support/topic/an-unexpected-http-error-occurred-during-the-api-request-on-wordpress-3?replies=37
*** QuickLaTeX cannot compile formula:
\[R = \frac{L}{\tan s}~~~~\Delta \theta = \frac{V \Delta t\sin s}{L}\]
*** Error message:
Cannot connect to QuickLaTeX server: SSL certificate problem: certificate has expired
Please make sure your server/PHP settings allow HTTP requests to external resources ("allow_url_fopen", etc.)
These links might help in finding solution:
http://wordpress.org/extend/plugins/core-control/
http://wordpress.org/support/topic/an-unexpected-http-error-occurred-during-the-api-request-on-wordpress-3?replies=37

 

Зубчатая передача

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

Зубчатые передачи

Зубчатые передачи

Если Передача 1 имеет крутящий момент 
*** QuickLaTeX cannot compile formula:
t_1

*** Error message:
Cannot connect to QuickLaTeX server: SSL certificate problem: certificate has expired
Please make sure your server/PHP settings allow HTTP requests to external resources ("allow_url_fopen", etc.)
These links might help in finding solution:
http://wordpress.org/extend/plugins/core-control/
http://wordpress.org/support/topic/an-unexpected-http-error-occurred-during-the-api-request-on-wordpress-3?replies=37

, она оказывает тангенциальную силу

*** QuickLaTeX cannot compile formula:
\[F = \frac{t_1}{r_1} \]
*** Error message:
Cannot connect to QuickLaTeX server: SSL certificate problem: certificate has expired
Please make sure your server/PHP settings allow HTTP requests to external resources ("allow_url_fopen", etc.)
These links might help in finding solution:
http://wordpress.org/extend/plugins/core-control/
http://wordpress.org/support/topic/an-unexpected-http-error-occurred-during-the-api-request-on-wordpress-3?replies=37

на Передачу 2. Крутящий момент Передачи 2 поэтому

*** QuickLaTeX cannot compile formula:
\[t_2 = r_2F = \frac{r_2}{r_1}t_1\]
*** Error message:
Cannot connect to QuickLaTeX server: SSL certificate problem: certificate has expired
Please make sure your server/PHP settings allow HTTP requests to external resources ("allow_url_fopen", etc.)
These links might help in finding solution:
http://wordpress.org/extend/plugins/core-control/
http://wordpress.org/support/topic/an-unexpected-http-error-occurred-during-the-api-request-on-wordpress-3?replies=37

Изменение угловой скорости между Передачей 1 и Передачей 2 вычислим, рассмотрев скорость в точке где они соприкасаются:

*** QuickLaTeX cannot compile formula:
\[V = \omega_1 r_1 = \omega_2 r_2\]
*** Error message:
Cannot connect to QuickLaTeX server: SSL certificate problem: certificate has expired
Please make sure your server/PHP settings allow HTTP requests to external resources ("allow_url_fopen", etc.)
These links might help in finding solution:
http://wordpress.org/extend/plugins/core-control/
http://wordpress.org/support/topic/an-unexpected-http-error-occurred-during-the-api-request-on-wordpress-3?replies=37
*** QuickLaTeX cannot compile formula:
\[\Rightarrow \omega_2 = \frac{r_1}{r_2}\omega_1\]
*** Error message:
Cannot connect to QuickLaTeX server: SSL certificate problem: certificate has expired
Please make sure your server/PHP settings allow HTTP requests to external resources ("allow_url_fopen", etc.)
These links might help in finding solution:
http://wordpress.org/extend/plugins/core-control/
http://wordpress.org/support/topic/an-unexpected-http-error-occurred-during-the-api-request-on-wordpress-3?replies=37
  • Когда маленькая шестерня приводит в движение большую, второе зубчатое колесо будет иметь более высокий крутящий момент и меньшую угловую скорость пропорционально соотношению зубьев.
  • Для достижения комбинированного воздействия шестерни можно объединять в цепочки.

 

Оценка движения c помощью датчиков

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

Например, на основе очень простой оценки:

*** QuickLaTeX cannot compile formula:
\[D=KV\Delta t\]
*** Error message:
Cannot connect to QuickLaTeX server: SSL certificate problem: certificate has expired
Please make sure your server/PHP settings allow HTTP requests to external resources ("allow_url_fopen", etc.)
These links might help in finding solution:
http://wordpress.org/extend/plugins/core-control/
http://wordpress.org/support/topic/an-unexpected-http-error-occurred-during-the-api-request-on-wordpress-3?replies=37
Пройденное расстояние пропорционально напряжению и времени. Здесь
*** QuickLaTeX cannot compile formula:
K

*** Error message:
Cannot connect to QuickLaTeX server: SSL certificate problem: certificate has expired
Please make sure your server/PHP settings allow HTTP requests to external resources ("allow_url_fopen", etc.)
These links might help in finding solution:
http://wordpress.org/extend/plugins/core-control/
http://wordpress.org/support/topic/an-unexpected-http-error-occurred-during-the-api-request-on-wordpress-3?replies=37

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

  • Калибровка включает экспериментальное перемещение робота и сравнение фактического значения пройденного расстояния, со значением, полученным в результате теоретической оценки. Отношение фактического к теоретическому значениям и является коэффициентом калибровки.
  • Если при повторных испытаниях будет наблюдаться расхождения в полученных значениях, мы можем повысить точность путем изменения значения констант в наших выражений (таких как 
    *** QuickLaTeX cannot compile formula:
    K
    *** Error message:
    Cannot connect to QuickLaTeX server: SSL certificate problem: certificate has expired
    Please make sure your server/PHP settings allow HTTP requests to external resources ("allow_url_fopen", etc.)
    These links might help in finding solution:
    http://wordpress.org/extend/plugins/core-control/
    http://wordpress.org/support/topic/an-unexpected-http-error-occurred-during-the-api-request-on-wordpress-3?replies=37
    ), а затем повторить процесс.

Энкодеры дают большую точность измерения числа оборотов колес. Информация с энкодера может быть преобразована в линейное расстояние умножением на постоянный радиус колеса. Но все же, как правило, для большей точности, все равно проводится калибровка.

 

Движение и состояние робота для плоскости

Если предположить, что робот ограничивается перемещением на плоскости, его местоположение может быть определено вектором состояния
*** QuickLaTeX cannot compile formula:
X

*** Error message:
Cannot connect to QuickLaTeX server: SSL certificate problem: certificate has expired
Please make sure your server/PHP settings allow HTTP requests to external resources ("allow_url_fopen", etc.)
These links might help in finding solution:
http://wordpress.org/extend/plugins/core-control/
http://wordpress.org/support/topic/an-unexpected-http-error-occurred-during-the-api-request-on-wordpress-3?replies=37

, состоящем из трех параметров:

*** QuickLaTeX cannot compile formula:
\[X = \left(\begin{array}{c}x \\ y \\ \theta \end{array}\right) \]
*** Error message:
Cannot connect to QuickLaTeX server: SSL certificate problem: certificate has expired
Please make sure your server/PHP settings allow HTTP requests to external resources ("allow_url_fopen", etc.)
These links might help in finding solution:
http://wordpress.org/extend/plugins/core-control/
http://wordpress.org/support/topic/an-unexpected-http-error-occurred-during-the-api-request-on-wordpress-3?replies=37
*** QuickLaTeX cannot compile formula:
x
*** Error message:
Cannot connect to QuickLaTeX server: SSL certificate problem: certificate has expired
Please make sure your server/PHP settings allow HTTP requests to external resources ("allow_url_fopen", etc.)
These links might help in finding solution:
http://wordpress.org/extend/plugins/core-control/
http://wordpress.org/support/topic/an-unexpected-http-error-occurred-during-the-api-request-on-wordpress-3?replies=37
 и
*** QuickLaTeX cannot compile formula:
y

*** Error message:
Cannot connect to QuickLaTeX server: SSL certificate problem: certificate has expired
Please make sure your server/PHP settings allow HTTP requests to external resources ("allow_url_fopen", etc.)
These links might help in finding solution:
http://wordpress.org/extend/plugins/core-control/
http://wordpress.org/support/topic/an-unexpected-http-error-occurred-during-the-api-request-on-wordpress-3?replies=37

определяют местоположение предопределенной точки «центра робота» в мировой системе координат.

*** QuickLaTeX cannot compile formula:
\theta
*** Error message:
Cannot connect to QuickLaTeX server: SSL certificate problem: certificate has expired
Please make sure your server/PHP settings allow HTTP requests to external resources ("allow_url_fopen", etc.)
These links might help in finding solution:
http://wordpress.org/extend/plugins/core-control/
http://wordpress.org/support/topic/an-unexpected-http-error-occurred-during-the-api-request-on-wordpress-3?replies=37
определяет угол поворота между системами координат (угол между осями
*** QuickLaTeX cannot compile formula:
x^W

*** Error message:
Cannot connect to QuickLaTeX server: SSL certificate problem: certificate has expired
Please make sure your server/PHP settings allow HTTP requests to external resources ("allow_url_fopen", etc.)
These links might help in finding solution:
http://wordpress.org/extend/plugins/core-control/
http://wordpress.org/support/topic/an-unexpected-http-error-occurred-during-the-api-request-on-wordpress-3?replies=37
и
*** QuickLaTeX cannot compile formula:
x^R

*** Error message:
Cannot connect to QuickLaTeX server: SSL certificate problem: certificate has expired
Please make sure your server/PHP settings allow HTTP requests to external resources ("allow_url_fopen", etc.)
These links might help in finding solution:
http://wordpress.org/extend/plugins/core-control/
http://wordpress.org/support/topic/an-unexpected-http-error-occurred-during-the-api-request-on-wordpress-3?replies=37

).

Две системы координат совпадают в момент, когда центр робота находится в начале координат и
*** QuickLaTeX cannot compile formula:
x = y = \theta = 0

*** Error message:
Cannot connect to QuickLaTeX server: SSL certificate problem: certificate has expired
Please make sure your server/PHP settings allow HTTP requests to external resources ("allow_url_fopen", etc.)
These links might help in finding solution:
http://wordpress.org/extend/plugins/core-control/
http://wordpress.org/support/topic/an-unexpected-http-error-occurred-during-the-api-request-on-wordpress-3?replies=37

.

 

Интегральное движение на плоскости

Получая перемещения робота в некоторые моменты времени, мы можем найти весь путь, пройденный роботом, просуммировав эти значения, или перейдя к пределу (при стремлении количества измерений
*** QuickLaTeX cannot compile formula:
\rightarrow \infty

*** Error message:
Cannot connect to QuickLaTeX server: SSL certificate problem: certificate has expired
Please make sure your server/PHP settings allow HTTP requests to external resources ("allow_url_fopen", etc.)
These links might help in finding solution:
http://wordpress.org/extend/plugins/core-control/
http://wordpress.org/support/topic/an-unexpected-http-error-occurred-during-the-api-request-on-wordpress-3?replies=37

) — путем их интегрирования.

При движении на плоскости мы имеем три степени свободы для определения положения, представленные
*** QuickLaTeX cannot compile formula:
(x, y, \theta)

*** Error message:
Cannot connect to QuickLaTeX server: SSL certificate problem: certificate has expired
Please make sure your server/PHP settings allow HTTP requests to external resources ("allow_url_fopen", etc.)
These links might help in finding solution:
http://wordpress.org/extend/plugins/core-control/
http://wordpress.org/support/topic/an-unexpected-http-error-occurred-during-the-api-request-on-wordpress-3?replies=37
при
*** QuickLaTeX cannot compile formula:
\pi < \theta \le \pi

*** Error message:
Cannot connect to QuickLaTeX server: SSL certificate problem: certificate has expired
Please make sure your server/PHP settings allow HTTP requests to external resources ("allow_url_fopen", etc.)
These links might help in finding solution:
http://wordpress.org/extend/plugins/core-control/
http://wordpress.org/support/topic/an-unexpected-http-error-occurred-during-the-api-request-on-wordpress-3?replies=37

.

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

Движение робота на плоскости

Движение робота на плоскости

При прямолинейном движении робота на расстояние
*** QuickLaTeX cannot compile formula:
D

*** Error message:
Cannot connect to QuickLaTeX server: SSL certificate problem: certificate has expired
Please make sure your server/PHP settings allow HTTP requests to external resources ("allow_url_fopen", etc.)
These links might help in finding solution:
http://wordpress.org/extend/plugins/core-control/
http://wordpress.org/support/topic/an-unexpected-http-error-occurred-during-the-api-request-on-wordpress-3?replies=37

новое состояние будет выражено как:

*** QuickLaTeX cannot compile formula:
\[ \left(\begin{array}{c}x_{new} \\ y_{new} \\ \theta_{new} \end{array}\right) = \left(\begin{array}{c}x + D \cos \theta\\ y + D \sin \theta \\ \theta \end{array}\right) \]
*** Error message:
Cannot connect to QuickLaTeX server: SSL certificate problem: certificate has expired
Please make sure your server/PHP settings allow HTTP requests to external resources ("allow_url_fopen", etc.)
These links might help in finding solution:
http://wordpress.org/extend/plugins/core-control/
http://wordpress.org/support/topic/an-unexpected-http-error-occurred-during-the-api-request-on-wordpress-3?replies=37
Если присутствует только вращательное движение, при повороте на угол
*** QuickLaTeX cannot compile formula:
\alpha

*** Error message:
Cannot connect to QuickLaTeX server: SSL certificate problem: certificate has expired
Please make sure your server/PHP settings allow HTTP requests to external resources ("allow_url_fopen", etc.)
These links might help in finding solution:
http://wordpress.org/extend/plugins/core-control/
http://wordpress.org/support/topic/an-unexpected-http-error-occurred-during-the-api-request-on-wordpress-3?replies=37

:

*** QuickLaTeX cannot compile formula:
\[ \left(\begin{array}{c}x_{new} \\ y_{new} \\ \theta_{new} \end{array}\right) = \left(\begin{array}{c}x \\ y \\ \theta + \alpha \end{array}\right) \]
*** Error message:
Cannot connect to QuickLaTeX server: SSL certificate problem: certificate has expired
Please make sure your server/PHP settings allow HTTP requests to external resources ("allow_url_fopen", etc.)
These links might help in finding solution:
http://wordpress.org/extend/plugins/core-control/
http://wordpress.org/support/topic/an-unexpected-http-error-occurred-during-the-api-request-on-wordpress-3?replies=37

 

Оценка кругового 2D движения

Движение по окружности

Движение по окружности

Для случаев и дифференциального и трехколесного роботов мы можем получить выражения для
*** QuickLaTeX cannot compile formula:
R

*** Error message:
Cannot connect to QuickLaTeX server: SSL certificate problem: certificate has expired
Please make sure your server/PHP settings allow HTTP requests to external resources ("allow_url_fopen", etc.)
These links might help in finding solution:
http://wordpress.org/extend/plugins/core-control/
http://wordpress.org/support/topic/an-unexpected-http-error-occurred-during-the-api-request-on-wordpress-3?replies=37
и
*** QuickLaTeX cannot compile formula:
\Delta \theta

*** Error message:
Cannot connect to QuickLaTeX server: SSL certificate problem: certificate has expired
Please make sure your server/PHP settings allow HTTP requests to external resources ("allow_url_fopen", etc.)
These links might help in finding solution:
http://wordpress.org/extend/plugins/core-control/
http://wordpress.org/support/topic/an-unexpected-http-error-occurred-during-the-api-request-on-wordpress-3?replies=37

для случая когда присутствует только движение по дуге окружности:

*** QuickLaTeX cannot compile formula:
\[ \left(\begin{array}{c}x_{new} \\ y_{new} \\ \theta_{new} \end{array}\right) = \left(\begin{array}{c}x + R(\sin(\Delta \theta + \theta) - \sin \theta) \\ y - R(\cos(\Delta \theta + \theta) - \cos \theta) \\ \theta + \Delta \theta \end{array}\right) \]
*** Error message:
Cannot connect to QuickLaTeX server: SSL certificate problem: certificate has expired
Please make sure your server/PHP settings allow HTTP requests to external resources ("allow_url_fopen", etc.)
These links might help in finding solution:
http://wordpress.org/extend/plugins/core-control/
http://wordpress.org/support/topic/an-unexpected-http-error-occurred-during-the-api-request-on-wordpress-3?replies=37

 

Планирование маршрута

Планирование маршрута, основываясь на положении

Планирование маршрута, основываясь на положении

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

  • Движение робота состоит из прямолинейных отрезков отдельно от разворотов на месте.
  • Робот стремится свести к минимуму общее пройденное расстояние, так что он всегда сразу поворачивается лицом к следующей точке и едет прямо к ней.
На первом шаге планирования маршрута, предположим, что текущее положение робота
*** QuickLaTeX cannot compile formula:
(x, y, \theta)

*** Error message:
Cannot connect to QuickLaTeX server: SSL certificate problem: certificate has expired
Please make sure your server/PHP settings allow HTTP requests to external resources ("allow_url_fopen", etc.)
These links might help in finding solution:
http://wordpress.org/extend/plugins/core-control/
http://wordpress.org/support/topic/an-unexpected-http-error-occurred-during-the-api-request-on-wordpress-3?replies=37
и следующей точкой маршрута является
*** QuickLaTeX cannot compile formula:
(W_x, W_y)

*** Error message:
Cannot connect to QuickLaTeX server: SSL certificate problem: certificate has expired
Please make sure your server/PHP settings allow HTTP requests to external resources ("allow_url_fopen", etc.)
These links might help in finding solution:
http://wordpress.org/extend/plugins/core-control/
http://wordpress.org/support/topic/an-unexpected-http-error-occurred-during-the-api-request-on-wordpress-3?replies=37

.

  • Сначала робот должен повернуться к указанной точке. Вектор направления должен указывать на:
*** QuickLaTeX cannot compile formula:
\[ \left(\begin{array}{c}d_x \\ d_y \end{array}\right) = \left(\begin{array}{c}W_x - x \\ W_y - y  \end{array}\right) \]
*** Error message:
Cannot connect to QuickLaTeX server: SSL certificate problem: certificate has expired
Please make sure your server/PHP settings allow HTTP requests to external resources ("allow_url_fopen", etc.)
These links might help in finding solution:
http://wordpress.org/extend/plugins/core-control/
http://wordpress.org/support/topic/an-unexpected-http-error-occurred-during-the-api-request-on-wordpress-3?replies=37
Значение абсолютного значения угла в градусах
*** QuickLaTeX cannot compile formula:
\alpha

*** Error message:
Cannot connect to QuickLaTeX server: SSL certificate problem: certificate has expired
Please make sure your server/PHP settings allow HTTP requests to external resources ("allow_url_fopen", etc.)
These links might help in finding solution:
http://wordpress.org/extend/plugins/core-control/
http://wordpress.org/support/topic/an-unexpected-http-error-occurred-during-the-api-request-on-wordpress-3?replies=37

в который робот должен повернуться:

*** QuickLaTeX cannot compile formula:
\[\alpha = \tan^{-1}\frac{d_y}{d_x} \]
*** Error message:
Cannot connect to QuickLaTeX server: SSL certificate problem: certificate has expired
Please make sure your server/PHP settings allow HTTP requests to external resources ("allow_url_fopen", etc.)
These links might help in finding solution:
http://wordpress.org/extend/plugins/core-control/
http://wordpress.org/support/topic/an-unexpected-http-error-occurred-during-the-api-request-on-wordpress-3?replies=37
Необходимо убедиться, что
*** QuickLaTeX cannot compile formula:
\alpha

*** Error message:
Cannot connect to QuickLaTeX server: SSL certificate problem: certificate has expired
Please make sure your server/PHP settings allow HTTP requests to external resources ("allow_url_fopen", etc.)
These links might help in finding solution:
http://wordpress.org/extend/plugins/core-control/
http://wordpress.org/support/topic/an-unexpected-http-error-occurred-during-the-api-request-on-wordpress-3?replies=37
находится в правильном квадранте, в промежутке
*** QuickLaTeX cannot compile formula:
-\pi < \alpha \le \frac{\pi}{2}

*** Error message:
Cannot connect to QuickLaTeX server: SSL certificate problem: certificate has expired
Please make sure your server/PHP settings allow HTTP requests to external resources ("allow_url_fopen", etc.)
These links might help in finding solution:
http://wordpress.org/extend/plugins/core-control/
http://wordpress.org/support/topic/an-unexpected-http-error-occurred-during-the-api-request-on-wordpress-3?replies=37

.

  • Робот уже повернут на определенный угол, поэтому угол на который он должен повернуться
    *** QuickLaTeX cannot compile formula:
    \beta = \alpha - \theta
    *** Error message:
    Cannot connect to QuickLaTeX server: SSL certificate problem: certificate has expired
    Please make sure your server/PHP settings allow HTTP requests to external resources ("allow_url_fopen", etc.)
    These links might help in finding solution:
    http://wordpress.org/extend/plugins/core-control/
    http://wordpress.org/support/topic/an-unexpected-http-error-occurred-during-the-api-request-on-wordpress-3?replies=37
    . Чтобы робот двигался наиболее эффективно, нужно сдвинуть угол, добавив или вычитая
    *** QuickLaTeX cannot compile formula:
    2\pi
    
    *** Error message:
    Cannot connect to QuickLaTeX server: SSL certificate problem: certificate has expired
    Please make sure your server/PHP settings allow HTTP requests to external resources ("allow_url_fopen", etc.)
    These links might help in finding solution:
    http://wordpress.org/extend/plugins/core-control/
    http://wordpress.org/support/topic/an-unexpected-http-error-occurred-during-the-api-request-on-wordpress-3?replies=37
    , чтобы
    *** QuickLaTeX cannot compile formula:
    -\pi < \beta \le \pi
    
    *** Error message:
    Cannot connect to QuickLaTeX server: SSL certificate problem: certificate has expired
    Please make sure your server/PHP settings allow HTTP requests to external resources ("allow_url_fopen", etc.)
    These links might help in finding solution:
    http://wordpress.org/extend/plugins/core-control/
    http://wordpress.org/support/topic/an-unexpected-http-error-occurred-during-the-api-request-on-wordpress-3?replies=37
    .
  • После этого, робот должен двигаться по прямой на расстояние
    *** QuickLaTeX cannot compile formula:
    d = \sqrt{d_x^2 + d_y^2}
    *** Error message:
    Cannot connect to QuickLaTeX server: SSL certificate problem: certificate has expired
    Please make sure your server/PHP settings allow HTTP requests to external resources ("allow_url_fopen", etc.)
    These links might help in finding solution:
    http://wordpress.org/extend/plugins/core-control/
    http://wordpress.org/support/topic/an-unexpected-http-error-occurred-during-the-api-request-on-wordpress-3?replies=37
    .
 
Как вы оцениваете эту публикацию? 1 звезда2 звезды3 звезды4 звезды5 звезд (21 голосов, средняя оценка: 4.86 из 5)
Loading ... Loading ...

Вы можете пропустить чтение записи и оставить комментарий. Размещение ссылок запрещено.

2 комментария к записи “Описание движения мобильного робота”

  1. Юрий пишет:

    На роботе-танке есть компас, датчики вращения колес и блютус связь с компьютером (плюс датчики препятствий и микроконтроллер). Задача- отобразить на экране переданный от робота маршрут движения по лабиринту.

    Пожалуйста посоветуйте:

    1-какую программу применить для графического отображения пакета данных

    (азимут + число оборотов колеса)? Лучше в процессе движения ,в крайнем

    случае — таблица в конечной точке маршрута.

    2-как передать данные со входного порта компьютера в эту программу?

    Заранее благодарен.

    Юрий

    • Юрий, здравствуйте!

      Самый простой способ визуализировать данные — использовать встроенный в Arduino IDE инструмент Serial Plotter. Для рисования траектории и визуализации каких-то дополнительных параметров придется писать самописную программку. Простенький язык специально предназначенный для подобных задач называется Processing. Есть видео.

      Hello world! на Processing.

      Также для реализации коммуникации между микроконтроллером и ПО, которое запущено на компьютере существует специальный протокол Firmata.

Оставить комментарий