State Space Sampling of Feasible Motions for High Performance Mobile Robot Navigation in Highly Constrained Environments