|
void | EigenAffine2TranslationAndEulerAngles (const Eigen::Affine3d &t, double &x, double &y, double &z, double &roll, double &pitch, double &yaw) |
|
void | EigenTwist2GeometryMsgsTwist (Eigen::Twistd &eigen_twist, geometry_msgs::Twist &gm_twist) |
|
void | GeometryMsgsTwist2EigenTwist (const geometry_msgs::Twist &gm_twist, Eigen::Twistd &eigen_twist) |
|
void | invert3x3Matrix (const MatrixWrapper::Matrix &to_inv, MatrixWrapper::Matrix &inverse) |
|
void | invert3x3MatrixEigen (const Eigen::Map< Eigen::Matrix< double, Eigen::Dynamic, Eigen::Dynamic, Eigen::RowMajor > > &to_inv, Eigen::Map< Eigen::Matrix< double, Eigen::Dynamic, Eigen::Dynamic, Eigen::RowMajor > > &inverse) |
|
void | invert3x3MatrixEigen2 (const Eigen::Matrix3d &to_inv, Eigen::Matrix3d &inverse) |
|
Eigen::Twistd | invertTwist (Eigen::Twistd ¤t_twist, Eigen::Twistd &previous_twist, bool &inverted) |
|
bool | isFinite (const Eigen::Matrix4d &transformation) |
|
double | L2Distance (const Feature::Location &first, const Feature::Location &second) |
|
void | Location2PointPCL (const Feature::Location &point_location, pcl::PointXYZ &point_pcl) |
|
void | LocationAndId2FeaturePCL (const Feature::Location &feature_location, const Feature::Id &feature_id, pcl::PointXYZL &feature_pcl) |
|
void | LocationAndId2FeaturePCLwc (const Feature::Location &feature_location, const Feature::Id &feature_id, omip::FeaturePCLwc &feature_pcl) |
|
void | LocationOfFeature2ColumnVector (const Feature::Location &lof, MatrixWrapper::ColumnVector &col_vec) |
|
void | LocationOfFeature2ColumnVectorHomogeneous (const Feature::Location &lof, MatrixWrapper::ColumnVector &col_vec) |
|
void | LocationOfFeature2EigenVectorHomogeneous (const Feature::Location &lof, Eigen::Vector4d &eig_vec) |
|
Feature::Location | operator+ (const Feature::Location &location1, const Feature::Location &location2) |
|
Feature::Location | operator- (const Feature::Location &location1, const Feature::Location &location2) |
|
std::ostream & | operator<< (std::ostream &os, std::vector< Feature::Id > vector_ids) |
|
std::ostream & | operator<< (std::ostream &os, Eigen::Twistd twistd) |
|
std::ostream & | operator<< (std::ostream &os, Feature::Location location) |
|
void | ROSTwist2EigenTwist (const geometry_msgs::Twist &ros_twist, Eigen::Twistd &eigen_twist) |
|
double | sampleNormal (double mean, double std_dev) |
|
void | TransformLocation (const Feature::Location &origin, const Eigen::Matrix4d &transformation, Feature::Location &new_location) |
|
void | TransformLocation (const Feature::Location &origin, const geometry_msgs::Twist &twist, Feature::Location &new_location) |
|
void | TransformLocation (const Feature::Location &origin, const Eigen::Twistd &twist, Feature::Location &new_location, int feat_id=0) |
|
void | TransformMatrix2Twist (const Eigen::Matrix4d &transformation_matrix, Eigen::Twistd &twist) |
|
void | TransformMatrix2TwistUnwrapped (const Eigen::Matrix4d &transformation_matrix, Eigen::Twistd &twist, const Eigen::Twistd &twist_previous) |
|
void | TranslationAndEulerAngles2EigenAffine (const double &x, const double &y, const double &z, const double &roll, const double &pitch, const double &yaw, Eigen::Transform< double, 3, Eigen::Affine > &t) |
|
void | Twist2TransformMatrix (const Eigen::Twistd &transformation_twist, Eigen::Matrix4d &matrix) |
|
Eigen::Twistd | unwrapTwist (Eigen::Twistd ¤t_twist, Eigen::Displacementd ¤t_displacement, Eigen::Twistd &previous_twist, bool &changed) |
|