edgeConstraints

Пакет: робототехника

Ограничения ребра в графике положения

Синтаксис

relPoses = edgeConstraints(poseGraph)
[relPoses,infoMatrices] = edgeConstraints(poseGraph)
[relPoses,infoMatrices] = edgeConstraints(poseGraph,edgeIDs)

Описание

relPoses = edgeConstraints(poseGraph) списки все ограничения ребра в заданном графике положения как относительное положение.

[relPoses,infoMatrices] = edgeConstraints(poseGraph) также возвращает информационные матрицы для каждого ребра. Информационная матрица является инверсией ковариации измерения положения.

[relPoses,infoMatrices] = edgeConstraints(poseGraph,edgeIDs) возвращает ограничения ребра для заданных идентификаторов ребра.

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

свернуть все

Изложите график, заданный как объект PoseGraph или PoseGraph3D.

Идентификаторы ребра, заданные как вектор положительных целых чисел.

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

свернуть все

Относительные положения измеряются между узлами, возвращенными как n-by-3 матрица или n-by-7 матрица.

Для (2D) PoseGraph каждая строка является вектором [x y theta], который задает относительный позиционный xy и угол ориентации, theta, положения в графике.

Для PoseGraph3D каждая строка является вектором [x y z qw qx qy qz], который задает относительный позиционный xyz и ориентация кватерниона, [qw qx qy qz], положения в графике.

Примечание

Много других источников для 3-D графиков положения, включая форматы .g2o, задают ориентацию кватерниона в различном порядке, например, [qx qy qz qw]. Проверяйте источник своих данных о графике положения перед добавляющими узлами к вашему объекту PoseGraph3D.

Информационные матрицы, заданные в компактной форме как n-by-6 или n-by-21 матрица, где n является количеством положений в графике положения.

Каждая строка является вектором, который содержит элементы верхнего треугольника квадратной информационной матрицы. Информационная матрица является инверсией ковариации положения и представляет неуверенность в измерении. Если вектором положения является [x y theta], ковариация является 3х3 матрицей попарных вычислений ковариации. Как правило, неуверенность определяется моделью датчика.

Для (2D) PoseGraph каждая информационная матрица является вектором с шестью элементами. Значением по умолчанию является [1 0 0 1 0 1].

Для PoseGraph3D каждая информационная матрица является вектором с 21 элементом. Значением по умолчанию является [1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 1 0 0 1 0 1].

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

Введенный в R2018a