Skip to content

[Rolling] Implement pose graph node marginalization#3

Closed
hidmic wants to merge 4 commits into
ros2from
feature/chow_liu_marginalization
Closed

[Rolling] Implement pose graph node marginalization#3
hidmic wants to merge 4 commits into
ros2from
feature/chow_liu_marginalization

Conversation

@hidmic

@hidmic hidmic commented Dec 13, 2021

Copy link
Copy Markdown
Collaborator

Basic Info

Info Please fill out this column
Ticket(s) this addresses SteveMacenski#407
Primary OS tested on Ubuntu
Robotic platform tested on Nav2 TB3 Gazebo simulation

Description of contribution in a few bullet points

  • Added graph node marginalization support using the approximations proposed by Kretzschmar et. al.
  • Modified lifelong support to marginalize decayed nodes instead of plainly removing them.

Description of documentation updates required from your changes

  • (I think) I left enough comments to walk back from the implementation to the paper, but do take a look.

Future work that may be required in bullet points

  • I wonder if Karto wouldn't be better off fully embracing Eigen.

@hidmic hidmic self-assigned this Dec 13, 2021
@hidmic
hidmic force-pushed the feature/chow_liu_marginalization branch from 4242eb4 to 8e3880f Compare December 30, 2021 15:41
@hidmic
hidmic changed the base branch from ros2 to fix/tf2_related_includes December 30, 2021 15:41
@hidmic
hidmic marked this pull request as ready for review December 30, 2021 15:41
@hidmic

hidmic commented Dec 30, 2021

Copy link
Copy Markdown
Collaborator Author

@kmilo7204 alright, code's complete here. Need to do some testing now, and watch out for SteveMacenski#398.

@hidmic hidmic changed the title Implement Chow Liu pose graph node marginalization Implement pose graph node marginalization Dec 30, 2021
@kmilo7204

Copy link
Copy Markdown

@hidmic After a couple of revisions, I could say that code looks great!

Just a minor comment: Are you going to add documents (Papers) in code comments or that will not be relevant at all?

@hidmic

hidmic commented Jan 2, 2022

Copy link
Copy Markdown
Collaborator Author

Are you going to add documents (Papers) in code comments or that will not be relevant at all?

@kmilo7204 Indeed I am. See 31aea91.

hidmic added 4 commits January 2, 2022 13:43
Signed-off-by: Michel Hidalgo <michel@ekumenlabs.com>
Signed-off-by: Michel Hidalgo <michel@ekumenlabs.com>
Signed-off-by: Michel Hidalgo <michel@ekumenlabs.com>
Signed-off-by: Michel Hidalgo <michel@ekumenlabs.com>
@hidmic
hidmic force-pushed the feature/chow_liu_marginalization branch from e32399c to 31aea91 Compare January 2, 2022 16:49
@hidmic
hidmic changed the base branch from fix/tf2_related_includes to ros2 January 2, 2022 16:49
@hidmic hidmic changed the title Implement pose graph node marginalization [Rolling] Implement pose graph node marginalization Jan 9, 2022
@hidmic

hidmic commented Jan 9, 2022

Copy link
Copy Markdown
Collaborator Author

See #5. Had to go back to ROS 1 to find a good enough simulation for our testing purposes.

@hidmic

hidmic commented Jan 14, 2022

Copy link
Copy Markdown
Collaborator Author

I'll close this for now. Once SteveMacenski#468 goes in, we can port it to Rolling.

@hidmic hidmic closed this Jan 14, 2022
Sign up for free to join this conversation on GitHub. Already have an account? Sign in to comment

Labels

None yet

Projects

None yet

Development

Successfully merging this pull request may close these issues.

2 participants