System for motion planning of robotic manipulators and mobile robots based on bubbles of free configuration space.