#include <slam2d.h>
Public Member Functions | |
Eigen::VectorXd | basic_error (Selector s=LINPOINT) const |
void | initialize () |
Jacobian | jacobian () |
Pose2d_Pose2d_Factor (Pose2d_Node *pose1, Pose2d_Node *pose2, const Pose2d &measure, const Noise &noise, Anchor2d_Node *anchor1=NULL, Anchor2d_Node *anchor2=NULL) | |
Private Attributes | |
Pose2d_Node * | _pose1 |
Pose2d_Node * | _pose2 |
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. |
Eigen::VectorXd isam::Pose2d_Pose2d_Factor::basic_error | ( | Selector | s = LINPOINT | ) | const [inline, virtual] |
Implements isam::Factor.
void isam::Pose2d_Pose2d_Factor::initialize | ( | ) | [inline, virtual] |
Implements isam::Factor.
Jacobian isam::Pose2d_Pose2d_Factor::jacobian | ( | ) | [inline, virtual] |
Reimplemented from isam::Factor.
Pose2d_Node* isam::Pose2d_Pose2d_Factor::_pose1 [private] |
Pose2d_Node* isam::Pose2d_Pose2d_Factor::_pose2 [private] |