Sensor Reduction of Variable Stiffness Actuated Robots Using Moving Horizon Estimation

Variable stiffness actuated (VSA) robots are expected to play an important role in physical human–robot interaction, thanks to their inherent safety features. These systems can control the position and stiffness concurrently by incorporating two or more actuators for each joint. Unfortunately, the need for extra sensors to measure the state of these actuators decreases the reliability of these systems. In this paper, we present a sensor reduction scheme for VSA robots. Specifically, we utilize moving horizon estimation (MHE) to estimate the unmeasured states of the system. Due to its ability to handle constraints, MHE is chosen as the estimation algorithm. The estimated states are then used by a nonlinear model predictive controller to implement a closed-loop control system. In order to show the efficacy of our framework, we conducted extensive simulation and real-world experiments with a reaction wheel augmented VSA system. The objective of these experiments was to compare the control performance of the sensor reduced system (from four encoders to two encoders) with the system using the full set of states for control. The results of these experiments show the feasibility of the MHE-based sensor reduction. Sensor reduction might increase the reliability of VSA robots and might facilitate their earlier introduction to the industrial environments.

[1]  James B. Rawlings,et al.  Particle filtering and moving horizon estimation , 2006, Comput. Chem. Eng..

[2]  Hyondong Oh,et al.  New Multiple-Target Tracking Strategy Using Domain Knowledge and Optimization , 2017, IEEE Transactions on Systems, Man, and Cybernetics: Systems.

[3]  Boris Lohmann,et al.  Gauss-Newton moving horizon observer for state and parameter estimation of nonlinear networked control systems , 2009, 2009 European Control Conference (ECC).

[4]  Jinya Su,et al.  Simultaneous state and input estimation with partial information on the inputs , 2015 .

[5]  A. Bryson,et al.  Discrete square root filtering: A survey of current techniques , 1971 .

[6]  Jeffrey K. Uhlmann,et al.  New extension of the Kalman filter to nonlinear systems , 1997, Defense, Security, and Sensing.

[7]  Wolfgang Dahmen,et al.  On the regularization of dynamic data reconciliation problems , 2002 .

[8]  David Q. Mayne,et al.  Constrained state estimation for nonlinear discrete-time systems: stability and moving horizon approximations , 2003, IEEE Trans. Autom. Control..

[9]  Matteo Rubagotti,et al.  Time-Optimal Control of Variable-Stiffness-Actuated Systems , 2017, IEEE/ASME Transactions on Mechatronics.

[10]  M. Diehl,et al.  Real-time optimization and nonlinear model predictive control of processes governed by differential-algebraic equations , 2000 .

[11]  Moritz Diehl,et al.  Convergence Guarantees for Moving Horizon Estimation Based on the Real-Time Iteration Scheme , 2014, IEEE Transactions on Automatic Control.

[12]  Simon Altmannshofer,et al.  Experimental validation of a new moving horizon estimator approach for networked control systems with unsynchronized clocks , 2012, 2012 American Control Conference (ACC).

[13]  D. Simon Kalman filtering with state constraints: a survey of linear and nonlinear algorithms , 2010 .

[14]  Wen-an Zhang,et al.  Moving Horizon Estimation for Mobile Robots With Multirate Sampling , 2017, IEEE Transactions on Industrial Electronics.

[15]  Quanmin Zhu,et al.  Moving Horizon State Estimation for Networked Control Systems With Multiple Packet Dropouts , 2012, IEEE Transactions on Automatic Control.

[16]  X. Rong Li,et al.  State estimation for systems with unknown inputs based on variational Bayes method , 2012, 2012 15th International Conference on Information Fusion.

[17]  Siwei Zhang,et al.  Log-PF: Particle Filtering in Logarithm Domain , 2018, J. Electr. Comput. Eng..

[18]  Marcello Farina,et al.  Distributed Moving Horizon Estimation for Linear Constrained Systems , 2010, IEEE Transactions on Automatic Control.

[19]  Sirish L. Shah,et al.  Nonlinear Bayesian state estimation: A review of recent developments , 2012 .

[20]  Matteo Rubagotti,et al.  Closed-Loop Control of Variable Stiffness Actuated Robots via Nonlinear Model Predictive Control , 2015, IEEE Access.

[21]  Fredrik Gustafsson,et al.  The Rao-Blackwellized Particle Filter: A Filter Bank Implementation , 2010, EURASIP J. Adv. Signal Process..

[22]  Johannes P. Schlöder,et al.  A real-time algorithm for moving horizon state and parameter estimation , 2011, Comput. Chem. Eng..

[23]  Erdal Kayacan,et al.  Learning in Centralized Nonlinear Model Predictive Control: Application to an Autonomous Tractor-Trailer System , 2021, IEEE Transactions on Control Systems Technology.

