finished the motion sampling
but the robot path planning is not yet available.