Fully integrated path and motion planning approach for modular reconfigurable robots. Planning system adapts itself to different robot configurations. Consideration of different capabilities for overcoming obstacles. Newly introduced Secondary Nearest Neighbor (SNN) space extends the RRT* algorithm.