Probabilistic Trajectory Planning for Static and Interaction-aware Dynamic Obstacle Avoidance

by   Baskin Senbaslar, et al.

Collision-free mobile robot navigation is an important problem for many robotics applications, especially in cluttered environments. In such environments, obstacles can be static or dynamic. Dynamic obstacles can additionally be interactive, i.e. changing their behavior according to the behavior of other entities. The perception and prediction modules of robotic systems create probabilistic representations and predictions of such environments. In this paper, we propose a novel prediction representation for interactive behaviors of dynamic obstacles. Then, we propose a real-time trajectory planning algorithm that probabilistically avoids collisions against static and interactive dynamic obstacles, and produces dynamically feasible trajectories. During decision making, our planner simulates the interactive behavior of dynamic obstacles in response to the actions planning robot takes. We explicitly minimize collision probabilities against static and dynamic obstacles using a multi-objective search formulation. Then, we formulate a quadratic program to safely fit a smooth trajectory to the search result while attempting to preserve the collision probabilities computed during search. We evaluate our algorithm extensively in simulations to show its performance under different environments and configurations using 78000 randomly generated cases. We compare its performance to a state-of-the-art trajectory planning algorithm for static and dynamic obstacle avoidance using 4500 randomly generated cases. We show that our algorithm achieves up to 3.8x success rate using as low as 0.18x time the baseline uses. We implement our algorithm for physical quadrotors, and show its feasibility in the real world.


page 1

page 14


Rapid Collision Detection for Multicopter Trajectories

We present an algorithm for quickly detecting whether certain polynomial...

Benchmarking local motion planners for navigation of mobile manipulators

There are various trajectory planners for mobile manipulators. It is oft...

Environment-aware Interactive Movement Primitives for Object Reaching in Clutter

The majority of motion planning strategies developed over the literature...

i2LQR: Iterative LQR for Iterative Tasks in Dynamic Environments

This work introduces a novel control strategy called Iterative Linear Qu...

MRNAV: Multi-Robot Aware Planning and Control Stack for Collision and Deadlock-free Navigation in Cluttered Environments

Multi-robot collision-free and deadlock-free navigation in cluttered env...

Efficient Obstacle Rearrangement for Object Manipulation Tasks in Cluttered Environments

We present an algorithm that produces a plan for relocating obstacles in...

Please sign up or login with your details

Forgot password? Click here to reset