Skip to content

[TASK] Implement ESKF for sensor fusion of DVL and IMU #439

@Andeshog

Description

@Andeshog

Description of task

To get better pose and velocity estimates, we can fuse the DVL measurements and the IMU measurements. Structure of the DVL measurements not yet decided, but the IMU measurements are given in an IMU message.

The IMU can be tested in the office by:

  • Finding the IMU and plugging it into your computer.
  • Make a new workspace, clone this repo and build:
    • mkdir -p stim300_ws/src ; cd stim300_ws/src
    • git clone [email protected]:vortexntnu/stim300-driver.git -b feature/ros2-port
    • cd .. ; colcon build ; source install/setup.bash
  • Launch the driver:
    • ros2 launch driver_stim300 stim300_driver.launch.py

Suggested Workflow

  • Define the state vector to be estimated. Must include 6 DOF pose (NED) and velocity (body).
  • Run and read the output from the IMU by doing the steps in the description.
  • Look at this template for inspiration/starting point.

Specifications

  • Output message type: Odometry
  • Output topic name: TBD

Contacts

Code Quality

  • Every function in header files are documented (inputs/returns/exceptions)
  • The project has automated tests that cover MOST of the functions and branches in functions (pytest/gtest)
  • The code is documented on the wiki (provide link)

Metadata

Metadata

Assignees

Labels

Type

No type

Projects

No projects

Milestone

No milestone

Relationships

None yet

Development

No branches or pull requests

Issue actions