Add in a force for regenerating the next waypoint if there's obstacle data available
Add in a force for regenerating the next waypoint if there's obstacle data available