Converted to 2D coordinate system in x-y plane
Working 2D solution with pathing