Abstract

This work proposes a formulation for the moving horizon estimation technique considering both states and parameters obtained simultaneously with reduced estimation issues. The parameters can be either constant or time-varying, while states are related to complex output trajectories related to underactuated systems. Particularly, the proposed formulation considers additional equality constraints as a counterpart of the dynamics tube-model predictive control. Thus, it becomes less dependent on probabilistic information, such as probability density function and covariance of the process noise. In addition, the calibration of the method parameters has less sensitivity and driven by the tube constraints. The proposed approach can be applied in different systems; however, here it is detailed for a class of soft continuum manipulators with fluidic actuation through a variable flowrate and demonstrated with numerical simulations in planar motion. Results indicate robustness of the algorithm estimation in a challenging scenario arising from underactuation as well as in the presence of uncertainty and external disturbance, while simultaneously states and a vector of structural parameters are coherently estimated.

References

1.
Kalman
,
R. E.
,
1960
, “
A New Approach to Linear Filtering and Prediction Problems
,”
ASME J. Basic Eng.
,
82
(
1
), pp.
35
45
.10.1115/1.3662552
2.
Julier
,
S. J.
, and
Uhlmann
,
J. K.
,
1997
, “
New Extension of the Kalman Filter to Nonlinear Systems
,”
Signal Processing, Sensor Fusion, and Target Recognition VI
,
I.
Kadar
, ed.,
International Society for Optics and Photonics, SPIE
, Orlando, FL, Vol.
3068
, pp.
182
193
.
3.
Metropolis
,
N.
, and
Ulam
,
S.
,
1949
, “
The Monte Carlo Method
,”
J. Am. Stat. Assoc.
,
44
(
247
), pp.
335
341
.10.1080/01621459.1949.10483310
4.
Li
,
X.
,
Ichchou
,
M.
,
Zine
,
A.
,
Droz
,
C.
, and
Bouhaddi
,
N.
,
2023
, “
An Algebraic Wavenumber Identification (AWI) Technique Under Stochastic Conditions
,”
Mech. Syst. Signal Process.
,
188
, p.
109983
.10.1016/j.ymssp.2022.109983
5.
Sira-Ramírez, H., García-Rodríguez, C., Cortés-Romero, J., and Luviano-Juárez, A.,
2014
,
Algebraic Parameter Identification in Nonlinear Systems
,
Wiley, Ltd
, Hoboken, NJ, pp.
71
143
, Chap. III.
6.
Sira-Ramírez, H., García-Rodríguez, C., Cortés-Romero, J., and Luviano-Juárez, A.,
2014
,
Simultaneous State and Parameter Estimation: An Algebraic Approach
,
Wiley, Ltd
, Hoboken, NJ, pp.
349
355
.
7.
Ortega
,
R.
,
Spong
,
M. W.
,
Gomez-Estern
,
F.
, and
Blankenstein
,
G.
,
2002
, “
Stabilization of a Class of Underactuated Mechanical Systems Via Interconnection and Damping Assignment
,”
IEEE Trans. Autom. Control
,
47
(
8
), pp.
1218
1233
.10.1109/TAC.2002.800770
8.
Franco
,
E.
,
2019
, “
Adaptive IDA-PBC for Underactuated Mechanical Systems With Constant Disturbances
,”
Int. J. Adapt. Control Signal Process.
,
33
(
1
), pp.
1
15
.10.1002/acs.2947
9.
Robertson
,
D. G.
,
Lee
,
J. H.
, and
Rawlings
,
J. B.
,
1996
, “
A Moving Horizon-Based Approach for Least-Squares Estimation
,”
AIChE J.
,
42
(
8
), pp.
2209
2224
.10.1002/aic.690420811
10.
Rao
,
C. V.
,
Rawlings
,
J. B.
, and
Lee
,
J. H.
,
2001
, “
Constrained Linear State Estimation-a Moving Horizon Approach
,”
Automatica
,
37
(
10
), pp.
1619
1628
.10.1016/S0005-1098(01)00115-7
11.
Allgower
,
F.
,
Findeisen
,
R.
, and
Nagy
,
Z.
,
2004
, “
Nonlinear Model Predictive Control: From Theory to Application
,”
J. Chin. Inst. Chem. Eng.
,
35
(
3
), pp.
299
315
.10.6967/JCICE.200405.0299
12.
Rao
,
C.
,
Rawlings
,
J.
, and
Mayne
,
D.
,
2003
, “
Constrained State Estimation for Nonlinear Discrete-Time Systems: Stability and Moving Horizon Approximations
,”
IEEE Trans. Autom. Control
,
48
(
2
), pp.
246
258
.10.1109/TAC.2002.808470
13.
Diehl
,
M.
,
Ferreau
,
H. J.
, and
Haverbeke
,
N.
,
2009
,
Efficient Numerical Methods for Nonlinear MPC and Moving Horizon Estimation
,
Springer
,
Berlin, Heidelberg
, pp.
391
417
.
14.
Kuhl
,
P.
,
Diehl
,
M.
,
Kraus
,
T.
,
Schlöder
,
J. P.
, and
Bock
,
H. G.
,
2011
, “
A Real-Time Algorithm for Moving Horizon State and Parameter Estimation
,”
Comput. Chem. Eng.
,
35
(
1
), pp.
71
83
.10.1016/j.compchemeng.2010.07.012
15.
Rao
,
C. V.
, and
Rawlings
,
J. B.
,
2002
, “
Constrained Process Monitoring: Moving-Horizon Approach
,”
AIChE J.
,
48
(
1
), pp.
97
109
.10.1002/aic.690480111
16.
Haseltine
,
E.
, and
Rawlings
,
J.
,
2005
, “
Critical Evaluation of Extended Kalman Filtering and Moving-Horizon Estimation
,”
Ind. Eng. Chem. Res.
,
44
(
8
), pp.
2451
2460
.10.1021/ie034308l
17.
Baumgartner
,
K.
,
Frey
,
J.
,
Hashemi
,
R.
, and
Diehl
,
M.
,
2021
, “
Zero-Order Moving Horizon Estimation for Large-Scale Nonlinear Processes
,”
Comput. Chem. Eng.
,
154
, p.
107433
.10.1016/j.compchemeng.2021.107433
18.
Alessandri
,
A.
, and
Gaggero
,
M.
,
2020
, “
Fast Moving Horizon State Estimation for Discrete-Time Systems With Linear Constraints
,”
Int. J. Adaptive Control Signal Process.
,
34
(
6
), pp.
706
720
.10.1002/acs.3054
19.
Gharbi
,
M.
, and
Ebenbauer
,
C.
,
2020
, “
A Proximity Moving Horizon Estimator for a Class of Nonlinear Systems
,”
Int. J. Adapt. Control Signal Process.
,
34
(
6
), pp.
721
742
.10.1002/acs.3092
20.
Bastos
,
G.
, and
Franco
,
E.
,
2023
, “
Dynamic Tube Model Predictive Control for a Class of Soft Manipulators With Fluidic Actuation
,”
Int. J. Robust Nonlinear Control
, epub.10.1002/rnc.6598
21.
Suzumori
,
K.
,
Iikura
,
S.
, and
Tanaka
,
H.
,
1991
, “
Development of Flexible Microactuator and Its Applications to Robotic Mechanisms
,”
Proceedings. 1991 IEEE International Conference on Robotics and Automation
,
Sacramento, CA, Apr. 9–11, pp.
1622
1627
.10.1109/ROBOT.1991.131850
22.
Garriga-Casanovas
,
A.
,
Collison
,
I.
, and
Rodriguez y Baena
,
F.
,
2018
, “
Toward a Common Framework for the Design of Soft Robotic Manipulators With Fluidic Actuation
,”
Soft Rob.
,
5
(
5
), pp.
622
649
.10.1089/soro.2017.0105
23.
Gerboni
,
G.
,
Ranzani
,
T.
,
Diodato
,
A.
,
Ciuti
,
G.
,
Cianchetti
,
M.
, and
Menciassi
,
A.
,
2015
, “
Modular Soft Mechatronic Manipulator for Minimally Invasive Surgery (MIS): Overall Architecture and Development of a Fully Integrated Soft Module
,”
Meccanica
,
50
(
11
), pp.
2865
2878
.10.1007/s11012-015-0267-0
24.
Franco
,
E.
,
Garriga-Casanovas
,
A.
,
Tang
,
J.
,
Rodriguez y Baena
,
F.
, and
Astolfi
,
A.
,
2021
, “
Adaptive Energy Shaping Control of a Class of Nonlinear Soft Continuum Manipulators
,”
IEEE ASME Trans. Mechatron.
,
27
(
1
), pp.
1
11
.10.1109/TMECH.2021.3063121
25.
Suzumori
,
K.
,
Miyagawa
,
T.
,
Kimura
,
M.
, and
Hasegawa
,
Y.
,
1999
, “
Micro Inspection Robot for 1-in Pipes
,”
IEEE/ASME Trans. Mechatron.
,
4
(
3
), pp.
286
292
.10.1109/3516.789686
26.
Chung
,
J.
, and
Hulbert
,
G.
,
1993
, “
A Time Integration Algorithm for Structural Dynamics With Improved Numerical Dissipation: The Generalized-α Method
,”
ASME J. Appl. Mech.
,
60
(
2
), pp.
371
375
.10.1115/1.2900803
27.
Arnold
,
M.
, and
Brüls
,
O.
,
2007
, “
Convergence of the Generalized-α Scheme for Constrained Mechanical Systems
,”
Multibody Syst. Dyn.
,
18
(
2
), pp.
185
202
.10.1007/s11044-007-9084-0
28.
Newmark
,
N.
,
1959
, “
A Method of Computation for Structural Dynamics
,”
J. Eng. Mech.
,
85
(
3
), pp.
67
94
.10.1061/JMCEA3.0000098
29.
Diehl
,
M.
,
2022
, “
Lecture Notes on Modelling and System Identification
,” Lecture Manuscript.
30.
Bastos
,
G.
, and
Franco
,
E.
,
2021
, “
Energy Shaping Dynamic tube-MPC for Underactuated Mechanical Systems
,”
Nonlinear Dyn.
,
106
(
1
), pp.
359
380
.10.1007/s11071-021-06863-9
31.
Betts
,
J.
,
2010
,
Practical Methods for Optimal Control and Estimation Using Nonlinear Programming
, 2nd ed.,
Society for Industrial and Applied Mathematics
, Philadelphia, PA.
32.
Franco
,
E.
, and
Garriga-Casanovas
,
A.
,
2021
, “
Energy-Shaping Control of Soft Continuum Manipulators With in-Plane Disturbances
,”
Int. J. Rob. Res.
,
40
(
1
), pp.
236
255
.10.1177/0278364920907679
33.
Bastos
,
G.
,
Seifried
,
R.
, and
Brüls
,
O.
,
2017
, “
Analysis of Stable Model Inversion Methods for Constrained Underactuated Mechanical Systems
,”
Mech. Mach. Theory
,
111
, pp.
99
117
.10.1016/j.mechmachtheory.2017.01.011
You do not currently have access to this content.