Создайте 3-D график положения
Информация об объектно-ориентированной памяти PoseGraph3D
для 3-D представления графика положения. График положения содержит nodes
, соединенный edges
с ограничениями ребра, которые задают относительное положение между узлами и неуверенностью на том измерении. Функция optimizePoseGraph
изменяет узлы, чтобы составлять неуверенность и улучшить полный график.
Для 2D графиков положения смотрите PoseGraph
.
Чтобы создать график положения итеративно, используйте addRelativePose
, чтобы добавить положения и соединить их с существующим графиком. Укажите, что неуверенность сопоставила использование информационной матрицы. Укажите, что закрытия цикла добавляют дополнительные ограничения ребра между существующими узлами.
poseGraph = robotics.PoseGraph3D
poseGraph = robotics.PoseGraph3D('MaxNumEdges',maxEdges,'MaxNumNodes',maxNodes)
poseGraph = robotics.PoseGraph3D
создает 3-D объект диаграмм положения. Добавьте положения с помощью addRelativePose
, чтобы создать график положения итеративно.
poseGraph = robotics.PoseGraph3D('MaxNumEdges',maxEdges,'MaxNumNodes',maxNodes)
задает верхнюю границу на количестве ребер и узлов, позволенных в графике положения при генерации кода. Этот предел только требуется при генерации кода.
addRelativePose | Добавьте относительное положение, чтобы изложить график |
edges | Ребра в графике положения |
edgeConstraints | Ограничения ребра в графике положения |
findEdgeID | Найдите ID ребра ребра |
nodes | Положения узлов в графике положения |
optimizePoseGraph | Оптимизируйте узлы в графике положения |
removeEdges | Удалите ребра закрытия цикла из графика |
show | Постройте график положения |
[1] Carlone, Лука, Роберто Трон, Костас Даниилидис и Франк Деллэерт. "Методы инициализации для 3D SLAM: Обзор Оценки Вращения и ее Использования в Оптимизации Графика Положения". 2 015 Международных конференций IEEE по вопросам Робототехники и Автоматизации (ICRA). 2015, стр 4597–4604.