monteCarloLocalization

Локализуйте робота с помощью данных о датчике области значений и карты

Описание

monteCarloLocalization Система object™ создает объект Monte Carlo localization (MCL). Алгоритм MCL используется, чтобы оценить положение и ориентацию транспортного средства в его среде с помощью известной карты среды, данных о скане лидара и данных датчика одометрии.

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

monteCarloLocalization возразите берет положение и данные о скане лидара как входные параметры. Входные данные о датчике скана лидара даны в его собственной координатной системе координат, и алгоритм преобразовывает данные согласно SensorModel.SensorPose свойство, которое необходимо задать. Входное положение вычисляется путем интеграции данных датчика одометрии в зависимости от времени. Если изменение в положении больше какого-либо из заданных порогов обновления, UpdateThresholds, затем частицы обновляются, и алгоритм вычисляет новую оценку состояния из фильтра частиц. Частицы обновляются с помощью этого процесса:

  1. Частицы распространены на основе изменения в положении и заданной модели движения, MotionModel.

  2. Частицы являются присвоенными весами на основе вероятности получения датчика области значений, читающего для каждой частицы. Эти веса вероятности основаны на модели датчика, которую вы задаете в SensorModel.

  3. На основе ResamplingInterval свойство, частицы передискретизируются от апостериорного распределения, и частицы низкого веса устраняются. Например, интервал передискретизации 2 средних значений, что частицы передискретизируются после любого обновления.

Выходные параметры объекта являются предполагаемым положением и ковариацией и значением isUpdated. Это предполагаемое состояние является средним значением и ковариацией самого высокого взвешенного кластера частиц. Выходное положение дано в координатной системе координат карты, которая задана в SensorModel.Map свойство. Если изменение в положении больше какого-либо из порогов обновления, то оценка состояния была обновлена и isUpdated true. В противном случае, isUpdated false и оценка остается то же самое. Для непрерывного отслеживания наилучшей оценки состояния робота повторите этот процесс распространения частиц, оценки их вероятности и передискретизации.

Оценить положение робота и ковариацию с помощью данных о скане лидара:

  1. Создайте monteCarloLocalization объект и набор его свойства.

  2. Вызовите объект с аргументами, как будто это была функция.

Чтобы узнать больше, как Системные объекты работают, смотрите то, Что Системные объекты?.

Создание

Описание

пример

mcl = monteCarloLocalization возвращает объект MCL, который оценивает положение транспортного средства с помощью карты, датчика области значений и данных об одометрии. По умолчанию пустая карта присвоена, таким образом, допустимое присвоение карты требуется перед использованием объекта.

mcl = monteCarloLocalization(Name,Value) создает объект MCL с дополнительными опциями, заданными одним или несколькими Name,Value парные аргументы.

Name имя свойства и Value соответствующее значение. Name должен появиться в одинарных кавычках (''). Можно задать несколько аргументов пары "имя-значение" в любом порядке как Name1,Value1,...,NameN,ValueN.

Свойства

развернуть все

Начальное положение транспортного средства раньше запускало локализацию в виде трехэлементного вектора, [x y theta], это указывает на положение и заголовок транспортного средства. Инициализация объекта MCL с начальной оценкой положения позволяет вам использовать меньшее значение для максимального количества частиц и все еще сходиться на местоположении.

Ковариация Распределения Гаусса для начального положения в виде диагональной матрицы. Трехэлементные векторные и скалярные входные параметры преобразованы в диагональную матрицу. Эта матрица дает оценку неопределенности в InitialPose.

Отметьте указание, выполнить ли глобальную локализацию в виде false или true. Значение по умолчанию, false, инициализирует частицы с помощью InitialPose и InitialCovariance свойства. true значение инициализирует равномерно распределенные частицы в целой карте и игнорирует InitialPose и InitialCovariance свойства. Глобальная локализация требует, чтобы большое количество частиц покрыло целую рабочую область. Используйте глобальную локализацию только, когда первоначальная оценка местоположения транспортного средства и ориентации не будет доступна.

Минимальное и максимальное количество частиц в виде двухэлементного вектора, [min max].

Модель датчика поля Likelihood в виде likelihoodFieldSensor объект. Значение по умолчанию использует likelihoodFieldSensorModel по умолчанию объект. После использования объекта, который будет выведен, вызовите release на объекте внести изменения в SensorModel. Например:

mcl = monteCarloLocalization; 
[isUpdated,pose,covariance] = mcl(ranges,angles); 
release(mcl) 
mcl.SensorModel.NumBeams = 120;

Модель движения одометрии для дифференциального диска в виде odometryMotionModel объект. Значение по умолчанию использует odometryMotionModel по умолчанию объект. После использования объекта, который будет выведен, вызовите release на объекте внести изменения в MotionModel. Например:

