Skip to content

set pose_4dof#99

Merged
yunzc merged 1 commit into
MIT-SPARK:developfrom
LimHyungTae:feature/add_4dof
Feb 12, 2025
Merged

set pose_4dof#99
yunzc merged 1 commit into
MIT-SPARK:developfrom
LimHyungTae:feature/add_4dof

Conversation

@LimHyungTae

Copy link
Copy Markdown
Member

Upload pose_4dof in Kimera-RPGO utils.

@LimHyungTae

Copy link
Copy Markdown
Member Author

@yunzc Hi Yun, before managing Kimera-PGMO, please reflect on this PR first.

@yunzc yunzc merged commit fb823ab into MIT-SPARK:develop Feb 12, 2025
nathanhhughes pushed a commit to MIT-SPARK/Kimera-PGMO that referenced this pull request Mar 11, 2025
* Initial start of using pose4dof and implment factors

* set use_4dof_optim flag and processFactorsAndValues

* (minor, not directly used) add convertPose3ToPose4DoF function and run clang-format

* Simplify key type checking because it is already done inside `KimeraRpgoOptimizer::update`

* Support 4dof optimization mode

* consider prior factors

* Generalize managing robot and vertex prefixes

* Rename pose variables for clarification

* Account for temp_factors

* (minor) elaborate the runtime error statement

* set prefixExistsInMap functions

* Cleanup code using `prefixExistsInMap` function (checked it runs in batch optimization mode)

* Fix error to account for place nodes

* Detach Pose4DoF package (relevant to MIT-SPARK/Kimera-RPGO#99)

* set run_time error to prevent unexpected case (+ apply clang-format)
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