[go: up one dir, main page]

Next Article in Journal
A Novel Method for Speech Acquisition and Enhancement by 94 GHz Millimeter-Wave Sensor
Previous Article in Journal
An Electrically Tunable Zoom System Using Liquid Lenses
 
 
Font Type:
Arial Georgia Verdana
Font Size:
Aa Aa Aa
Line Spacing:
Column Width:
Background:
Article

Position and Velocity Estimation for Two-Inertia System with Nonlinear Stiffness Based on Acceleration Sensor

1
Department of Electronic Engineering, Sungkyunkwan Univerity, Suwon 440-746, Korea
2
Korea Institute of Industrial Technology, Ansan 426-171, Korea
3
ASRI, Department of Electrical and Computer Engineering, Seoul National University, Seoul 151-744, Korea
*
Author to whom correspondence should be addressed.
Sensors 2016, 16(1), 49; https://doi.org/10.3390/s16010049
Submission received: 27 October 2015 / Revised: 21 December 2015 / Accepted: 24 December 2015 / Published: 31 December 2015
(This article belongs to the Section Physical Sensors)

Abstract

:
In this paper, we consider the state estimation problem for flexible joint manipulators that involve nonlinear characteristics in their stiffness. The two key ideas of our design are that (a) an accelerometer is used in order that the estimation error dynamics do not depend on nonlinearities at the link part of the manipulators and (b) the model of the nonlinear stiffness is indeed a Lipschitz function. Based on the measured acceleration, we propose a nonlinear observer under the Lipschitz condition of the nonlinear stiffness. In addition, in order to effectively compensate for the estimation error, the gain of the proposed observer is chosen from the ARE (algebraic Riccati equations) which depend on the Lipschitz constant. Comparative experimental results verify the effectiveness of the proposed method.

1. Introduction

Flexible joint manipulators are widely used in industrial applications that require high productivity [1,2]. Furthermore, they can deal with many kinds of assembling, manufacturing, and moving jobs with low costs. Thus, for several decades, a lot of effective control methods have been proposed [1,2,3,4,5,6,7,8]. While the majority of the proposed controllers require exact state information, such as the position and the velocity of the motor and the link, it is not easy to obtain this exact state information due to the high nonlinearity, high coupling, and model uncertainty. In particular, the estimation of link states is important because most industrial manipulators are not usually equipped with sensors. To this end, research has been conducted [4,9,10]. However, it is still difficult to obtain link information because the motor position is only measurable and the manipulators demonstrate flexibility between the motor and link.
Recently, observers based on the acceleration information have been proposed to obtain more accurate states [11,12,13,14,15]. By the accelerometer which is mounted on the link of the robot manipulator, the observer uses information of link acceleration, and thus the complexity of the link part can be eliminated. As a result, the estimation error can be made globally asymptotically stable for flexible joint manipulators with linear stiffness. However, as shown in Figure 1, the flexible joint manipulators actually have nonlinear characteristics in stiffness that appear when the torsional angle between the motor and the link increases [16,17,18].
Figure 1. Nonlinear stiffness.
Figure 1. Nonlinear stiffness.
Sensors 16 00049 g001
In this paper, we propose an acceleration based nonlinear observer that takes into consideration the nonlinear stiffness of the robot manipulator. We transform the robot model with nonlinear stiffness into a Lipschitz nonlinear system [19], and then design the observer of the transformed system. The observer gain is designed by the ARE (algebraic Riccati equations) in order that the observer error asymptotically converges to zero.
The paper adheres to the following organizational structure: In Section 2, we present the problem formulation. Section 3 provides an observer design method and stability analysis. Then, in Section 4, the proposed observer is experimentally tested in terms of real industrial robots. Finally, conclusions are laid out Section 5.

2. Problem Formulation

