On human-aware task and motion planning abilities for a teammate robot
Planning human-aware motions using a sampling-based costmap planner