Research Analyzer
← Back ICRA 2026

Optimal Dexterity Path Planning for Robotic Manipulators Using Rapid Workspace Density Approximation

Nathaniel Osikowicz, John Cooper, Puneet Singla

PDF

AI summary

Key figure (auto-extracted from paper)
A novel Gaussian mixture model optimized via higher-order statistical moments enables computationally efficient, dexterity-maximizing path planning for redundant robotic manipulators.
Workspace density approximation Dexterous path planning Gaussian mixture models Conjugate Unscented Transform Robotic manipulation Statistical moments

Problem

Computing workspace density for dexterity-based path planning is computationally intractable due to the exponential growth of joint configurations, creating a bottleneck for singularity avoidance and redundancy utilization in modern robots.

Approach

The method approximates workspace density as an optimal Gaussian mixture model by solving a nonlinear optimization problem constrained by higher-order statistical moments, which are computed efficiently using the Conjugate Unscented Transform and an adaptive splitting algorithm.

Key results

  • Developed the AGM-HOM framework for rapid workspace density approximation
  • Enabled efficient higher-order moment computation via the Conjugate Unscented Transform
  • Formulated workspace approximation as a moment-constrained nonlinear optimization problem
  • Validated dexterity-maximizing path planning on the NASA PASS robotic platform

Why it matters

Provides roboticists and automation engineers with a scalable tool to plan highly dexterous, singularity-avoidant paths, critical for complex assembly and space operations.

Abstract

This paper introduces a path planning algo- rithm for executing robotic manipulation tasks with maximum dexterity in the workspace. This is achieved by using the workspace density of the end-effector as the objective function in a sampling-based planner. In doing so, the path planning algorithm prioritizes joint configurations that correspond to the highest density of local end-effector positions. This results in a singularity avoidant path planning algorithm that favors redundancy, making it a favorable approach for manipulation scenarios in which dexterity is paramount. However, due to the exponential relationship between the number of possible end-effector positions and the number of joints, computing the workspace density via traditional methods is computationally intractable for most modern industrial robots. In this paper, a newly developed approach is taken wherein the workspace density is approximated by a Gaussian mixture model that solves for the optimal workspace density function subject to higher-order statistical moment constraints. The statistical moments of the workspace density function are computed recursively with a minimum number of sample points by using a non-product quadrature rule known as the Conjugate Unscented Transform (CUT). This results in a computationally efficient framework that allows the user to trade accuracy and computation time by varying the number of mixture components and the number of statistical moments used in the workspace density approximation. To demonstrate, the algorithm is implemented on the Precision Assembled Space Structure (PASS) platform at NASA illustrating its effectiveness in dexterous robotic assembly tasks.

Index terms

Motion and Path Planning Probability and Statistical Methods Manipulation Planning

Related papers