rayvburn / humap_local_planner

Human-aware robot trajectory planner using a hybrid trajectory candidates generation and spatiotemporal cost functions
BSD 3-Clause "New" or "Revised" License
0 stars 1 forks source link

consider adding `SlowMovementCostFunction` #108

Closed rayvburn closed 1 year ago

rayvburn commented 1 year ago

The aim of this cost function is to keep linear speed close to the maximum allowable (defined by the kinematic constraint)

rayvburn commented 1 year ago

Added to the non-main branch, see https://github.com/rayvburn/hubero_local_planner/tree/planning/feature-slow-translation-costfun

rayvburn commented 1 year ago
 STR %6.1f "
// ...
slow_translation_costs_.getScale() * slow_translation_costs_.scoreTrajectory(traj_copy),
rayvburn commented 1 year ago

This will not be merged

rayvburn commented 11 months ago

It may be useful in some situations. Consider renaming that to UnsaturatedTranslationCostFunction

rayvburn commented 11 months ago

Imported to the main devel branch with a default scale set to 0.0. The scale might be later changed in https://github.com/rayvburn/hubero_local_planner/issues/92