More A star work

Started working on pathfinding to start position for when player becomes
undetected. Not working entirely yet, but the enemy's are now using A
star since it no longer can crash the game.