Pathing completely working and excutes quickly, still need minor refactoring and needs to be passed temp collision points