Abstract
A novel two-stage approach is presented for improving the estimates of both the kinematic state and the unknown external forces in rigid-link multibody systems with negligible joint clearance. The approach is said to be a two-stage one because the estimation process is carried out by two observers running simultaneously and only partially coupled in order to reduce model uncertainties. Nonlinear Kalman filters are employed at both stages. In the first stage, a kinematic observer estimates an augmented system state (i.e., positions, velocities and accelerations) by employing the kinematic constraint equations and some measurements of kinematic quantities as inputs and outputs. Therefore, it is unbiased by external forces and uncertainties on any dynamic parameters. In the second stage, a force observer estimates the external forces by employing dynamic models. The input of the force observer is the kinematic state, while the correction is performed through some direct or indirect measurements of the known forces. Numerical assessment of the theory developed is provided through a slider–crank mechanism. The results achieved through the proposed approach are compared with those yielded by traditional unknown input observers based on a single-stage dynamic estimation. An extensive statistical analysis is carried out at varying levels of measurement noise. Two different strategies are followed in the synthesis of the non-linear Kalman filters. The comparison clearly shows the advantages and the effectiveness of the new two-stage approach.
Similar content being viewed by others
References
Torres, J., Blanco, J., Sanjurjo, E., Naya, M., Giménez, A.: Towards benchmarking of state estimators for multibody dynamics. In: Proc. of the 7th Asian International Conference on Multibody System Dynamics, pp. 261–262
Pastorino, R., Richiedei, D., Cuadrado, J., Trevisani, A.: State estimation using multibody models and non-linear Kalman filters. Int. J. Non-Linear Mech. 53, 83–90 (2013)
Grewal, M.S., Andrews, A.P.: Kalman Filtering: Theory and Practice Using MATLAB. Wiley, New York (2011)
Lourens, E., Reynders, E., De Roeck, G., Lombaert, G.: An augmented Kalman filter for force identification in structural dynamics. Mech. Syst. Signal Process. 27(1), 446–460 (2012)
Naets, F., Pastorino, R., Cuadrado, J., Desmet, W.: Online state and input force estimation for multibody models employing extended Kalman filtering. Multibody Syst. Dyn. 32(3), 317–336 (2014)
Jeon, S.: State estimation based on kinematic models considering characteristics of sensors. In: Proceedings American Control Conference, pp. 640–645 (2010)
Palomba, I., Richiedei, D., Trevisani, A.: Kinematic state estimation for rigid-link multibody systems by means of nonlinear constraint equations. Multibody Syst. Dyn. (2016). doi:10.1007/s11044-016-9515-x
Zumer, J., Slavic, J., Boltezar, M.: Minimization of the positional errors for an accurate determination of the kinematic parameters of a rigid-body system with miniature inertial sensors. Mech. Mach. Theory 81, 193–208 (2014)
Simon, D.: Optimal State Estimation: Kalman, \(H_{\infty }\), and Nonlinear Approaches. Wiley, New York (2006)
Haug, A.: Bayesian Estimation and Tracking: A Practical Guide. Wiley, New York (2012)
Julier, S.: The spherical simplex unscented transformation. In: Proceedings American Control Conference, vol. 3, pp. 2430–2434 (2003)
Kalman, R.E.: A new approach to linear filtering and prediction problems. J. Basic Eng. 82, 35–45 (1960)
Šabanović, A., Ohnishi, K.: Motion Control Systems. Wiley, New York (2011)
Radke, A., Gao, Z.: A survey of state and disturbance observers for practitioners. In: Proceedings American Control Conference (2006)
Caracciolo, R., Richiedei, D., Trevisani, A.: Robust piecewise-linear state observers for flexible link mechanisms. J. Dyn. Syst. Meas. Control 130, 3 (2008)
Schmidt P., B., Rehm, T.: Adaptive motor drive method and apparatus including inertia estimator. U.S. Patent No. 7,395,124, US Patent and Trademark Office, Washington, DC (2008)
Zimmerschied, R., Isermann, R.: Nonlinear time constant estimation and dynamic compensation of temperature sensors. Control Eng. Pract. 18(3), 300–310 (2010)
Author information
Authors and Affiliations
Corresponding author
Appendix A: Implementation details
Appendix A: Implementation details
1.1 A.1 Two-stage approach
1.1.1 A.1.1 Kinematic observer
Starting from the definitions of the state and the inputs given in Table 1, it is possible to define the first-order ODEs representing the slider–crank mechanism in the kinematic estimation as follows:
The model in Eq. (A.1) has been discretized using the Runge–Kutta method of order 2, so the discrete-time model is
A discretization time of \(5\cdot 10^{-3}\mbox{ s}\) has been employed.
The augmented discrete-time kinematic model used in the state prediction takes the following form:
The measurement model employed by the kinematic observer is
1.1.2 A.1.2 Force observer
Equation (12) has been employed in order to formulate the model used for the state prediction in the force observer:
In Eq. (A.5), \(\mathrm{I}(\theta_{k-1})\), \(\mathrm{P}( \theta_{k-1})\), and \(\mathrm{C}(\theta_{k-1},\dot{\theta }_{k-1})\) are, respectively, the total inertia, gravity, and centrifugal effects of the mechanism reflected to the crank. All the data needed to compute such values are provided in Table 3.
The measurement model employed by the force observer is
1.2 A.2 Benchmark approach
The continuous-time first-order dynamic model augmented with a random walk model to represent the force acting on the slider \(F\) can be write as follows:
The model in Eq. (A.7) has been discretized using the Runge–Kutta method of order 2, so the discrete-time model is
A discretization time of \(5\times 10^{-3}\mbox{ s}\) has been employed.
The discrete-time model in Eq. (A.8) has been augmented with the Newmark’s first-order interpolation, in order to estimate also the crank acceleration. Finally, the discrete-time dynamic model used by the benchmark observer is the following one:
The measurement model employed by the benchmark observer is
1.3 A.3 Filter tuning
The filter implementation requires the knowledge of the statistics of the process and the measurement noise, i.e., the covariance matrices \(\mathbf{Q}\) and \(\mathbf{R}\), and an estimate of the initial state \(\mathbf{x}_{0}\) and its covariance \(\mathbf{P}_{0}\). In this paper the following choices have been adopted.
As far as \(\mathbf{x}_{0}\) is concerned, the state variables that are not directly measured have been set to zero, while the rest have been set to their measured values (\(\theta_{0}\), \(T_{0} \)):
The initial state covariances have been set on the basis of the sensor covariances (see Table 2) and by manual tuning of the remaining values. In particular, the following diagonal matrices have been selected:
The process noise covariance matrices have been set by analyzing the propagation of the parameter uncertainties on the state variables through the model, i.e., by comparing the model outcomes with different values of the uncertain parameters (see Table 3). The entries related to the force applied to the slider (the first one on the main diagonal in \(\mathbf{Q}^{\mathrm{for}}\) and the third one in \(\mathbf{Q}^{\mathrm{ben}}\)) have been manually tuned, since they are modeled as random walks and hence do not depend on model parameters. The following matrices have been obtained:
Finally, the measurement noise covariance matrices have been determined by standard deviations of the sensors (see Table 2), and have been set as diagonal matrices:
The same filter statistics have been used for both the SS-UKF and EKF to ensure a fair comparison.
Rights and permissions
About this article
Cite this article
Palomba, I., Richiedei, D. & Trevisani, A. Two-stage approach to state and force estimation in rigid-link multibody systems. Multibody Syst Dyn 39, 115–134 (2017). https://doi.org/10.1007/s11044-016-9548-1
Received:
Accepted:
Published:
Issue Date:
DOI: https://doi.org/10.1007/s11044-016-9548-1