Motion planning algorithms and implementations for obstacle-cluttered environments