4am-robotics / cob_control

The cob_control stack includes packages that are used to do low level control tasks with Care-O-bot hardware over ROS.
www.care-o-bot.org
Apache License 2.0
35 stars 64 forks source link

[melodic] Feature/invert odom #259

Closed HannesBachter closed 3 years ago

HannesBachter commented 3 years ago

introduces the capability to invert the odom tf so we can get a tf-tree like this: image


$ rostopic echo /base/odometry_controller/odometry -n 1
header: 
  seq: 8438
  stamp: 
    secs: 1627560726
    nsecs: 391182772
  frame_id: "odom_wheel"
child_frame_id: "base_footprint"
pose: 
  pose: 
    position: 
      x: -0.9286206985110904
      y: 10.843665335483834
      z: 0.0
    orientation: 
      x: 0.0
      y: 0.0
      z: 0.8923281215810869
      w: 0.4513873319396203
  covariance: [0.1, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.1, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.1, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.1, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.1, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.1]
twist: 
  twist: 
    linear: 
      x: 0.0
      y: 0.0
      z: 0.0
    angular: 
      x: 0.0
      y: 0.0
      z: 0.0
  covariance: [0.1, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.1, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.1, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.1, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.1, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.1]
---
HannesBachter commented 3 years ago

also investigate whether the frame_ids and/or data in the odometry topic need to be inverted

and finally post a tf tree where we can see the structure that uses the inverted odom logic....the graph above doesn't show the result of invert_odom

see https://github.com/ipa320/cob_control/pull/259#issue-694251801