mcl = monteCarloLocalization; 
[isUpdated,pose,covariance] = mcl(ranges,angles); 
release(mcl) 
mcl.MotionModel.Noise = [0.25 0.25 0.4 0.4];

Минимальное изменение в состояниях, требуемых инициировать обновление в виде трехэлементного вектора. Локализация обновляет частицы если минимальное изменение в любом [x y theta] состояниям соответствуют. Оценка положения обновляется, только если фильтр частиц обновляется.

Количество фильтра обновляется между передискретизацией частиц в виде положительного целого числа.

Используйте lidarScan возразите как скан, введенный в виде любого false или true.

Использование

Описание

пример

[isUpdated,pose,covariance] = mcl(odomPose,scan) оценивает положение и ковариацию транспортного средства с помощью алгоритма MCL. Оценки основаны на положении, вычисленном от заданной одометрии транспортного средства, odomPose, и заданные данные о датчике скана лидара, scan. mcl monteCarloLocalization объект. isUpdated указывает, обновляется ли оценка на основе UpdateThreshold свойство.

Чтобы включить этот синтаксис, необходимо установить UseLidarScan свойство к true. Например:

mcl = monteCarloLocalization('UseLidarScan',true);
...
[isUpdated,pose,covariance] = mcl(odomPose,scan);

пример

[isUpdated,pose,covariance] = mcl(odomPose,ranges,angles) задает данные о скане лидара как ranges и angles.

Входные параметры

развернуть все

Позируйте на основе одометрии в виде трехэлементного вектора, [x y theta]. Это положение вычисляется путем интеграции одометрии в зависимости от времени.

Чтения сканов лидара в виде lidarScan объект.

Зависимости

Чтобы использовать этот аргумент, необходимо установить UseLidarScan свойство к true.

mcl.UseLidarScan = true;

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

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

Выходные аргументы

развернуть все

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

Текущая оценка положения, возвращенная как трехэлементный вектор, [x y theta]. Положение вычисляется как среднее значение взвешенного самым высоким образом кластера частиц.

Оценка ковариации для текущего положения, возвращенного как матрица. Эта матрица дает оценку неопределенности в текущем положении. Ковариация вычисляется как ковариация взвешенного самым высоким образом кластера частиц.

Функции объекта

Чтобы использовать объектную функцию, задайте Системный объект как первый входной параметр. Например, чтобы выпустить системные ресурсы Системного объекта под названием obj, используйте этот синтаксис:

release(obj)

развернуть все

getParticlesПолучите частицы из алгоритма локализации
stepЗапустите алгоритм Системного объекта
releaseВысвободите средства и позвольте изменения в значениях свойств Системного объекта и введите характеристики
resetСбросьте внутренние состояния Системного объекта

Примеры

свернуть все

Создайте monteCarloLocalization объект, присвойте модель датчика и вычислите оценку положения с помощью step метод.

Примечание: Начиная в R2016b, вместо того, чтобы использовать метод шага, чтобы выполнить операцию, заданную Системным объектом, можно вызвать объект с аргументами, как будто это была функция. Например, y = step(obj,x) и y = obj(x) выполните эквивалентные операции.

Создайте monteCarloLocalization объект. Установите UseLidarScan свойство к true.

mcl = monteCarloLocalization;
mcl.UseLidarScan = true;

Присвойте модель датчика с картой сетки заполнения к объекту.

sm = likelihoodFieldSensorModel;
p = zeros(200,200);
sm.Map = occupancyMap(p,20);
mcl.SensorModel = sm;

Создайте демонстрационный лазерный вход данных сканирования.

ranges = 10*ones(1,300);
ranges(1,130:170) = 1.0;
angles = linspace(-pi/2,pi/2,300);
odometryPose = [0 0 0];

Создайте lidarScan объект путем указывания диапазонов и углов.

scan = lidarScan(ranges,angles);

Оцените положение транспортного средства и ковариацию.

[isUpdated,estimatedPose,covariance] = mcl(odometryPose,scan)
isUpdated = logical
   1

estimatedPose = 1×3

    0.0350   -0.0126    0.0280

covariance = 3×3

    0.9946   -0.0012         0
   -0.0012    0.9677         0
         0         0    0.9548

Ссылки

[1] Трун, Sebatian, вольфрам Бергард и Дитер Фокс. Вероятностная робототехника. Нажатие MIT, 2005.

[2] Dellaert, F., Д. Фокс, В. Бергард и С. Трун. "Локализация Монте-Карло для мобильных роботов". Продолжения 1 999 международных конференций IEEE по вопросам робототехники и автоматизации.

Расширенные возможности

Генерация кода C/C++
Генерация кода C и C++ с помощью MATLAB® Coder™.

Введенный в R2019b
Для просмотра документации необходимо авторизоваться на сайте