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

imu_filter_madgewick frame does not display rotation accurately

asked 2022-08-10 11:17:28 -0500

LiquidTurtle1 gravatar image

updated 2022-08-10 11:18:34 -0500

I am using the L515 Intel Realsense Camera, and the imu readings function as expected in the realsense-viewer, however when I launch the filter, RVIZ displays the "camera_imu_optical_frame," but neither the orientation nor the rotation accurately represent the positioning and movement of the camera.

When I alter the yaw of the camera, a change in the pitch is displayed in rviz. Altering the pitch, shows a change in roll. And changing the roll shows a change in yaw.

The lower frame in the picture is the imu frame, and the top frame is an arbitrary frame that is oriented in the direction that I would like my imu frame to face.

https://imgur.com/vymtoMc (Sorry for using image hosting, I don't have the karma yet).

imu_filter:
  ros__parameters:
    stateless: false
    use_mag: false
    publish_tf: true
    reverse_tf: false
    fixed_frame: "odom"
    constant_dt: 0.0
    publish_debug_topics: false
    world_frame: "enu"
    gain: 0.1
    zeta: 0.0
    mag_bias_x: 0.0
    mag_bias_y: 0.0
    mag_bias_z: 0.0
    orientation_stddev: 0.0

Let me know if you have any recommendations, or need more information. Thank you!

edit retag flag offensive close merge delete

1 Answer

Sort by ยป oldest newest most voted
0

answered 2022-08-15 11:07:01 -0500

LiquidTurtle1 gravatar image

The issue had nothing to do with the filter at all, actually. The issue was that my imu data was not aligned with the proper coordinate frame. There seem to be ways to do this with a static transform, but I found it simpler to make the changes on the driver level.

Specifications for imu data preparation: http://docs.ros.org/en/noetic/api/rob...

I followed the instructions provided in this issue to fix my problem: https://github.com/IntelRealSense/rea...

This type of fix is likely necessary for anyone using a realsense camera with imu that is looking to use ros packages like imu_madgwick_filter or robot_localization.

edit flag offensive delete link more

Question Tools

1 follower

Stats

Asked: 2022-08-10 11:17:28 -0500

Seen: 175 times

Last updated: Aug 15 '22