How to change it that the robot will not injects the global goal if TEB detects the robot is close to the goal?
In the function of TebLocalPlannerROS::transformGlobalPlan(), TEB explicitly injects the global goal if the robot is close to the goal. However, I prefer the robot to follow the global plan path rather than move to global point directly if it close to the global point.