Fix issue where units would pathing thrash when targets were near