[24]  Kazuma Sekiguchi,et al.  Vehicle localization by sensor fusion of LRS measurement and odometry information based on moving horizon estimation , 2014, 2014 IEEE Conference on Control Applications (CCA).

[25]  Francis J. Doyle,et al.  Use of multiple models and qualitative knowledge for on-line moving horizon disturbance estimation and fault diagnosis , 2002 .

[26]  Michel Verhaegen,et al.  Robust air data sensor fault diagnosis with enhanced fault sensitivity using moving horizon estimation , 2016, 2016 American Control Conference (ACC).

[27]  Yuanqing Xia,et al.  Robust Derivative Unscented Kalman Filter Under Non-Gaussian Noise , 2018, IEEE Access.

[28]  Tor Arne Johansen,et al.  Estimation of wind velocities and aerodynamic coefficients for UAVs using standard autopilot sensors and a Moving Horizon Estimator , 2017, 2017 International Conference on Unmanned Aircraft Systems (ICUAS).

[29]  Giorgio Grioli,et al.  Variable Stiffness Actuators: Review on Design and Components , 2016, IEEE/ASME Transactions on Mechatronics.

[30]  Huseyin Atakan Varol,et al.  Augmenting Variable Stiffness Actuation Using Reaction Wheels , 2016, IEEE Access.

[31]  N. Gordon,et al.  Novel approach to nonlinear/non-Gaussian Bayesian state estimation , 1993 .

[32]  Giorgio Battistelli,et al.  Moving horizon state estimation for discrete-time linear systems with binary sensors , 2015, 2015 54th IEEE Conference on Decision and Control (CDC).

[33]  Manuel G. Catalano,et al.  Variable impedance actuators: A review , 2013, Robotics Auton. Syst..

[34]  Yaakov Bar-Shalom,et al.  Estimation and Tracking: Principles, Techniques, and Software , 1993 .

[35]  Souad Chebbi,et al.  On the Convergence of Constrained Particle Filters , 2017, IEEE Signal Processing Letters.

[36]  F. Daum Nonlinear filters: beyond the Kalman filter , 2005, IEEE Aerospace and Electronic Systems Magazine.

[37]  Bangjun Lei,et al.  Classification, Parameter Estimation and State Estimation: An Engineering Approach Using MATLAB, 2nd Edition , 2017 .

[38]  D. Mayne,et al.  Moving horizon observers and observer-based control , 1995, IEEE Trans. Autom. Control..

[39]  Alin Albu-Schäffer,et al.  Soft robotics , 2008, IEEE Robotics & Automation Magazine.

[40]  Guanrong Chen,et al.  Extended Kalman Filter and System Identification , 1991 .

[41]  Jay H. Lee,et al.  A moving horizon‐based approach for least‐squares estimation , 1996 .

[42]  Fredrik Gustafsson,et al.  Particle filters for positioning, navigation, and tracking , 2002, IEEE Trans. Signal Process..

[43]  Simon J. Godsill,et al.  On sequential Monte Carlo sampling methods for Bayesian filtering , 2000, Stat. Comput..

[44]  R. E. Kalman,et al.  A New Approach to Linear Filtering and Prediction Problems , 2002 .

[45]  Olzhas Adiyatov,et al.  Successive linearization based model predictive control of variable stiffness actuated robots , 2017, 2017 IEEE International Conference on Advanced Intelligent Mechatronics (AIM).

[46]  Giorgio Battistelli,et al.  MAP Moving Horizon state estimation with binary measurements , 2016, 2016 American Control Conference (ACC).

[47]  S. Särkkä,et al.  On the (non-)convergence of particle filters with Gaussian importance distributions* , 2015 .

[48]  Robi Polikar,et al.  Constrained state estimation in particle filters , 2015, 2015 IEEE International Conference on Acoustics, Speech and Signal Processing (ICASSP).

[49]  Dan Simon,et al.  Optimal State Estimation: Kalman, H∞, and Nonlinear Approaches , 2006 .

[50]  Ling Chen,et al.  Single beacon based localization of AUVs using moving Horizon estimation , 2013, 2013 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[51]  Moritz Diehl,et al.  A Moving Horizon State Estimation algorithm applied to the Tennessee Eastman Benchmark Process , 2006, 2006 IEEE International Conference on Multisensor Fusion and Integration for Intelligent Systems.

[52]  Christian Kirches,et al.  qpOASES: a parametric active-set algorithm for quadratic programming , 2014, Mathematical Programming Computation.

[53]  Prem K. Goel,et al.  Bayesian estimation via sequential Monte Carlo sampling - Constrained dynamic systems , 2007, Autom..