Добавьте узел поворотного момента в график положения
addPointLandmark(
добавляет узел поворотного момента, на основе входного положения poseGraph
,measurement
)measurement
это соединяется с последним узлом положения в графике положения. Чтобы добавить узлы измерения положения, смотрите addRelativePose
функция.
addPointLandmark(
также задает информационную матрицу как часть ограничения ребра, которое представляет неопределенность в знаменательном измерении.poseGraph
,measurement
,infoMat
)
addPointLandmark(
добавляет новый узел поворотного момента и соединяет его с узлом положения, заданным poseGraph
,measurement
,infoMat
,poseNodeID
)poseNodeID
.
addPointLandmark(
создает ребро путем определения измерения точки между существующими узлами, заданными poseGraph
,measurement
,infoMat
,poseNodeID
,pointNodeID
)poseNodeID
и pointNodeID
. Если пара узла уже существует, функция добавляет новое измерение.