PiP-X: Online feedback motion planning/replanning in dynamic environments using invariant funnels

02/01/2022
by   Mohamed Khalid M Jaffar, et al.
0

Computing kinodynamically feasible motion plans and repairing them on-the-fly as the environment changes is a challenging, yet relevant problem in robot-navigation. We propose a novel online single-query sampling-based motion re-planning algorithm - PiP-X, using finite-time invariant sets - funnels. We combine concepts from sampling-based methods, nonlinear systems analysis and control theory to create a single framework that enables feedback motion re-planning for any general nonlinear dynamical system in dynamic workspaces. A volumetric funnel-graph is constructed using sampling-based methods, and an optimal funnel-path from robot configuration to a desired goal region is then determined by computing the shortest-path subtree in it. Analysing and formally quantifying the stability of trajectories using Lyapunov level-set theory ensures kinodynamic feasibility and guaranteed set-invariance of the solution-paths. The use of incremental search techniques and a pre-computed library of motion-primitives ensure that our method can be used for quick online rewiring of controllable motion plans in densely cluttered and dynamic environments. We represent traversability and sequencibility of trajectories together in the form of an augmented directed-graph, helping us leverage discrete graph-based replanning algorithms to efficiently recompute feasible and controllable motion plans that are volumetric in nature. We validate our approach on a simulated 6DOF quadrotor platform in a variety of scenarios within a maze and random forest environment. From repeated experiments, we analyse the performance in terms of algorithm-success and length of traversed-trajectory.

READ FULL TEXT

page 1

page 14

page 16

page 18

research
10/06/2022

Cloud Hopping; Navigating in 3D Uneven Environments via Supervoxels and Control Lyapunov Function

This paper presents a novel feedback motion planning method for mobile r...
research
08/01/2019

Online Motion Planning Over Multiple Homotopy Classes with Gaussian Process Inference

Efficient planning in dynamic and uncertain environments is a fundamenta...
research
04/21/2023

IBBT: Informed Batch Belief Trees for Motion Planning Under Uncertainty

In this work, we propose the Informed Batch Belief Trees (IBBT) algorith...
research
05/16/2022

Robust-RRT: Probabilistically-Complete Motion Planning for Uncertain Nonlinear Systems

Robust motion planning entails computing a global motion plan that is sa...
research
07/23/2021

Multi-Start n-Dimensional Lattice Planning with Optimal Motion Primitives

In the field of motion planning the use of pre-computed, feasible, local...
research
05/10/2021

Stability Constrained Mobile Manipulation Planning on Rough Terrain

This paper presents a framework that allows online dynamic-stability-con...
research
07/03/2000

Interval Constraint Solving for Camera Control and Motion Planning

Many problems in robust control and motion planning can be reduced to ei...

Please sign up or login with your details

Forgot password? Click here to reset