Path planning with moving obstacles using stochastic optimal control

Fuente: arXiv
Saved in:
Bibliographic Details
Main Authors: Jafari, Seyyed Reza, Hansson, Anders, Wahlberg, Bo
Format: Preprint
Published: 2025
Subjects:
Online Access:
Tags: Add Tag
No Tags, Be the first to tag this record!
_version_ 1866911516585885696
author Jafari, Seyyed Reza
Hansson, Anders
Wahlberg, Bo
author_facet Jafari, Seyyed Reza
Hansson, Anders
Wahlberg, Bo
contents Navigating a collision-free and optimal trajectory for a robot is a challenging task, particularly in environments with moving obstacles such as humans. We formulate this problem as a stochastic optimal control problem. Since solving the full problem is computationally demanding, we introduce a tractable approximation whose Bellman equation can be solved efficiently. The resulting value function is then incorporated as a terminal penalty in an online rollout framework. We construct a trade-off curve between safety and performance to identify an appropriate weighting between them, and compare the performance with other methods. Simulation results show that the proposed rollout approach can be tuned to reach the target in nearly the same expected time as receding horizon $A^\star$ while maintaining a larger expected minimum distance to the moving obstacle. The results also show that the proposed method outperforms the considered CBF-based methods when a larger obstacle clearance is desired, while achieving comparable performance otherwise.
format Preprint
id arxiv_https___arxiv_org_abs_2504_02057
institution arXiv
publishDate 2025
record_format arxiv
spellingShingle Path planning with moving obstacles using stochastic optimal control
Jafari, Seyyed Reza
Hansson, Anders
Wahlberg, Bo
Systems and Control
Navigating a collision-free and optimal trajectory for a robot is a challenging task, particularly in environments with moving obstacles such as humans. We formulate this problem as a stochastic optimal control problem. Since solving the full problem is computationally demanding, we introduce a tractable approximation whose Bellman equation can be solved efficiently. The resulting value function is then incorporated as a terminal penalty in an online rollout framework. We construct a trade-off curve between safety and performance to identify an appropriate weighting between them, and compare the performance with other methods. Simulation results show that the proposed rollout approach can be tuned to reach the target in nearly the same expected time as receding horizon $A^\star$ while maintaining a larger expected minimum distance to the moving obstacle. The results also show that the proposed method outperforms the considered CBF-based methods when a larger obstacle clearance is desired, while achieving comparable performance otherwise.
title Path planning with moving obstacles using stochastic optimal control
topic Systems and Control
url https://arxiv.org/abs/2504.02057