Added pathfinding

Uses unity's navmesh