Added currentPos drawing, next is pathfinding through currentPos