# Balancing Safety and Optimality in Robot Path Planning: Algorithm and Metric

Source: [Balancing Safety and Optimality in Robot Path Planning: Algorithm and Metric](<https://www.sota2.com/research/paper/68fa7aef1e209131cea85d87>)

Collection index: [llms.txt](<https://www.sota2.com/research/llms.txt>)

Data updated: 2026-03-18T05:00:04.466Z

Authors: Jatin Kumar Arora, Soutrik Bandyopadhyay, Sunil Sulania, Shubhendu Bhasin

Published: 2025-05-29T07:34:56.000Z

## Abstract

Path planning for autonomous robots faces a fundamental trade-off between path length and obstacle clearance. While existing algorithms typically prioritize a single objective, we introduce the Unified Path Planner (UPP), a graph-search algorithm that dynamically balances safety and optimality via adaptive heuristic weighting. UPP employs a local inverse-distance safety field and auto-tunes its parameters based on real-time search progress, achieving provable suboptimality bounds while maintaining superior clearance. To enable rigorous evaluation, we introduce the OptiSafe index, a normalized metric that quantifies the trade-off between safety and optimality. Extensive evaluation across 10 environments shows that UPP achieves a 0.94 OptiSafe score in cluttered environments, compared with 0.22-0.85 for existing methods, with only 0.5-1% path-length overhead in simulation and a 100% success rate. Hardware validation on TurtleBot confirms practical advantages despite sim-to-real gaps.

## Recorded benchmark results

A research result applies to its stated dataset, split, metric and evaluation configuration. Compare like-for-like settings, preserve the metric's unit and direction, and distinguish paper-reported results from independent reproduction. The best result recorded here is not a claim of exhaustive, current global coverage.

- [Path Planning on Sparse Env Map 1](<https://www.sota2.com/research/sota/path-planning-on-sparse-env-map-1.md>): Path planning; Sparse Env Map 1; Time (ms): 279.83.

- [Path Planning on Cluttered Env (Map 2)](<https://www.sota2.com/research/sota/path-planning-on-cluttered-env-map-2.md>): Path planning; Cluttered Env (Map 2); Clearance (cm): 25.44.

- [Path Planning on Hardware Lab Environment Turtlebot ROS2-humble](<https://www.sota2.com/research/sota/path-planning-on-hardware-lab-environment-turtlebot-ros2-humble.md>): Path planning; Hardware Lab Environment Turtlebot ROS2-humble; Path Length (m): 3.75.

## Original sources and implementation

[Original paper](<https://arxiv.org/abs/2505.23197>)

[PDF](<https://arxiv.org/pdf/2505.23197.pdf>)
