ROS Resources: Documentation | Support | Discussion Forum | Index | Service Status | ros @ Robotics Stack Exchange
Ask Your Question

Function logic of PR2 Odometry iterativeLeastSquares

asked 2012-12-03 15:19:30 -0500

ChickenSoup gravatar image

updated 2016-05-17 02:38:17 -0500

Hi all,

Can someone tell what happens in "iterativeLeastSquares" method in

According to its description the function is used to compute the most likely solution to the odometry using iterative least squares. And, I tried understanding the code but with no luck.

If someone can give a rough idea, then I would be able to follow the code.

Thank you


edit retag flag offensive close merge delete


what I need to know is what the algorithm does to the individual wheel velocities and steering angles of casters to come up with the final velocity of the base. If someone can give a pointer to a research paper that would be really appreciated.

ChickenSoup gravatar image ChickenSoup  ( 2012-12-06 19:00:51 -0500 )edit

1 Answer

Sort by ยป oldest newest most voted

answered 2013-02-08 22:17:10 -0500

ChickenSoup gravatar image

The "iterativeLeastSquares" function implements an iterative least squares technique to compute odometry.

  • It actually computes and returns x where A*x = b

  • x: [Vx Vy W]^T of the whole robot base i.e. Vx = odom_vel_.linear.x; Vy = odom_vel_.linear.y; W = odom_vel_.angular.z

  • b: [v0 0 v1 0 v2 0 v3 0]^T here v0 = wheel 0's velocity in its steering direction and the 0 = wheel 0's velocity in the direction perpendicular to its steering direction and so on.

  • A: the matrix that transforms x to individual wheel velocities b.

edit flag offensive delete link more

Question Tools


Asked: 2012-12-03 15:19:30 -0500

Seen: 132 times

Last updated: May 17 '16