[TASK] Setup simple IPDA Pose Filtering

[jorgenfj]

Description of task

Setup a structure to do simple IPDA filtering with 6DOF pose. Should serve as an MVP for landmark filtering.

Suggested Workflow

No response

Specifications

• Standalone node for testing purposes
• Export tracking manager as library to import in other packages

Contacts

No response

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)