While the eventual goal of this paper is to estimate the states of the multiaxis flexible joint manipulator, we consider the observation problem for a two-inertia system since it appropriately describes the dynamic characteristics of a single manipulator with a flexible joint [20]. The two-inertia system is described by [16]
θ ˙ l = ω l ω ˙ l = J l - 1 ( θ l ) D ( ω m - ω l ) + K ( θ l , θ m ) - C ( θ l , ω l ) - G ( θ l ) θ ˙ m = ω m ω ˙ m = J m - 1 D ( ω l - ω m ) - K ( θ l , θ m ) + J m - 1 τ
where θ l and θ m are the angular positions of the link and motor, and ω l and ω m are the angular velocities of the link and motor, respectively. The signal τ is the torque applied to the motor. The link inertia J l ( θ l ) and the gravity term G ( θ l ) depend on the position of the link, and Coriolis and centrifugal term C ( θ l , ω l ) depend on the position and angular velocity of the link, while the motor inertia J m and damping D have constant values. The nonlinear stiffness function K ( θ l , θ m ) is given by
K ( θ l , θ m ) = - k 1 θ B - k 2 θ B 3 - ( k 1 + 3 k 2 θ B 2 ) ( - θ m + θ l - θ B ) , if θ m - θ l < - θ B k 1 ( θ m - θ l ) + k 2 ( θ m - θ l ) 3 , if θ m - θ l θ B k 1 θ B + k 2 θ B 3 + ( k 1 + 3 k 2 θ B 2 ) ( θ m - θ l - θ B ) , if θ m - θ l > θ B
where the positive numbers k 1 and k 2 represent the linear and nonlinear coefficients of spring stiffness, respectively. The breakpoint deflection θ B is a positive constant, which refers to the physical limit of the torsional angle between the motor and link.
Our goal is to design an observer that guarantees the estimation performance of all the states of the Equation (1). In particular, it is important to estimate the states of the link part because of the lack of the available position sensors on the link side.
Now, some assumptions are made, on which the proposed observer will be designed in the next section.
Assumption 1. The motor position θ m and the link acceleration ω ˙ l are measurable while θ l , ω l , and ω m are not.
Assumption 2. The system parameters J m , D , k 1 , k 2 , and θ B are known.

3. Main Results

3.1. Observer Design

