Randomized Kinodynamic Motion Planning with Moving Obstacles

  • David Hsu
    Department of Computer Science Stanford University Stanford, CA 94305, U.S.A.,
  • Robert Kindel
    Department of Aeronautics & Astronautics Stanford University Stanford, CA 94305, U.S.A.,
  • Jean-Claude Latombe
    Department of Computer Science Stanford University Stanford, CA 94305, U.S.A.,
  • Stephen Rock
    Department of Aeronautics & Astronautics Stanford University Stanford, CA 94305, U.S.A.,

抄録

<jats:p> This paper presents a novel randomized motion planner for robots that must achieve a specified goal under kinematic and/or dynamic motion constraints while avoiding collision with moving obstacles with known trajectories. The planner encodes the motion constraints on the robot with a control system and samples the robot's state × time space by picking control inputs at random and integrating its equations of motion. The result is a probabilistic roadmap of sampled state × time points, called milestones, connected by short admissible trajectories. The planner does not precompute the roadmap; instead, for each planning query, it generates a new roadmap to connect an initial and a goal state× time point. The paper presents a detailed analysis of the planner's convergence rate. It shows that, if the state× time space satisfies a geometric property called expansiveness, then a slightly idealized version of our implemented planner is guaranteed to find a trajectory when one exists, with probability quickly converging to 1, as the number of milestones increases. Our planner was tested extensively not only in simulated environments, but also on a real robot. In the latter case, a vision module estimates obstacle motions just before planning starts. The planner is then allocated a small, fixed amount of time to compute a trajectory. If a change in the expected motion of the obstacles is detected while the robot executes the planned trajectory, the planner recomputes a trajectory on the fly. Experiments on the real robot led to several extensions of the planner in order to deal with time delays and uncertainties that are inherent to an integrated robotic system interacting with the physical world. </jats:p>

収録刊行物

被引用文献 (11)*注記

もっと見る

詳細情報 詳細情報について

問題の指摘

ページトップへ