added emergency avoidance when obstacle is wayyyy to close