#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. |