Visual and collision geometry misaligned in Gazebo 1.0
I recently updated to fuerte and attempted to simulate the same robot model that I was using in Electric. It is defined in URDF and is loaded using spawn_model
. Even though this model works fine in the fuerte version of RViz, it is completely broken in the new version of Gazebo (i.e. all of the collision and visual geometries are in the wrong places).
I haven't been able to diagnose the issue, but I have found a minimal example that breaks. Load the following model into Gazebo and view collision geometry. Even though I didn't modify any of the origins in the URDF, there is a huge offset between the two models. This becomes even buggier if you add non-zero <origin/>
s inside the collision and geometry nodes.
I am able to simulate the PR2 fine, e.g. pr2_wg_world.world
in the pr2_gazebo
package, so I am not sure what I am doing wrong.
Skeleton URDF Example
<?xml version="1.0"?>
<robot xmlns:xacro="http://ros.org/wiki/xacro" name="test">
<xacro:property name="robot_weight" value="90.0"/>
<link name="base_link">
<inertial>
<mass value="${robot_weight}"/>
<inertia ixx="1.000" ixy="0.000" ixz="0.000"
iyy="28.500" iyz="0.000"
izz="34.800"/>
</inertial>
<collision>
<geometry>
<box size="0.83 0.60 0.25"/>
</geometry>
</collision>
<visual>
<geometry>
<box size="0.83 0.60 0.25"/>
</geometry>
</visual>
</link>
</robot>
Screenshot of the Problem in Gazebo (debs)
Screenshot of the Problem in Gazebo (svn)
Edits:
- Edit 1: Nothing changes if I add
<origin xyz="0 0 0" rpy="0 0 0"/>
to the<geometry/>
elements. - Edit 2: This may only be a problem in how Gazebo 1.0 renders the collision model. It's behaving as if the collision model is correct, even though it's rendering in the wrong position.
- Edit 3: It's broken in a different way using the SVN version of Gazebo. See above. The output of
urdf2model
appears to be correct, so I think it's a bug in Gazebo. - Edit 4: I fixed the issues with the collision model by modifying how I called
spawn_model
. It is only buggy if I pass a non-zero offset (e.g.-z 0.5
).
which release of simulator_gazebo are you using? I suspect this might have been a bug that should be fixed in the newer releases.
I am using the latest debs as of 5/4, version 1.6.7-s1336006714~oneiric, and am having the same problem. Also, the visual geometry is also translated or rotated incorrectly. Should I try building gazebo_simulator from source?
Just finished testing it using the SVN version (r39364). It's still broken, but is now broken in a different way (see above). Do you know of a known-good SVN revision of the stack that I could use?
After a lot more testing, I found that the issue was spawning the model with a non-zero z-offset (e.g.
spawn_model
with-z 0.5
). This is apparently broken in Fuerte. However, I am still having issues where my STL mesh is rendering in a different location than in RViz.I loaded the file up and I get the collision geometry over the box. Only difference is that I commented out your xacro parameter and hard coded it. Also, I have no problems in gazebo when spawning my own models with offsets, so not sure that spawn_model is really your problem...
Just reread your other comment. How are you generating your STL? Solidworks? Sounds like you might have a coordinate system problem. CS used to model vs. CS used to export STL vs. CS used in urdf, etc.
Could you post the exact series of commands you're using to launch gazebo and spawn the model? I am not sure why I am having the strange behavior shown in the screenshots. Re: the STL file, I believe you are correct. How can I export the model from SolidWorks so it works in both RViz and Gazebo?