Any angle path planning in partitioned space