Provably Safe Tolerance Estimation for Robot Arms via Sum-of-Squares Programming

Tolerance estimation problems are prevailing in engineering applications. For example, in modern robotics, it remains challenging to efficiently estimate joint tolerance, i.e., the maximal allowable deviation from a reference robot state such that safety constraints are still satisfied. This paper presented an efficient algorithm to estimate the joint tolerance using sumof-squares programming. It is theoretically proved that the algorithm provides a tight lower bound of the joint tolerance. Extensive numerical studies demonstrate that the proposed method is computationally efficient and near optimal. The algorithm is implemented in the JTE toolbox and is available at https://github. com/intelligent-control-lab/Sum-of-Square-Safety-Optimization.

[1]  Jean-Pierre Merlet,et al.  Solving the Forward Kinematics of a Gough-Type Parallel Manipulator with Interval Analysis , 2004, Int. J. Robotics Res..

[2]  Masayoshi Tomizuka,et al.  The Convex Feasible Set Algorithm for Real Time Optimization in Motion Planning , 2017, SIAM J. Control. Optim..

[3]  Ian R. Manchester,et al.  LQR-trees: Feedback Motion Planning via Sums-of-Squares Verification , 2010, Int. J. Robotics Res..

[4]  Emilio Frazzoli,et al.  Incremental Search Methods for Reachability Analysis of Continuous and Hybrid Systems , 2004, HSCC.

[5]  A. Packard,et al.  Searching for Control Lyapunov Functions using Sums of Squares Programming , 2022 .

[6]  Changliu Liu,et al.  Contact-Rich Trajectory Generation in Confined Environments Using Iterative Convex Optimization , 2020, Volume 2: Intelligent Transportation/Vehicles; Manufacturing; Mechatronics; Engine/After-Treatment Systems; Soft Actuators/Manipulators; Modeling/Validation; Motion/Vibration Control Applications; Multi-Agent/Networked Systems; Path Planning/Motion Contro.

[7]  Katta G. Murty,et al.  Nonlinear Programming Theory and Algorithms , 2007, Technometrics.

[8]  Marie-Françoise Roy,et al.  Real algebraic geometry , 1992 .

[9]  Masayoshi Tomizuka,et al.  Convex feasible set algorithm for constrained trajectory smoothing , 2017, 2017 American Control Conference (ACC).

[10]  Pablo A. Parrilo,et al.  Introducing SOSTOOLS: a general purpose sum of squares programming solver , 2002, Proceedings of the 41st IEEE Conference on Decision and Control, 2002..

[11]  Pablo A. Parrilo,et al.  SOSTOOLS Version 3.00 Sum of Squares Optimization Toolbox for MATLAB , 2013, ArXiv.

[12]  Mykel J. Kochenderfer,et al.  Algorithms for Verifying Deep Neural Networks , 2019, Found. Trends Optim..

[13]  Hang Su,et al.  Benchmarking Adversarial Robustness on Image Classification , 2020, 2020 IEEE/CVF Conference on Computer Vision and Pattern Recognition (CVPR).

[14]  Pablo A. Parrilo,et al.  Semidefinite programming relaxations for semialgebraic problems , 2003, Math. Program..

[15]  Weidong Wu,et al.  Uncertainty analysis and allocation of joint tolerances in robot manipulators based on interval analysis , 2007, Reliab. Eng. Syst. Saf..