[Stage] topic coordinates are different of those declared in .world file

asked 2013-09-16 09:51:45 -0600

gustavo.velascoh

756 ●26 ●36 ●42 http://sites.google.co...

updated 2013-11-18 18:51:56 -0600

tfoote

58457 ●128 ●550 ●526 http://www.ros.org/

Hi,

In my world file I have this model:

laser_base
(
    name "base_0"       # NE base points W
    pose [1.6 1.6 0 180]    
)

where pose is [x y z th], so this model is located at the top-right of the origin.

Now, when I subscribe to the topic /base_pose_ground truth, I have this:

[...]
pose: 
  pose: 
    position: 
      x: 1.6
      y: -1.6
      z: 0.0
    orientation: 
      x: 0.0
      y: 0.0
      z: -0.707106781187
      w: 0.707106781187
[...]

Why these coordinates are different? Should not they be the same?

EDIT 1:

I've found this in stageros.cpp:

// Note that we correct for Stage's screwed-up coord system.
    tf::Quaternion q_gpose;
    q_gpose.setRPY(0.0, 0.0, gpose.a-M_PI/2.0);
    tf::Transform gt(q_gpose, tf::Point(gpose.y, -gpose.x, 0.0));
    tf::Quaternion q_gvel;

Why is this considered screwed-up coord system?

edit retag flag offensive close merge delete

add a comment

0

answered 2013-10-02 14:04:32 -0600

gustavo.velascoh

756 ●26 ●36 ●42 http://sites.google.co...

The coordinate system was fixed in stage_ros version 1.7.2:

CHANGELOG.rst:

1.7.2 (2013-09-19)

Changed default GUI window size to 600x400
Added velocity to ground truth odometry
Fixed tf (yaw component) for the base_link->camera transform.
**Fixed ground truth pose coordinate system**

edit flag offensive delete link

add a comment

1

answered 2013-09-16 13:51:09 -0600

jgilsenan

181 ●6 ●9 ●12

I had the same issue, its a bug in stageros which causes it to broadcast the negative of the 'x' value as the 'y' value, and broadcast the correct 'y' value as the 'x' value. The fix is as simple as switching it to broadcast the correct values in the source code (near line 400 can't remember the specific line #). If the topic 'odom' broadcast by stageros appears to be correct (aside from its 'error') then you are probably experiencing the same issues that I had before.

As for the comment about stage's messed up coordinate system, if stageros is broadcasting heading incorrectly (ie the angle '0' points along the positive y-axis instead of the desired direction of along the positive x-axis as was the case with my previous issues) then you basically need to remove the 'fix' referred to by the comment, that did the trick for me and realigned the heading with the positive x-axis.

edit flag offensive delete link

add a comment

[Stage] topic coordinates are different of those declared in .world file

2 Answers

Question Tools

Stats

Related questions

[Stage] topic coordinates are different of those declared in .world file edit

2 Answers

Question Tools

Stats

Related questions

[Stage] topic coordinates are different of those declared in .world file