Feasible Trajectories for Mobile Robots with Kinematic and Environment Constraints