Resetting gazebo simulation gives problems

asked 2018-03-23 12:16:22 -0600

rohitmur gravatar image

Hi all,

I am try to perform quadcoptor simulation using the hector_quadcoptor package. I am trying to reset the simulation after after the quad falls down. Resetting the simulation is successful but it requires a lot of time for the messages to be published on topics after the reset.

The code snippet below shows the function where I am calling the services.

def resetSim(self):
    rospy.wait_for_service('/gazebo/reset_world')
    rospy.wait_for_service('/gazebo/reset_simulation')
    try:
        self.reset_proxy()
    except rospy.ServiceException as e:
        print ("/gazebo/reset_simulation service call failed")

Following is the node snippet where I am waiting for messages from some topics:

    while poseData is None:
      try:
          # poseData = rospy.wait_for_message('/ground_truth_to_tf/pose', PoseStamped, timeout=5)
          poseData = rospy.wait_for_message('/ground_truth/state', Odometry, timeout=5)
      except:
          rospy.loginfo("Current drone pose not ready yet, retrying to get robot pose")

Following is the truncated output on the terminal:

[INFO] [WallTime: 1521825344.499104] [6.823000] Current drone pose not ready yet, retrying to get robot pose [INFO] [WallTime: 1521825349.504447] [11.730000] Current drone pose not ready yet, retrying to get robot pose [INFO] [WallTime: 1521825354.518395] [16.698000] Current drone pose not ready yet, retrying to get robot pose [INFO] [WallTime: 1521825359.533711] [21.572000] Current drone pose not ready yet, retrying to get robot pose [INFO] [WallTime: 1521825364.546936] [26.371000] Current drone pose not ready yet, retrying to get robot pose [INFO] [WallTime: 1521825369.559794] [31.289000] Current drone pose not ready yet, retrying to get robot pose

There are times when it takes upto 100 seconds to get the drone pose. Does anyone have any suggestions on what I should do differently to do an iterative learning process using Gazebo? I have seen other questions where someone suggested using Gazebo 7 for iterative learning but I'm not completely sure why that would be the case.

I am using Gazebo 2.2 with ROS Indigo on Ubuntu 14.04.

Any help will be much appreciated!

edit retag flag offensive close merge delete

Comments

Hi, Did you find a solution?? I am facing the same issue, after resetting the simulation it takes a really long time for some topics to be published (it doesn't happen with all topics, it seems to me that it only happens with sensor related topics). I am using Gazebo 7 with ROS Kinetic on Ubuntu 16.04

iAba gravatar imageiAba ( 2018-05-02 06:24:55 -0600 )edit

Hi, did you find any solution? I am having the same problem. I am using Ubuntu 16.04, Gazebo 7 ROS Kinetic. I am listening to /tf topic but it stops publishing after resetting simulation in Gazebo.

aniket0112 gravatar imageaniket0112 ( 2018-05-31 11:14:11 -0600 )edit