Добавьте относительное положение в график положения
addRelativePose(
создает узел на основе входа poseGraph
,measurement
)measurement
который соединяется с последним узлом положения в графике положения. Чтобы добавить знаковые узлы, смотрите addPointLandmark
функция.
addRelativePose(
также задает информационную матрицу как часть ограничения ребра, которое представляет неопределенность измерения положения.poseGraph
,measurement
,infoMat
)
addRelativePose(
создает новый узел положения и соединяет его с определенным узлом, заданным poseGraph
,measurement
,infoMat
,fromNodeID
)fromNodeID
.
addRelativePose(
создает ребро путем определения относительного измерения положения между существующими узлами, заданными poseGraph
,measurement
,infoMat
,fromNodeID
,toNodeID
)fromNodeID
и toNodeID
. Это ребро называется loop closure. Если замыкание цикла уже существует, функция добавляет новое измерение. Вызов optimizePoseGraph
Функция объединяет несколько добавленных измерений в одно ребро. Этот синтаксис не поддерживает добавление ребер к знаковому узлу.