Jacobian State Augmented Viable Kinematic Safety Filter

Abstract:Safety Filters (SF) are leveraged to design certifiably safe controllers, which ensures forward invariance on a defined safe set when the filter is feasible. Predictive Safety Filters (PSF) embed these constraints to a closed-loop model-based optimization method to improve constraint satisfaction, and reduce feasibility loss caused by myopic, one-step filtering. Related viability-based methods emphasize approximating a viability kernel which ensures admissible control for all future time, but requires significant computational expense. This work introduces a Jacobian-based kinematic safety filter leveraging an augmented state variable with task-space velocity and filters task-space acceleration to preserve the feasibility of a low-level filter while enforcing joint position and velocity. The proposed method introduces a nested Quadratic Program (QP) formulation, defines a conservative inner approximation of viability envelope and computes a viable planner online. The method is validated in a simplified 2R planar manipulator simulation environment and shows significant improvement compared to a baseline Control Barrier Function Quadratic Program (CBF-QP) based filter. The experiments highlights the improvements in terms of computation time compared to traditional PSF and Reference Governor approach while also showing significant reduction in feasibility violations. Lastly, a simplified demonstration on a simulated 6-DoF manipulator highlights the potential scalability of the method to higher degree-of-freedom setups.

Robotics (cs.RO); Systems and Control (eess.SY)

arXiv:2610.15936 [cs.RO]

(or arXiv:2610.15936v1 [cs.RO] for this version)

https://doi.org/10.48550/arXiv.2610.15936 Focus to learn more arXiv-issued DOI via DataCite (pending registration)

arXivLabs is a framework that allows collaborators to develop and share new arXiv features directly on our website.

Both individuals and organizations that work with arXivLabs have embraced and accepted our values of openness, community, excellence, and user data privacy. arXiv is committed to these values and only works with partners that adhere to them.

Have an idea for a project that will add value for arXiv's community? Learn more about arXivLabs.