#include <slam3d.h>
Public Member Functions | |
Eigen::VectorXd | basic_error (Selector s=ESTIMATE) const |
void | initialize () |
Pose3d_Pose3d_Factor (Pose3d_Node *pose1, Pose3d_Node *pose2, const Pose3d &measure, const Noise &noise, Anchor3d_Node *anchor1=NULL, Anchor3d_Node *anchor2=NULL) | |
Private Attributes | |
Pose3d_Node * | _pose1 |
Pose3d_Node * | _pose2 |
isam::Pose3d_Pose3d_Factor::Pose3d_Pose3d_Factor | ( | Pose3d_Node * | pose1, |
Pose3d_Node * | pose2, | ||
const Pose3d & | measure, | ||
const Noise & | noise, | ||
Anchor3d_Node * | anchor1 = NULL , |
||
Anchor3d_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 6x6 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::Pose3d_Pose3d_Factor::basic_error | ( | Selector | s = ESTIMATE | ) | const [inline, virtual] |
Implements isam::Factor.
void isam::Pose3d_Pose3d_Factor::initialize | ( | ) | [inline, virtual] |
Implements isam::Factor.
Pose3d_Node* isam::Pose3d_Pose3d_Factor::_pose1 [private] |
Pose3d_Node* isam::Pose3d_Pose3d_Factor::_pose2 [private] |