void LapManager:: dockWhenClose(Runner &runner) {
// Check if we're close to dock
double delta_x = std::abs(runner.pos_x_ - dock_x_);
double delta_y = std::abs(runner.pos_y_ - dock_y_);
// Only start docking once we are close enough
if (delta_x < dock_proximity_ && delta_y < dock_proximity_) {
ROS_INFO("Going to try and dock");
runner.setActionGoal(dock_x_, dock_y_, dock_yaw_);
runner.sendActionGoal();
runner.dock();
}// end if
}// end dockWhenClose
