A 2D path planner with 6 degrees of freedom (+-x, +-y and +-theta) using numeric field algorithm