Define θ d : = θ m - θ l . Then, the Equation (2) is divided into a linear part and a nonlinear part of θ d , and thus it follows from Equations (1) and (2) that
x ˙ = A x + Y + Φ ( x ) + B u y 1 = C x
where u : = τ is the input, x : = x 1 x 2 x 3 x 4 T : = θ l ω l θ d ω m T are the states, y : = y 1 y 2 T : = θ m ω ˙ l T are the measurable outputs, and
A = 0 1 0 0 0 0 0 0 0 - 1 0 1 0 J m - 1 D - J m - 1 k 1 - J m - 1 D , Y = 0 y 2 0 0 Φ ( x ) = 0 0 0 - J m - 1 ϕ ( x 3 ) , B = 0 0 0 J m - 1 , C = 1 0 1 0 T ϕ ( x 3 ) = ϕ 1 ( x 3 ) = 3 k 2 θ B 2 x 3 + 2 k 2 θ B 3 , if x 3 < - θ B ϕ 2 ( x 3 ) = k 2 x 3 3 , if x 3 θ B ϕ 3 ( x 3 ) = 3 k 2 θ B 2 x 3 - 2 k 2 θ B 3 , if x 3 > θ B
Note that the matrix Φ ( x ) is a nonlinear function of ϕ ( x 3 ) , and thus we obtain the following.
Lemma 1. 
The function Φ ( x ) is globally Lipschitz, i.e., there exists a Lipschitz constant γ ( = J m - 1 3 k 2 θ B 2 ) > 0 such that the following property holds.
Φ ( x ) - Φ ( x ^ ) γ x - x ^ , x , x ^ R 4
Now, we propose a nonlinear observer for the System (3) as follows:
x ^ ˙ = A x ^ + Y + Φ ( x ^ ) + B u + L ( y 1 - y ^ 1 ) y ^ 1 = C x ^
where L is a suitable observer gain (which will be designed in the following).
Define the estimation error by e : = x - x ^ . Then, the estimation error dynamic is seen to be given by
e ˙ = ( A - L C ) e + Φ ( x ) - Φ ( x ^ ) = : A o b e + Φ ( x ) - Φ ( x ^ )
In order to stabilize the error System (5), it is of great importance to design an appropriate observer gain L. When the nonlinear term Φ ( x ) - Φ ( x ^ ) is zero, the stability of error dynamics is guaranteed if the observer gain L is designed such that the matrix A - L C is Hurwitz (i.e., all its eigenvalues have negative real parts). However, since the Equation (5) has a nonlinear term, the Lipschitz function, we have to use a different method. There are some results on the study that consider the stability of Estimation Error Dynamics (5) [19,21]. We briefly introduce a result in [19] to design the observer gain matrix L. For some small ϵ > 0 , if the following the ARE (algebraic Riccati equation)
A P + P A T + P γ 2 I - 1 ϵ C T C P + I + ϵ I = 0
has a symmetric positive definite solution P. Then, the observer gain
L = P C T 2 ϵ
stabilizes the Estimation Error Eynamics (5).
We shall now proceed to state the main results of this paper.
Theorem 1. 
Suppose the observer is given by Equation (4). Then, under Assumptions 1 and 2, the Estimation Error Dynamic (5) is asymptotically stable if the algebraic Ricaati Equation (6) has a symmetric positive definite solution P and the observer gain is designed by Equation (7).
Proof. 
From the Equations (6) and (7), we obtain
A o b P + P A o b T + γ 2 P P + I < 0
Then, by [19] (Lemma 1), we have
A o b T P 1 + P 1 A o b + γ 2 P 1 P 1 + I < 0
where P 1 is any symmetric positive definite matrix. Consider the Lyapunov function candidate
V = e T P 1 e
By Lemma 1, its derivative is given by
V ˙ = e T ( A o b T P 1 + P 1 A o b ) e + 2 e T P 1 Φ ( x ) - Φ ( x ^ ) e T ( A o b T P 1 + P 1 A o b ) e + 2 P 1 e Φ ( x ) - Φ ( x ^ ) e T ( A o b T P 1 + P 1 A o b ) e + 2 γ P 1 e e e T ( A o b T P 1 + P 1 A o b ) e + γ 2 e T P 1 P 1 e + e T e = e T ( A o b T P 1 + P 1 A o b + γ 2 P 1 P 1 + I ) e
It follows from the Equation (9) that V ˙ < 0 , and so the Estimation Error Dynamics (5) is asymptotically stable by [22] (Theorem 4.1). ☐
Remark 1. Instead of the results from [19], we can consider the high gain observer proposed in [23] because the proposed Observer (4) does not guarantee the solution of the ARE exists. In fact, the observer gain of [23] does not require the resolution of any equation and is explicitly given. However, the System (3) does not satisfy the necessary assumptions of [23] because of the nonlinear term Φ ( x ) .

3.2. Coordinate Transformation

Since the manipulator systems in industrial fields usually have large coefficients of spring stiffness function, the magnitude of γ also has a large value. If γ is too large to satisfy the conditions in which the ARE (6) has a symmetric positive definite solution, then we cannot find the positive definite solution P satisfying the ARE since the real values of the eigenvalues of the Hamiltonian matrix for the ARE are close to zero [24]. Thus, in order to reduce the Lipschitz constant, we use the coordinate transformation method proposed in [21].
Let us define a transformation matrix
T : = 1 0 0 0 0 1 0 0 0 0 1 0 0 0 0 β
where β is any small positive number. Suppose z : = T x , then, the System (3) becomes
z ˙ = T A T - 1 z + T Y + T Φ ( T - 1 z ) + T B u y 1 = C T - 1 z
where z 1 = x 1 , z 2 = x 2 , z 3 = x 3 , z 4 = β x 4 , and T Φ ( T - 1 z ) = 0 0 0 - β J m - 1 ϕ ( z 3 ) T . Similarly, with z ^ : = T x ^ , the Equation (4) becomes
x ^ ˙ = T A T - 1 z ^ + T Y + T Φ ( T - 1 z ^ ) + T B u + T L ( y 1 - y ^ 1 ) y ^ 1 = C T - 1 z ^
Then, with e z : = z - z ^ , the estimation error dynamics in the new coordinate are seen to be given by:
e ˙ z = T ( A - L C ) T - 1 e z + T Φ ( T - 1 z ) - Φ ( T - 1 z ^ ) = : A ˜ o b e z + T Φ ( T - 1 z ) - Φ ( T - 1 z ^ )
Here, the Lipschitz constant γ in Lemma 1 is changed by the transformation matrix T as follows:
T Φ ( T - 1 z ) - T Φ ( T - 1 z ^ ) = 0 0 0 - β J m - 1 ϕ ( z 3 ) - 0 0 0 - β J m - 1 ϕ ( z ^ 3 ) β J m - 1 ϕ ( z 3 ) - ϕ ( z ^ 3 ) β γ z 3 - z ^ 3 = : γ ˜ z 3 - z ^ 3
Then, similar to the Equation (6), we obtain the following the ARE with the new Lipschitz constant γ ˜ = β γ
A ˜ P ˜ + P ˜ A ˜ T + P ˜ γ ˜ 2 I - 1 ϵ C ˜ T C ˜ P ˜ + I + ϵ I = 0
where A ˜ : = T A T - 1 and C ˜ : = C T - 1 . Therefore, if the ARE (16) has a symmetric positive definite solution P ˜ , then the new observer gain
L = T - 1 P ˜ C ˜ 2 2 ϵ
stabilizes the Estimation Error Dynamics (5), and also stabilizes the System (5) by e = T - 1 e z .

