Ask Your Question
0

How does robot_localization fuse pose odometry data?

asked 2017-09-27 08:03:47 -0500

LukasK gravatar image

Hi guys, I have a question concerning the working principle of robot_localization. I'm fusing odometry and IMU data. My odometry provides only absolute pose information, so I'm letting the robot_localization to fuse X, Y, yaw:

    <param name="odom0" value="/odom"/> 
          <rosparam param="odom0_config">[true,  true,  false, 
                                          false,  false,  true, 
                                          false,  false,  false, 
                                          false,  false,  false, 
                                          false,  false,  false]
    </rosparam>

But according to my knowledge about Kalman filter, it is not possible to supply it with pose data from odometry. In the prediction step, we need to supply velocity or acceleration, to carry out the prediction phase (control input u):

x[k|k-1] = A*x[k-1|k-1] + B*u

Niether can we use it as the measurement (z) in the correction phase:

x[k|k] = x[k|k−1] + K[k]( z[k] − H[k]x[k|k−1] )

Can someone please clarify this? I have read almost the whole robot_localization manual, Thomas Moore's presentation and his paper but couldn't get the answer. Thank you!

http://docs.ros.org/kinetic/api/robot... https://roscon.ros.org/2015/presentat... http://docs.ros.org/lunar/api/robot_l...

edit retag flag offensive close merge delete

1 Answer

Sort by » oldest newest most voted
1

answered 2018-01-03 10:16:00 -0500

Tom Moore gravatar image

A couple things:

  1. You can absolutely fuse pose data from odometry. It's just a pose measurement like any other. It gets applied in the correction phase like any other measurement (i.e., z is just the [X Y theta] of your odometry measurement).
  2. If you just fuse pose data from the wheel odometry, the EKF will end up with non-zero values in its velocities (the magic of matrix inversion). However, it is wise to have a velocity reference instead (or as well) so that prediction is more accurate.
edit flag offensive delete link more

Comments

Thank you for answering my question. I admit, it was silly.

LukasK gravatar imageLukasK ( 2018-04-04 09:41:06 -0500 )edit

No, not silly! State estimation is not trivial. Happy to help.

Tom Moore gravatar imageTom Moore ( 2018-04-09 03:52:05 -0500 )edit

Your Answer

Please start posting anonymously - your entry will be published after you log in or create a new account.

Add Answer

Question Tools

1 follower

Stats

Asked: 2017-09-27 08:03:47 -0500

Seen: 418 times

Last updated: Jan 03 '18