The controller is decreasing gradually the velocity while it advances to towards a wall that is closer to inf_thres until it fully stop.
Some small details were corrected. The general behavior is the same.