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