Use dynamic constraints to sample plausible states for RRT algorithm, improving robot motion planning