#include <marker_visualization.h>
Public Member Functions | |
void | addImuMarker (const ImuState &state, const Eigen::Vector3d &acceleration=Eigen::Vector3d::Zero()) |
Add marker for the current state and measured acceleration. | |
void | publish () const |
Publish all the markers at once. | |
void | setAcceleration (const Eigen::Vector3d &acc) |
display the acceleration in world frame | |
void | setMeasuredAcc (const Eigen::Vector3d &acc) |
Display the measured, uncompensated acceleration at the origin. | |
~MarkerVisualization () | |
Static Public Member Functions | |
static MarkerVisualization & | instance () |
Get the singleton instance. | |
Private Types | |
typedef std::list < visualization_msgs::Marker > | Container |
Private Member Functions | |
void | dump (visualization_msgs::Marker &m) |
MarkerVisualization (size_t bufferSize=10, const std::string &imuFrameId="/map") | |
MarkerVisualization (const MarkerVisualization &) | |
int | nextId () |
MarkerVisualization & | operator= (const MarkerVisualization &) |
void | updateMarkerPose (visualization_msgs::Marker &marker, const ImuState &state) |
Private Attributes | |
visualization_msgs::Marker | accArrow_ |
visualization_msgs::Marker | gravityArrow_ |
std::string | imuFrameId_ |
Container | marker_ |
size_t | maxMarkers_ |
visualization_msgs::Marker | measAcc_ |
size_t | nextId_ |
ros::Publisher | publisher_ |
visualization_msgs::Marker | velocityArrow_ |
Definition at line 53 of file marker_visualization.h.
typedef std::list<visualization_msgs::Marker> imu_filter::MarkerVisualization::Container [private] |
Definition at line 103 of file marker_visualization.h.
Definition at line 116 of file marker_visualization.cpp.
imu_filter::MarkerVisualization::MarkerVisualization | ( | size_t | bufferSize = 10 , |
const std::string & | imuFrameId = "/map" |
||
) | [private] |
Definition at line 42 of file marker_visualization.cpp.
imu_filter::MarkerVisualization::MarkerVisualization | ( | const MarkerVisualization & | ) | [private] |
void imu_filter::MarkerVisualization::addImuMarker | ( | const ImuState & | state, |
const Eigen::Vector3d & | acceleration = Eigen::Vector3d::Zero() |
||
) |
Add marker for the current state and measured acceleration.
state | The imustate for which we want to display markers |
acceleration | The measured acceleration from the IMU (optional) |
Definition at line 120 of file marker_visualization.cpp.
void imu_filter::MarkerVisualization::dump | ( | visualization_msgs::Marker & | m | ) | [private] |
Definition at line 201 of file marker_visualization.cpp.
static MarkerVisualization& imu_filter::MarkerVisualization::instance | ( | ) | [inline, static] |
Get the singleton instance.
Definition at line 61 of file marker_visualization.h.
int imu_filter::MarkerVisualization::nextId | ( | ) | [private] |
Definition at line 220 of file marker_visualization.cpp.
MarkerVisualization& imu_filter::MarkerVisualization::operator= | ( | const MarkerVisualization & | ) | [private] |
void imu_filter::MarkerVisualization::publish | ( | ) | const |
Publish all the markers at once.
Definition at line 147 of file marker_visualization.cpp.
void imu_filter::MarkerVisualization::setAcceleration | ( | const Eigen::Vector3d & | acc | ) |
display the acceleration in world frame
acc | the current acceleration in world frame |
Definition at line 206 of file marker_visualization.cpp.
void imu_filter::MarkerVisualization::setMeasuredAcc | ( | const Eigen::Vector3d & | acc | ) |
Display the measured, uncompensated acceleration at the origin.
acc | the measured acceleration from the IMU |
Definition at line 213 of file marker_visualization.cpp.
void imu_filter::MarkerVisualization::updateMarkerPose | ( | visualization_msgs::Marker & | marker, |
const ImuState & | state | ||
) | [private] |
Definition at line 164 of file marker_visualization.cpp.
visualization_msgs::Marker imu_filter::MarkerVisualization::accArrow_ [private] |
Definition at line 108 of file marker_visualization.h.
visualization_msgs::Marker imu_filter::MarkerVisualization::gravityArrow_ [private] |
Definition at line 106 of file marker_visualization.h.
std::string imu_filter::MarkerVisualization::imuFrameId_ [private] |
Definition at line 99 of file marker_visualization.h.
Definition at line 104 of file marker_visualization.h.
size_t imu_filter::MarkerVisualization::maxMarkers_ [private] |
Definition at line 98 of file marker_visualization.h.
visualization_msgs::Marker imu_filter::MarkerVisualization::measAcc_ [private] |
Definition at line 109 of file marker_visualization.h.
size_t imu_filter::MarkerVisualization::nextId_ [private] |
Definition at line 100 of file marker_visualization.h.
Definition at line 112 of file marker_visualization.h.
visualization_msgs::Marker imu_filter::MarkerVisualization::velocityArrow_ [private] |
Definition at line 107 of file marker_visualization.h.