A* algorithm implemented but untested. Started to implement steering behaviour.