Main Content


Poses of nodes in pose graph


measurements = nodeEstimates(poseGraph) lists all poses in the specified pose graph.

measurements = nodeEstimates(poseGraph,nodeIDs) lists the poses with the specified node IDs.

Input Arguments

collapse all

Pose graph, specified as a poseGraph or poseGraph3D object.

Node IDs, specified as a positive integer or vector of positive integers. Each node added gets an ID sequentially in the graph.

Output Arguments

collapse all

Measurements between nodes, returned as an n-by-3 matrix or n-by-7 matrix.

For poseGraph (2-D), each row is an [x y theta] vector, which defines the relative xy-position and orientation angle, theta, of a pose in the graph. For landmark positions, theta is returned as NaN.

For poseGraph3D, each row is an [x y z qw qx qy qz] vector, which defines the relative xyz-position and quaternion orientation, [qw qx qy qz], of a pose in the graph.


Many other sources for 3-D pose graphs, including .g2o formats, specify the quaternion orientation in a different order, for example, [qx qy qz qw]. Check the source of your pose graph data before adding nodes to your poseGraph3D object.

Extended Capabilities

Version History

Introduced in R2019b

expand all