4. Experimental Results

In this section, an experiment on a real industrial robot was carried out in order to verify the effectiveness of the observer proposed in this paper. As shown in Figure 2, the FPD (flat panel display) transfer robot is used in this experiment. As a matter of fact, most of the industrial manipulators just have an encoder in the motor part and not the link part, but the FPD robot also has an encoder in order to measure the link position. Consequently, without any position measurement system, we can compare the actual link position and the estimated value from the designed observer. This is why we used the FPD robot instead of the typical six-joint manipulator shown in [1,2,15]. The parameters of this robot system are given in Table 1. To obtain the acceleration information of the link side, we also use Miniature DeltaTron Accelerometer Type 4508B (manufactured by Brüel & Kjr). The design parameters for the proposed Observer (4) are selected as shown Table 2. The observers are implemented through Matlab xPC Target and the sampling rate is 2 kHz.
Figure 2. FPD (flat panel display) transfer robot.
Figure 2. FPD (flat panel display) transfer robot.
Sensors 16 00049 g002
Table 1. System parameters.
Table 1. System parameters.
ParameterValueUnit
motor inertia ( J m )0.001027kg· m 2
damping (D)600Nm·s/rad
k 1 1.5 × 10 6 Nm/rad
k 2 9.85 × 10 11 Nm/rad 3
θ B 2arcmin
gear ratio144
Table 2. Design parameters.
Table 2. Design parameters.
ParameterValue
observer gain (L) - 15968 , - 8506 , 19896 , 154 T
ϵ 1 . 0 × 10 - 6
β 1 . 0 × 10 - 5
Now, as shown in Figure 3, we compare the estimation performances of the proposed observer and the observer with the linear stiffness proposed in [11]. Specifically, we force on the estimation performance of the link states (position and velocity) since the motor states are typically obtained from the sensors such as encoders. Figure 4 shows the trajectory of the link position for cases of multi motion. The positive angle means that the robot arm rotates in a clockwise direction, whereas the negative angle implies a counter-clockwise direction. The black solid line is the measured value from the encoder, and the red dash-dot line and the blue dashed line are the estimated value of the conventional observer and proposed observer, respectively. In order to examine the performance in more detail, we magnify Figure 4 at 4.7 s and 6.7 s, respectively, as shown in Figure 5 and Figure 6. In addition, Figure 7 shows the estimation error of the link position of Figure 4. We note that the estimation performance of proposed observer is better than the conventional observer. In particular, it is observed that the estimation error is better suppressed with the proposed observer in transition response because the torsional angle increased in transition is the cause of the characteristic of the nonlinear stiffness as shown in Figure 1. On the other hand, the characteristic of nonlinear stiffness weakens in the steady-state since the torsional angle approaches the origin. Similarly, as shown in Figure 8, the estimation performance of the link velocity is also better than the conventional observer.
Figure 3. Block diagram of the robot system with the conventional and proposed observer.
Figure 3. Block diagram of the robot system with the conventional and proposed observer.
Sensors 16 00049 g003
Figure 4. Trajectory of the link position θ l .
Figure 4. Trajectory of the link position θ l .
Sensors 16 00049 g004
Figure 5. Magnified trajectory of the link position (around 4.7 s).
Figure 5. Magnified trajectory of the link position (around 4.7 s).
Sensors 16 00049 g005
Figure 6. Magnified trajectory of the link position (around 6.7 s).
Figure 6. Magnified trajectory of the link position (around 6.7 s).
Sensors 16 00049 g006
Figure 7. Estimation error of the link position θ l .
Figure 7. Estimation error of the link position θ l .
Sensors 16 00049 g007
Figure 8. Trajectory of the link velocity ω l .
Figure 8. Trajectory of the link velocity ω l .
Sensors 16 00049 g008

