[T-35] Overshoot detection refactor

[lakatop]

• Find out whether agent will be able to slow down to destination. If yes, dont count it as overshoot.