Switching to non-ptr approach in HuberoPlanner will allow to pass object references in ctor and omit such calls:
// update cost function with the people detections dataset
heading_disturbance_costs_.setPeopleDetections(*people_);
personal_space_costs_.setPeopleDetections(*people_);
fformation_space_costs_.setFformationsDetections(*groups_);
passing_speed_costs_.setPeopleDetections(*people_);
Switching to non-ptr approach in
HuberoPlanner
will allow to pass object references in ctor and omit such calls: