Расширенный фильтр Калмана с использованием модели движения одометрии

14

На этапе прогнозирования локализации EKF должна быть выполнена линеаризация и (как упомянуто в вероятностной робототехнике [THRUN, BURGARD, FOX] стр. 206) матрица Якоби при использовании скоростной модели движения, определяемая как

[ИксYθ]'знак равно[ИксYθ]+[v^Tω^T(-грехθ+грех(θ+ω^TΔT))v^Tω^T(созθ-соз(θ+ω^TΔT))ω^TΔT]

рассчитывается как

граммTзнак равно[10υTωT(-соsμT-1,θ+соs(μT-1,θ+ωTΔT))01υTωT(-sяNμT-1,θ+sяN(μT-1,θ+ωTΔT))001] .

Применяется ли то же самое при использовании модели движения одометрии (описанной в той же книге, стр. 133), где движение робота аппроксимируется вращением , переводом и второе вращение ? Соответствующие уравнения:δ^роT1δ^δ^роT2

[ИксYθ]'знак равно[ИксYθ]+[δ^соз(θ+δ^роT1)δ^грех(θ+δ^роT1)δ^роT1+δ^роT2] .

В этом случае якобиан

граммTзнак равно[10-δ^sяN(θ+δ^роT1)01-δ^соs(θ+δ^роT1)001] .

Является ли хорошей практикой использование модели движения одометрии вместо скорости для локализации мобильного робота?

Zst
источник
Я считаю, что ваш термин d_y / d_theta должен быть положительным, а не отрицательным (т. Е. Должен быть + \ hat {\ delta} cos (θ + \ hat {\ delta} _ {rot1}))
rcv

Ответы:

9

Вы задали два вопроса. Как я их понимаю, они:

  1. Необходимо ли линеаризовать модель движения одометрии для использования с расширенным фильтром Калмана (EKF)?
  2. Лучше использовать модель движения одометрии вместо модели скоростного движения.

Что касается вопроса 1, краткий ответ «да». Гарантии фильтра Калмана (KF) распространяются только на линейные системы. Мы линеаризуем нелинейную систему в надежде сохранить некоторые из этих гарантий для нелинейных систем. Фактически, линеаризация нелинейных компонентов системы (то есть модели движения и / или модели наблюдения) - это то, что отличает KF и EFK.

Что касается вопроса 2, д-р Трун утверждает на странице 132 «Вероятностной робототехники», что «практический опыт показывает, что одометрия, хотя она и остается ошибочной, обычно более точна, чем скорость». Однако я бы не стал интерпретировать это утверждение как аргумент в пользу замены скоростной модели. Если у вас есть и скорость, и одометрическая информация, тогда лучше использовать оба источника информации.

DaemonMaker
источник
Еще одна альтернатива линеаризации на основе Тейлора - это KS Unscented: seas.harvard.edu/courses/cs281/papers/unscented.pdf
Алекс Креймер,
2

По моему опыту, ответ на ваш последний вопрос «да». Мне повезло больше, используя одометрию вместо динамического (скоростного) прогнозирования. Однако я никогда не использовал описанную вами модель движения (из книги Труна). Вместо этого я использовал модель, которую я описал здесь .

Джош Вандер Хук
источник
В книге модель рассматривается как кинематическая задача, поэтому я думаю, что это хорошая модель для задачи моделирования.
CroCo
2

На ваш первый вопрос: «Применяется ли то же самое при использовании модели движения одометрии?», Ответ «Да».

EKF - это почти то же самое, что и KF, с добавлением шага линеаризации. Здесь вы линеаризуете модель движения, какой бы она ни была.

На ваш второй вопрос: «Является ли хорошей практикой использование модели движения одометрии вместо скорости для локализации мобильного робота?»: Я думаю, что ответ «это зависит».

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

бурундук
источник