 | 1 | initial version |
Simple. Use GetPose utility. For eg:
gazebo::math::Pose pose = this->model->gazebo::physics::ModelState::GetPose();
You can convert it into your preferred coordinate system through simple transformation.
ROS Answers is licensed under Creative Commons Attribution 3.0 Content on this site is licensed under a Creative Commons Attribution Share Alike 3.0 license.