Log In Sign Up

Robust and Recursively Feasible Real-Time Trajectory Planning in Unknown Environments

by   Inkyu Jang, et al.

Motion planners for mobile robots in unknown environments face the challenge of simultaneously maintaining both robustness against unmodeled uncertainties and persistent feasibility of the trajectory-finding problem. That is, while dealing with uncertainties, a motion planner must update its trajectory, adapting to the newly revealed environment in real-time; failing to do so may involve unsafe circumstances. Many existing planning algorithms guarantee these by maintaining the clearance needed to perform an emergency brake, which is itself a robust and persistently feasible maneuver. However, such maneuvers are not applicable for systems in which braking is impossible or risky, such as fixed-wing aircraft. To that end, we propose a real-time robust planner that recursively guarantees persistent feasibility without any need of braking. The planner ensures robustness against bounded uncertainties and persistent feasibility by constructing a loop of sequentially composed funnels, starting from the receding horizon local trajectory's forward reachable set. We implement the proposed algorithm for a robotic car tracking a speed-fixed reference trajectory. The experiment results show that the proposed algorithm can be run at faster than 16 Hz, while successfully keeping the system away from entering any dead-end, to maintain safety and feasibility.


page 1

page 3

page 7


Real-Time Motion Planning of a Hydraulic Excavator using Trajectory Optimization and Model Predictive Control

Automation of excavation tasks requires real-time trajectory planning sa...

Bridging the Gap Between Safety and Real-Time Performance in Receding-Horizon Trajectory Design for Mobile Robots

Autonomous mobile robots must operate with limited sensor horizons in un...

FaSTraP: Fast and Safe Trajectory Planner for Flights in Unknown Environments

Planning high-speed trajectories for UAVs in unknown environments requir...

Multi-level Adaptation for Automatic Landing with Engine Failure under Turbulent Weather

This paper addresses efficient feasibility evaluation of possible emerge...

Optimization-based Trajectory Tracking Approach for Multi-rotor Aerial Vehicles in Unknown Environments

The goal of this paper is to develop a continuous optimization-based ref...

Trajectory Planning Under Stochastic and Bounded Sensing Uncertainties Using Reachability Analysis

Trajectory planning under uncertainty is an active research topic. Previ...

Planning a Sequence of Base Positions for a Mobile Manipulator to Perform Multiple Pick-and-Place Tasks

In this paper, we present a planner that plans a sequence of base positi...