borglab / GTDynamics

Full kinodynamics constraints for arbitrary robot configurations with factor graphs.
BSD 2-Clause "Simplified" License
39 stars 10 forks source link

add constrained optimizers #293

Closed yetongumich closed 2 years ago

yetongumich commented 2 years ago

This PR adds the Penalty Method optimizer and Augmented Lagrangian method optimizer, with tests on the example constrained problem from Vandenberghe20Slide_ECNLS.