Closed whoenig closed 1 year ago
Heterogeneous_robot branch supports multi-robot case with single_integrator, double_integrator, unicycle, car_with_trailers_1 dynamics. The branch is also merged with Quim's latest changes (multirobot_optimization). I checked with parallelpark example (one unicycle + car_with_trailer). Please run the code, after I can close this issue.
The current optimization implementation is limited to two unicycles. We need to support arbitrary team sizes, as well as heterogeneous teams (i.e., team members with different dynamics).