5. Conclusions

In this paper, we have presented a state observer for flexible joint manipulators using the acceleration information of the link side. The observer has been designed on the basis of the Lipschitz nonlinear system, and the stability and performance have been analyzed. In particular, unlike conventional approaches, the study has dealt with the nonlinear stiffness in order to estimate real systems more closely. Therefore, the proposed observer has improved performance compared to that of the conventional observer considering the linear stiffness. Finally, the proposed observer is applied to the real industrial robot, and its effectiveness is confirmed via experiments.

Acknowledgments

This work was supported by the Korea Institute of Industrial Technology (KITECH).

Author Contributions

Kyung-Tae Nam and Hyungjong Kim proposed the detection idea, designed electrodes and sensors and wrote the manuscript. Seung-Joon Lee and Tae-Young Kuc performed the experiments and edited the manuscript.

Conflicts of Interest

The authors declare no conflict of interest.

References

  1. Spong, M.W.; Hutchinson, S.; Vidyasagar, M. Robot Modeling and Control; Wiley: New York, NY, USA, 2006. [Google Scholar]
  2. Bang, J.S.; Shim, H.; Park, S.K.; Seo, J.H. Robust tracking and vibration suppression for a two-inertia system by combining backstepping approach with disturbance observer. IEEE Trans. Ind. Electron. 2010, 11, 618–623. [Google Scholar]
  3. Tomei, P. A simple pd controller for robots with elastic joints. IEEE Trans. Autom. Control 1991, 36, 1208–1213. [Google Scholar] [CrossRef]
  4. Jankovic, M. Observer based control for elastic joint robots. IEEE Trans. Robot. Autom. 1995, 11, 618–623. [Google Scholar] [CrossRef]
  5. Choi, C.H.; Kwak, N. Robust control of robot manipulator by model-based disturbance attennuation. IEEE ASME Trans. Mechatron. 2003, 8, 511–513. [Google Scholar] [CrossRef]
  6. Islam, S.; Liu, P.X. Pd output feedback control design for industrial robotic manipulators. IEEE ASME Trans. Mechatron. 2011, 18, 187–197. [Google Scholar] [CrossRef]
  7. Kostarigka, A.K.; Doulgeri, Z.; Rovithakis, G.A. Prescribed performance tracking for flexible joint robots with unknown dynamics and variable elasticity. Automatica 2013, 49, 1137–1147. [Google Scholar] [CrossRef]
  8. Yun, J.N.; Su, J.B. Design of a disturbance ovserver for a tow-link manipulator with flexible joints. IEEE Trans. Control Syst. Technol. 2014, 22, 809–815. [Google Scholar] [CrossRef]
  9. Lotfi, N.; Namvar, M. Global adaptive estimation of joint velocities in robotic manipulators. IET Control Theory Appl. 2010, 4, 2672–2681. [Google Scholar] [CrossRef]
  10. Cantelli, L.; Muscato, G.; Nunnari, M.; Spina, D. A joint-angle estimation method for industrial manipulators using inertial sensors. IEEE ASME Trans. Mechatron. 2015, 20, 2486–2495. [Google Scholar] [CrossRef]
  11. Luca, A.E.; Schroder, D.; Thummel, M.; Spina, D. An acceleration-based state observer for robot manipulators with elastic joints. In Proceedings of the IEEE International Conference on Robotics and Automation, Roma, Italy, 10–14 April 2007; pp. 3817–3823.
  12. Staufer, P.; Gattringer, H. State estimation on flexible robots using accelerometers and angular rate sensors. Mechatronics 2012, 22, 1043–1049. [Google Scholar] [CrossRef]
  13. Axelsson, P.; Karlssn, R.; Norrlof, M. Bayesian state estimation of a flexible industrial robot. Mechatronics 2012, 20, 1220–1228. [Google Scholar] [CrossRef]
  14. Chen, W.; Tomizuka, M. Load side state estimation in robot with joint elasticity. In Proceedings of the IEEE/ASME International Conference on Advanced Intelligent Mechatronics (AIM), Kachsiung, Taiwan, 11–14 July 2012; pp. 598–603.
  15. Chen, W.; Tomizuka, M. Direct joint space state estimation in robots with multiple elastic joints. IEEE ASME Trans. Mechatron. 2014, 19, 697–706. [Google Scholar] [CrossRef]
  16. Moberg, S.; Öhr, J.; Gunnarsson, S. A benchmark problem for robust control of a multivariable nonlinear flexible manipulator. In Proceedings of the 17th IFAC World Congress, Seoul, Korea, 6–11 July 2008; pp. 1206–1211.
  17. Moberg, S.; Öhr, J.; Gunnarsson, S. A benchmark problem for robust control of a multivariable nonlinear flexible manipulator. IEEE Trans. Control Syst. Technol. 2009, 17, 1398–1405. [Google Scholar] [CrossRef]
  18. Moberg, S.; Wernholt, E.; Hanssen, S.; Brongardh, T. Modeling and parameter estimation of robot manipulators using extended flexible joint models. J. Dyn. Syst. Meas. Control 2014, 136, 1–13. [Google Scholar] [CrossRef]
  19. Raghavan, S.; Hedrick, J.K. Observer design for a class of nonlinear systems. Asian J. Control 1994, 59, 515–528. [Google Scholar] [CrossRef]
  20. Sugiura, K.; Hori, Y. Vibration suppression in 2- and 3-mass system based on the feedback of imperfect derivative of the estimated torsional torque. IEEE Trans. Ind. Electron. 1996, 43, 56–64. [Google Scholar] [CrossRef]
  21. Song, B.; Hedrick, J.K. Nonlinear observer design for lipschitz nonlinear systems. In Proceedings of the American Control Conference (ACC), San Francisco, CA, USA, 29 June–1 July 2011; pp. 2578–2583.
  22. Khalil, H. Nonlinear Systems, 3rd ed.; Prentice-Hall: Upper Saddle River, NJ, USA, 2001. [Google Scholar]
  23. Farza, M.; M’Saad, M.; Rossignol, L. Observer design for a class of MIMO nonlinear systems. Automatica 2004, 40, 135–143. [Google Scholar] [CrossRef]
  24. Ni, M.-L. Existence condition on solutions to the algebraic riccati equation. Acta Autom. Sin. 2008, 34, 85–87. [Google Scholar] [CrossRef]

Share and Cite

MDPI and ACS Style

Nam, K.-T.; Lee, S.-J.; Kuc, T.-Y.; Kim, H. Position and Velocity Estimation for Two-Inertia System with Nonlinear Stiffness Based on Acceleration Sensor. Sensors 2016, 16, 49. https://doi.org/10.3390/s16010049

AMA Style

Nam K-T, Lee S-J, Kuc T-Y, Kim H. Position and Velocity Estimation for Two-Inertia System with Nonlinear Stiffness Based on Acceleration Sensor. Sensors. 2016; 16(1):49. https://doi.org/10.3390/s16010049

Chicago/Turabian Style

Nam, Kyung-Tae, Seung-Joon Lee, Tae-Yong Kuc, and Hyungjong Kim. 2016. "Position and Velocity Estimation for Two-Inertia System with Nonlinear Stiffness Based on Acceleration Sensor" Sensors 16, no. 1: 49. https://doi.org/10.3390/s16010049

Note that from the first issue of 2016, this journal uses article numbers instead of page numbers. See further details here.

Article Metrics

Back to TopTop