This paper introduces a trajectory planning algorithm for nonholonomic mobile robots which operate in an environment with obstacles. An important feature of our approach is that the planning domain is the workspace of the mobile robot rather than its configuration space. The basic idea is to imagine the robot being subjected to Brownian motion forcing, and to generate evolving probability density functions (PDF) that describe all attainable positions and orientations of the robot at a given value of time. By planning a path that optimizes the value of this PDF at each instant in time, we generate a feasible trajectory. The PDF of robot pose can be constructed by solving the corresponding Fokker-Planck equation using the Fourier transform for SE(N). A closed-form approximation of the resulting time-dependent PDF is then used to plan a trajectory based on the observation that the evolution of this “workspace density” is a diffusion process. Examples are provided to illustrate the algorithm.
Nonholonomic Motion Planning Using Diffusion of Workspace Density Functions
- Views Icon Views
- Share Icon Share
- Search Site
Zhou, Y, & Chirikjian, GS. "Nonholonomic Motion Planning Using Diffusion of Workspace Density Functions." Proceedings of the ASME 2003 International Mechanical Engineering Congress and Exposition. Dynamic Systems and Control, Volumes 1 and 2. Washington, DC, USA. November 15–21, 2003. pp. 709-716. ASME. https://doi.org/10.1115/IMECE2003-42916
Download citation file: