#include <slam2d.h>
Public Member Functions | |
Pose2d_Pose2d_Factor (Pose2d_Node *pose1, Pose2d_Node *pose2, const Pose2d &measure, const Noise &noise, Anchor2d_Node *anchor1=NULL, Anchor2d_Node *anchor2=NULL) | |
void | initialize () |
Eigen::VectorXd | basic_error (Selector s=LINPOINT) const |
Jacobian | jacobian () |
isam::Pose2d_Pose2d_Factor::Pose2d_Pose2d_Factor | ( | Pose2d_Node * | pose1, |
Pose2d_Node * | pose2, | ||
const Pose2d & | measure, | ||
const Noise & | noise, | ||
Anchor2d_Node * | anchor1 = NULL , |
||
Anchor2d_Node * | anchor2 = NULL |
||
) | [inline] |
Constructor.
pose1 | The pose from which the measurement starts. |
pose2 | The pose to which the measurement extends. |
measure | The relative measurement from pose1 to pose2 (pose2 in pose1's frame). |
noise | The 3x3 square root information matrix (upper triangular). |
anchor1 | Optional anchor node for trajectory to which pose1 belongs to. |
anchor2 | Optional anchor node for trajectory to which pose2 belongs to. |