Add relative pose to pose graph
addRelativePose(
also specifies the information matrix as part of the edge constraint, which
represents the uncertainty of the pose measurement.poseGraph
,relPose
,infoMatrix
)
addRelativePose(
creates a new pose node and connects it to the specific node specified by
poseGraph
,relPose
,infoMatrix
,fromNodeID
)fromNodeID
.
addRelativePose(
creates an edge by specifying a relative pose between existing nodes specified by
poseGraph
,relPose
,infoMatrix
,fromNodeID
,toNodeID
)fromNodeID
and toNodeID
. This edge is
called a loop closure.