Investigate re-planning delay issue

[yambati03]

There's an issue in the execution of our behavior tree where there's an unexpected delay between when we abort the trajectory following service due to detecting a lethal obstacle at the lookahead point and actually re-planning. Need to investigate the cause of this delay.