Public Member Functions | Public Attributes | Static Public Attributes
Con2dP2 Class Reference

#include <spa2d.h>

List of all members.

Public Member Functions

double calcErr (const Node2d &nd0, const Node2d &nd1)
 calculates projection error and stores it in <err>
double calcErrDist (const Node2d &nd0, const Node2d &nd1)
 calculate error in distance only, no weighting
void setJacobians (std::vector< Node2d, Eigen::aligned_allocator< Node2d > > &nodes)

Public Attributes

double amean
Eigen::Matrix< double, 3, 1 > err
 error
bool isValid
 valid or not (could be out of bounds)
Eigen::Matrix< double, 3, 3 > J0
 jacobian with respect to frames; uses dR'/dq from Node2d calculation
Eigen::Matrix< double, 3, 3 > J0t
Eigen::Matrix< double, 3, 3 > J1
Eigen::Matrix< double, 3, 3 > J1t
int nd1
 Node2d index for the second node.
EIGEN_MAKE_ALIGNED_OPERATOR_NEW int ndr
 Reference pose index.
Eigen::Matrix< double, 3, 3 > prec
Eigen::Vector2d tmean
 Mean vector, quaternion (inverse) and precision matrix for this constraint.

Static Public Attributes

static const double qScale = 1.0

Detailed Description

CONP2 holds a constraint measurement of a pose to a pose. They are a repository for links between poses within a frame, with aux info such as jacobians

Definition at line 136 of file spa2d.h.


Member Function Documentation

double Con2dP2::calcErr ( const Node2d nd0,
const Node2d nd1 
) [inline]

calculates projection error and stores it in <err>

Definition at line 149 of file spa2d.cpp.

double Con2dP2::calcErrDist ( const Node2d nd0,
const Node2d nd1 
)

calculate error in distance only, no weighting

Definition at line 164 of file spa2d.cpp.

void Con2dP2::setJacobians ( std::vector< Node2d, Eigen::aligned_allocator< Node2d > > &  nodes)

dpc/dq = dR'/dq [pw-t], in homogeneous form, with q a quaternion param dpc/dx = -R' * [1 0 0]', in homogeneous form, with x a translation param d(px/pz)/du = [ pz dpx/du - px dpz/du ] / pz^2, works for all variables

Definition at line 87 of file spa2d.cpp.


Member Data Documentation

Definition at line 149 of file spa2d.h.

Eigen::Matrix<double,3,1> Con2dP2::err

error

Definition at line 153 of file spa2d.h.

valid or not (could be out of bounds)

Definition at line 180 of file spa2d.h.

Eigen::Matrix<double,3,3> Con2dP2::J0

jacobian with respect to frames; uses dR'/dq from Node2d calculation

Definition at line 162 of file spa2d.h.

Eigen::Matrix<double,3,3> Con2dP2::J0t

Definition at line 162 of file spa2d.h.

Eigen::Matrix<double,3,3> Con2dP2::J1

Definition at line 162 of file spa2d.h.

Eigen::Matrix<double,3,3> Con2dP2::J1t

Definition at line 162 of file spa2d.h.

Node2d index for the second node.

Definition at line 145 of file spa2d.h.

EIGEN_MAKE_ALIGNED_OPERATOR_NEW int Con2dP2::ndr

Reference pose index.

Definition at line 142 of file spa2d.h.

Eigen::Matrix<double,3,3> Con2dP2::prec

Definition at line 150 of file spa2d.h.

const double Con2dP2::qScale = 1.0 [static]

scaling factor for quaternion derivatives relative to translational ones; not sure if this is needed, it's close to 1.0

Definition at line 166 of file spa2d.h.

Eigen::Vector2d Con2dP2::tmean

Mean vector, quaternion (inverse) and precision matrix for this constraint.

Definition at line 148 of file spa2d.h.


The documentation for this class was generated from the following files:


nav2d_karto
Author(s): Sebastian Kasperski
autogenerated on Sun Apr 2 2017 04:05:24