Ask Your Question
0

transforming linear acceleration - robot_localization

asked 2020-09-24 18:17:24 -0500

JadTawil gravatar image

While inspecting the robot_localization source code, i see the following in line 2469 of ros_filter.cpp:

  // Transform to correct frame
  // @todo: This needs to take into account offsets from the origin. Right now,
  // it assumes that if the sensor is placed at some non-zero offset from the
  // vehicle's center, that the vehicle turns with constant velocity. This needs
  // to be something like
  // accTmp = targetFrameTrans.getBasis() * accTmp - targetFrameTrans.getOrigin().cross(rotation_acceleration);
  // We can get rotational acceleration by differentiating the rotational velocity
  // (if it's available)
  accTmp = targetFrameTrans.getBasis() * accTmp;
  maskAcc = targetFrameTrans.getBasis() * maskAcc;

I am curious, why are we assuming that the imu is not offset from the center of the robot? Clearly on most robots this will be the case.. It seems like the correct code is commented out. Also, it seems like this is done properly in prepareTwist() line 3006:

  // Transform to correct frame. Note that we can get linear velocity
  // as a result of the sensor offset and rotational velocity
  measTwistRot = targetFrameTrans.getBasis() * measTwistRot;
  twistLin = targetFrameTrans.getBasis() * twistLin + targetFrameTrans.getOrigin().cross(stateTwistRot);
  maskLin = targetFrameTrans.getBasis() * maskLin;
  maskRot = targetFrameTrans.getBasis() * maskRot;

Any clarification!

edit retag flag offensive close merge delete

1 Answer

Sort by ยป oldest newest most voted
1

answered 2020-09-29 05:02:06 -0500

Tom Moore gravatar image

I am curious, why are we assuming that the imu is not offset from the center of the robot?

We aren't. :) The comment is marked as todo, which means I know it needs to be done, but I didn't have the cycles to test it. But I welcome PRs.

edit flag offensive delete link more

Comments

No problem, I will uncomment and try.

Another couple questions, can you provide some references for the mathematics involved in transforming the angular velocities and linear accelerations from one frame to another?

What advise would you give for performing an extrinsic calibration between IMU and base_link on a real robot?

JadTawil gravatar image JadTawil  ( 2020-09-29 05:59:28 -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

Stats

Asked: 2020-09-24 18:17:24 -0500

Seen: 26 times

Last updated: Sep 29