GazeboRosIMU controller. More...
#include <gazebo_ros_imu.h>
Public Member Functions | |
GazeboRosIMU (Entity *parent) | |
Constructor. | |
virtual | ~GazeboRosIMU () |
Destructor. | |
Protected Member Functions | |
virtual void | FiniChild () |
Finalize the controller. | |
virtual void | InitChild () |
Init the controller. | |
virtual void | LoadChild (XMLConfigNode *node) |
Load the controller. | |
virtual void | UpdateChild () |
Update the controller. | |
Private Member Functions | |
void | DeprecatedIMUConnect () |
void | DeprecatedIMUDisconnect () |
double | GaussianKernel (double mu, double sigma) |
Gaussian noise generator. | |
void | IMUConnect () |
void | IMUDisconnect () |
bool | ServiceCallback (std_srvs::Empty::Request &req, std_srvs::Empty::Response &res) |
call back when using service | |
Private Attributes | |
Vector3 | aeul |
Vector3 | apos |
std::string | bodyName |
ParamT< std::string > * | bodyNameP |
store bodyname | |
ros::Publisher | deprecated_pub_ |
int | deprecatedImuConnectCount |
std::string | deprecatedTopicName |
ParamT< std::string > * | deprecatedTopicNameP |
ParamT< std::string > * | frameNameP |
frame transform name, should match link name deprecating this field for imu blocks. give warning and explaination if this is specified | |
double | gaussianNoise |
ParamT< double > * | gaussianNoiseP |
Gaussian noise. | |
int | imuConnectCount |
Keep track of number of connctions. | |
sensor_msgs::Imu | imuMsg |
ros message | |
Pose3d | initial_pose |
Time | last_time |
save last_time | |
Vector3 | last_veul |
Vector3 | last_vpos |
boost::mutex | lock |
A mutex to lock access to fields that are used in message callbacks. | |
Body * | myBody |
The parent Model. | |
Model * | myParent |
The parent Model. | |
ros::Publisher | pub_ |
std::string | robotNamespace |
ParamT< std::string > * | robotNamespaceP |
for setting ROS name space | |
ros::NodeHandle * | rosnode_ |
pointer to ros node | |
Vector3 | rpyOffsets |
ParamT< Vector3 > * | rpyOffsetsP |
std::string | serviceName |
ParamT< std::string > * | serviceNameP |
ros::ServiceServer | srv_ |
std::string | topicName |
ParamT< std::string > * | topicNameP |
topic name | |
Vector3 | xyzOffsets |
ParamT< Vector3 > * | xyzOffsetsP |
allow specifying constant xyz and rpy offsets |
GazeboRosIMU controller.
<model:physical name="some_fancy_model"> <controller:gazebo_ros_imu name="imu_controller" plugin="libgazebo_ros_imu.so"> <alwaysOn>true</alwaysOn> <updateRate>1000.0</updateRate> <bodyName>body_name</bodyName> <topicName>body_pose_ground_truth</topicName> <xyzOffsets>25.65 25.65 0</xyzOffsets> <!-- option to initialize odometry for fake localization--> <rpyOffsets>0 0 0</rpyOffsets> <interface:position name="imu_position_iface"/> </controller:gazebo_ros_imu> </model:phyiscal>
Definition at line 96 of file gazebo_ros_imu.h.
GazeboRosIMU::GazeboRosIMU | ( | Entity * | parent | ) |
Constructor.
Definition at line 46 of file gazebo_ros_imu.cpp.
GazeboRosIMU::~GazeboRosIMU | ( | ) | [virtual] |
Destructor.
Definition at line 72 of file gazebo_ros_imu.cpp.
void GazeboRosIMU::DeprecatedIMUConnect | ( | ) | [private] |
Definition at line 186 of file gazebo_ros_imu.cpp.
void GazeboRosIMU::DeprecatedIMUDisconnect | ( | ) | [private] |
Definition at line 194 of file gazebo_ros_imu.cpp.
void GazeboRosIMU::FiniChild | ( | ) | [protected, virtual] |
Finalize the controller.
Definition at line 328 of file gazebo_ros_imu.cpp.
double GazeboRosIMU::GaussianKernel | ( | double | mu, | |
double | sigma | |||
) | [private] |
Gaussian noise generator.
Definition at line 336 of file gazebo_ros_imu.cpp.
void GazeboRosIMU::IMUConnect | ( | ) | [private] |
Definition at line 173 of file gazebo_ros_imu.cpp.
void GazeboRosIMU::IMUDisconnect | ( | ) | [private] |
Definition at line 179 of file gazebo_ros_imu.cpp.
void GazeboRosIMU::InitChild | ( | ) | [protected, virtual] |
Init the controller.
Definition at line 202 of file gazebo_ros_imu.cpp.
void GazeboRosIMU::LoadChild | ( | XMLConfigNode * | node | ) | [protected, virtual] |
Load the controller.
node | XML config node |
Definition at line 88 of file gazebo_ros_imu.cpp.
bool GazeboRosIMU::ServiceCallback | ( | std_srvs::Empty::Request & | req, | |
std_srvs::Empty::Response & | res | |||
) | [private] |
call back when using service
Definition at line 165 of file gazebo_ros_imu.cpp.
void GazeboRosIMU::UpdateChild | ( | ) | [protected, virtual] |
Update the controller.
Definition at line 218 of file gazebo_ros_imu.cpp.
Vector3 gazebo::GazeboRosIMU::aeul [private] |
Definition at line 160 of file gazebo_ros_imu.h.
Vector3 gazebo::GazeboRosIMU::apos [private] |
Definition at line 159 of file gazebo_ros_imu.h.
std::string gazebo::GazeboRosIMU::bodyName [private] |
Definition at line 133 of file gazebo_ros_imu.h.
ParamT<std::string>* gazebo::GazeboRosIMU::bodyNameP [private] |
store bodyname
Definition at line 132 of file gazebo_ros_imu.h.
ros::Publisher gazebo::GazeboRosIMU::deprecated_pub_ [private] |
Definition at line 126 of file gazebo_ros_imu.h.
int gazebo::GazeboRosIMU::deprecatedImuConnectCount [private] |
Definition at line 178 of file gazebo_ros_imu.h.
std::string gazebo::GazeboRosIMU::deprecatedTopicName [private] |
Definition at line 144 of file gazebo_ros_imu.h.
ParamT<std::string>* gazebo::GazeboRosIMU::deprecatedTopicNameP [private] |
Definition at line 143 of file gazebo_ros_imu.h.
ParamT<std::string>* gazebo::GazeboRosIMU::frameNameP [private] |
frame transform name, should match link name deprecating this field for imu blocks. give warning and explaination if this is specified
Definition at line 138 of file gazebo_ros_imu.h.
double gazebo::GazeboRosIMU::gaussianNoise [private] |
Definition at line 165 of file gazebo_ros_imu.h.
ParamT<double>* gazebo::GazeboRosIMU::gaussianNoiseP [private] |
Gaussian noise.
Definition at line 164 of file gazebo_ros_imu.h.
int gazebo::GazeboRosIMU::imuConnectCount [private] |
Keep track of number of connctions.
Definition at line 175 of file gazebo_ros_imu.h.
sensor_msgs::Imu gazebo::GazeboRosIMU::imuMsg [private] |
ros message
Definition at line 129 of file gazebo_ros_imu.h.
Pose3d gazebo::GazeboRosIMU::initial_pose [private] |
Definition at line 161 of file gazebo_ros_imu.h.
Time gazebo::GazeboRosIMU::last_time [private] |
save last_time
Definition at line 156 of file gazebo_ros_imu.h.
Vector3 gazebo::GazeboRosIMU::last_veul [private] |
Definition at line 158 of file gazebo_ros_imu.h.
Vector3 gazebo::GazeboRosIMU::last_vpos [private] |
Definition at line 157 of file gazebo_ros_imu.h.
boost::mutex gazebo::GazeboRosIMU::lock [private] |
A mutex to lock access to fields that are used in message callbacks.
Definition at line 153 of file gazebo_ros_imu.h.
Body* gazebo::GazeboRosIMU::myBody [private] |
The parent Model.
Definition at line 121 of file gazebo_ros_imu.h.
Model* gazebo::GazeboRosIMU::myParent [private] |
The parent Model.
Definition at line 118 of file gazebo_ros_imu.h.
ros::Publisher gazebo::GazeboRosIMU::pub_ [private] |
Definition at line 125 of file gazebo_ros_imu.h.
std::string gazebo::GazeboRosIMU::robotNamespace [private] |
Definition at line 172 of file gazebo_ros_imu.h.
ParamT<std::string>* gazebo::GazeboRosIMU::robotNamespaceP [private] |
for setting ROS name space
Definition at line 171 of file gazebo_ros_imu.h.
ros::NodeHandle* gazebo::GazeboRosIMU::rosnode_ [private] |
pointer to ros node
Definition at line 124 of file gazebo_ros_imu.h.
Vector3 gazebo::GazeboRosIMU::rpyOffsets [private] |
Definition at line 150 of file gazebo_ros_imu.h.
ParamT<Vector3>* gazebo::GazeboRosIMU::rpyOffsetsP [private] |
Definition at line 149 of file gazebo_ros_imu.h.
std::string gazebo::GazeboRosIMU::serviceName [private] |
Definition at line 187 of file gazebo_ros_imu.h.
ParamT<std::string>* gazebo::GazeboRosIMU::serviceNameP [private] |
Definition at line 186 of file gazebo_ros_imu.h.
ros::ServiceServer gazebo::GazeboRosIMU::srv_ [private] |
Definition at line 185 of file gazebo_ros_imu.h.
std::string gazebo::GazeboRosIMU::topicName [private] |
Definition at line 142 of file gazebo_ros_imu.h.
ParamT<std::string>* gazebo::GazeboRosIMU::topicNameP [private] |
topic name
Definition at line 141 of file gazebo_ros_imu.h.
Vector3 gazebo::GazeboRosIMU::xyzOffsets [private] |
Definition at line 148 of file gazebo_ros_imu.h.
ParamT<Vector3>* gazebo::GazeboRosIMU::xyzOffsetsP [private] |
allow specifying constant xyz and rpy offsets
Definition at line 147 of file gazebo_ros_imu.h.