#include <tf2/LinearMath/Quaternion.h>
#include <tf2/LinearMath/Transform.h>
#include <tf2_ros/buffer.h>
#include <Eigen/Dense>
#include <iomanip>
#include <iostream>
#include <string>
#include <vector>
Go to the source code of this file.
|
#define | RF_DEBUG(msg) if (filter_.getDebug()) { debugStream_ << msg; } |
|
|
double | RobotLocalization::RosFilterUtilities::getYaw (const tf2::Quaternion quat) |
|
bool | RobotLocalization::RosFilterUtilities::lookupTransformSafe (const tf2_ros::Buffer &buffer, const std::string &targetFrame, const std::string &sourceFrame, const ros::Time &time, const ros::Duration &timeout, tf2::Transform &targetFrameTrans, const bool silent=false) |
| Method for safely obtaining transforms. More...
|
|
bool | RobotLocalization::RosFilterUtilities::lookupTransformSafe (const tf2_ros::Buffer &buffer, const std::string &targetFrame, const std::string &sourceFrame, const ros::Time &time, tf2::Transform &targetFrameTrans, const bool silent=false) |
| Method for safely obtaining transforms. More...
|
|
std::ostream & | operator<< (std::ostream &os, const tf2::Vector3 &vec) |
|
std::ostream & | operator<< (std::ostream &os, const tf2::Quaternion &quat) |
|
std::ostream & | operator<< (std::ostream &os, const tf2::Transform &trans) |
|
std::ostream & | operator<< (std::ostream &os, const std::vector< double > &vec) |
|
void | RobotLocalization::RosFilterUtilities::quatToRPY (const tf2::Quaternion &quat, double &roll, double &pitch, double &yaw) |
| Utility method for converting quaternion to RPY. More...
|
|
void | RobotLocalization::RosFilterUtilities::stateToTF (const Eigen::VectorXd &state, tf2::Transform &stateTF) |
| Converts our Eigen state vector into a TF transform/pose. More...
|
|
void | RobotLocalization::RosFilterUtilities::TFtoState (const tf2::Transform &stateTF, Eigen::VectorXd &state) |
| Converts a TF transform/pose into our Eigen state vector. More...
|
|
#define RF_DEBUG |
( |
|
msg | ) |
if (filter_.getDebug()) { debugStream_ << msg; } |
std::ostream& operator<< |
( |
std::ostream & |
os, |
|
|
const tf2::Vector3 & |
vec |
|
) |
| |
std::ostream& operator<< |
( |
std::ostream & |
os, |
|
|
const tf2::Quaternion & |
quat |
|
) |
| |
std::ostream& operator<< |
( |
std::ostream & |
os, |
|
|
const tf2::Transform & |
trans |
|
) |
| |
std::ostream& operator<< |
( |
std::ostream & |
os, |
|
|
const std::vector< double > & |
vec |
|
) |
| |