Open AccessArticle

Finite-Time Disturbance Observer for Robotic Manipulators

Pengfei Cao

^1,2,

Yahui Gan

^1,2,*

and

Xianzhong Dai

^1,2

School of Automation, Southeast University, Nanjing 210096, China

Key Lab of Measurement and Control of Complex Systems of Engineering, Ministry of Education, Nanjing 210096, China

Author to whom correspondence should be addressed.

Sensors 2019, 19(8), 1943; https://doi.org/10.3390/s19081943

Submission received: 2 April 2019 / Revised: 19 April 2019 / Accepted: 22 April 2019 / Published: 25 April 2019

(This article belongs to the Collection Robotics, Sensors and Industry 4.0)

Download

Browse Figures

Versions Notes

Abstract

Robotic manipulators may be subject to different types of disturbances such as unknown payloads, unmodeled dynamics, and environment interaction forces. Observing these unknown disturbances in robotic manipulators is fundamental in many robotic applications such as disturbance rejection and sensorless force control. In this paper, a novel disturbance observer (DOB) is introduced based on the insights from the finite-time observer (FTO) and robot dynamics. Different from the traditional DOBs, this new observer can provide the capability to track the disturbance within a finite time. The performance of the presented observer is verified by two kinds of typical disturbances for a two-link manipulator with a comparison with several existing DOBs. The simulation results show the rapidity and accuracy of the proposed FTO.

Keywords:

disturbance observer; robotic manipulator; finite-time observer; human-robot interaction; estimation

1. Introduction

Robotic manipulators could be subject to different kinds of disturbances when they carry on normal operations. Roughly speaking, these disturbances can be divided into two categories, namely external and internal disturbances. These disturbances may present useful information about how the manipulator interacts with its environment. In addition to the interaction force disturbance, adverse disturbances such as unknown payloads, unmodeled dynamics may challenge the performance of the manipulator by affecting the trajectory tracking accuracy. In order to deduce these uncertain disturbances induced by either internal or external factors, it is necessary to incorporate a disturbance observer (DOB) to estimate these disturbances. Once the observer is provided, the DOB in robotic manipulators can enable versatile applications including disturbance observer based control [1,2,3], friction estimation and compensation [4,5], sensorless force/torque control [6,7,8], fault diagnose and isolation (FDI) [9,10,11] etc. For example, the interaction force between human and robot could be treated as the joint torque disturbances as the Cartesian forces could be projected into the joint level. By observing the interaction toque, the manipulator could sense human intention or accidental collision [11,12]. Thus, the design of a well and sound DOB is not only theoretically important to robotic techniques but also empirically required to enhance the performance of robotic manipulators.

The disturbance observer technique has been widely utilized in robotic manipulators for a variety of purposes. The basic idea of DOB is to use the robot motion state and joint torque as input and then to estimate all the unknown internal and external torque imposed on the manipulator in a lumped term as the output. In Reference [5], a nonlinear disturbance observer (NDOB) was established to estimate the rapidly varying friction by elaborately choosing a nonlinear function. However, the selection of such a nonlinear function is nontrivial, and the implementation of this NDOB is limited to a two link condition. By observing the generalized momentum, the generalized momentum observer (GMO) [9] is built, which not only can avoid the calculation of acceleration to decrease the influence of noise in position measurement but also can generate the observation of disturbances as a first-order filtered result of the true value. GMO is able to realize FDI such as the prediction of the accidental impact as well as the saturated actuator fault [9]. Its easy implementation and reliable performance make GMO a popular and widely used method in many robotic applications [6,8,12]. However, in practice, GMO has to make a trade-off between the response rate and noise filtering. In a sensorless scenario, GMO is designed to remove the noise in a motor current as much as possible but at the cost of a delayed response. Such delayed behavior will degrade the detection sensitivity and response rate when GMO is applied in collision detection. As an enhancement of GMO, an external state observer (ESO) was proposed in Reference [10] by taking the disturbance as an external state. Moreover, despite the fact that many DOBs have been developed for robotic manipulators [5,9,10,13,14], the asymptotic convergence rate of these DOBs reveals that the estimation error will not converge to a certain small level quickly and will never decay to zero.

From the aspect of convergence rates, most of the existing DOBs for robotic disturbance achieve the asymptotically tracking performance. Specifically, the system convergence rate of traditional DOBs is at best exponential while FTO can obtain faster convergence rate with a finite-time convergence. Due to the finite-time features, several types of FTOs have been designed for different systems with versatile applications [15,16,17,18,19,20]. In this paper, a novel DOB is conceived by the requirement of a fast and accurate estimation of robotic disturbances. Based on the robot dynamic model, the concept in finite-time control is employed in the observer design. The resulting FTO could enable the estimation of disturbance in a finite time, which guarantees that the estimation error could vanish after a certain time. The proposed FTO also removes the requirement of computing the acceleration. Its finite-time convergent property renders the disturbance observation with more accuracy and quickness.

The rest of the paper is organized as follows. In Section 2, some basic knowledge of robot dynamics and finite-time stability is presented along with the introduction of GMO. Section 3 details the design of the proposed FTO for disturbance estimation. The stability and convergent rate is also presented. Section 4 presents the tracking performance of FTO in a simulation in comparison with other DOBs. The conclusion and future perspective are provided in Section 5.

2. Preliminaries

2.1. Robot Dynamic Model

For an n degrees-of-freedom (DOFs) robotic manipulator with a rigid link and joint, its dynamics could be represented by

M (q) \ddot{q} + C (q, \dot{q}) \dot{q} + G (q) + τ_{f} = τ + τ_{d}

(1)

where

q \in R^{n}

is the joint position and its first and second derivatives

\dot{q}

and

\ddot{q}

are the joint velocity and acceleration, respectively.

M (q) \in R^{n \times n}

denotes the symmetric and positive-definite inertia matrix,

C (q, \dot{q}) \dot{q} \in R^{n}

represents the centrifugal and Coriolis torque vector with

G (q) \in R^{n}

the gravity effect.

τ_{f} \in R^{n}

denotes the lumped friction effect from both the motor and link sides and are always described with the following Coulomb-viscous model, namely

τ_{f} = F_{c} sgn (\dot{q}) + F_{v} \dot{q}

(2)

with

F_{c} = diag {F_{c 1}, \dots, F_{c n}}, F_{v} = diag {F_{v 1}, \dots, F_{v n}}

F_{c i}, F_{v i} (1 \leq i \leq n)

are the Coulomb and viscous friction coefficients for the ith joint. Such a friction model could capture most dynamic property of the friction in a rigid joint. The equivalent motor torque at the link side through a reduced amplification is denoted as

τ \in R^{n}

τ_{d} \in R^{n}

is the internal/external disturbances which could be an external force, unmodeled or uncertain robot dynamics. The exact meaning of

τ_{d}

decides on the specific application. The observed disturbance for a manipulator can be further utilized in FDI and disturbance rejection control. For example,

τ_{d}

is deemed as the physical impact with the environment for collision detection scenario and, thus,

τ_{d}

can indicate the occurrence of the collision. The robot dynamics model in Equation (1) has the following property.

Property 1.

The matrix

\dot{M} (q) - 2 C (q, \dot{q})

is skew-symmetry [21], and it follows that

\dot{M} (q) = C (q, \dot{q}) + C^{T} (q, \dot{q}) .

(3)

2.2. Disturbance Observer Using Generalized Momentum

In order to estimate the disturbances for a robotic manipulator, different observer design techniques have been envisaged to estimate the disturbances. One of the commonly used observers is the generalized momentum observer (GMO) proposed in Reference [9] of which the basic concept is to observe the generalized momentum

p = M (q) \dot{q}

. Combined with the generalized momentum p, the robot dynamics in Equation (1) could be rewritten to

\dot{p} = τ + C^{T} (q, \dot{q}) \dot{q} - G (q) + τ_{d} .

(4)

Then, GMO method is implemented as follows:

\hat{\dot{p}} = τ + C^{T} (q, \dot{q}) \dot{q} - G (q) + {\hat{τ}}_{d}

(5)

{\hat{τ}}_{d} = K_{o} (p - \hat{p})

(6)

where

(\hat{\cdot})

denotes the estimated value and

K_{o} = diag {k_{o i}} > 0

. More compactly, the disturbance estimation

{\hat{τ}}_{d}

is given as

{\hat{τ}}_{d} = K_{o} [p - \int (τ + C^{T} (q, \dot{q}) \dot{q} - G (q) + {\hat{τ}}_{d}) d t] .

(7)

From Equations (5) and (6), the time evolution of GMO is given by

{\hat{\dot{τ}}}_{d} = K_{o} (τ_{d} - {\hat{τ}}_{d})

(8)

or equivalently expressed in the Laplace domain as

{\hat{τ}}_{d} = \frac{K_{o}}{s + K_{o}} τ_{d} .

(9)

Thus, the observation

{\hat{τ}}_{d}

can be interpreted as the output of a first-order filtering of

τ_{d}

. The obtained estimation

{\hat{τ}}_{d}

yielded by GMO exponentially converges to the disturbance

τ_{d}

. It is worth noting that the convergent rate of this observer critically depends on the observance matrix

K_{o}

. In practice, a large value of

k_{o i}

is demanded to quickly reproduce the disturbance. However, system measurement noises and modeling errors will limit the gain of the observer [10]. Moreover, the estimation error exponentially decays which reveals that the estimation error always exists. Particularly, the estimation error will not decrease to a relatively small level until a certain time elapses, suggesting GMO fails to provide a fast and accurate estimation of the rapidly changing disturbances.

2.3. Finite-Time Stability

Consider the following nonlinear autonomous system.

\dot{x} = f (x), x \in R^{n}, f (0) = 0

(10)

where f satisfies the locally Lipschitz continuous condition. Some basic knowledge of finite-time stability and homogeneity is recalled hereafter. The definition of finite-time stability (FTS) [22,23] is given as follows.

Definition 1.

The equilibrium

x = 0

of Equation (10) is finite-time convergent if there is a function

T : U \ {0} \to (0, + \infty)

(U is a neighborhood of the origin) such that every solution trajectory

x (t, x_{0})

of Equation (10) starting from the initial point

x_{0} \in U \ {0}

is well-defined and unique on

[0, T (x_{0})]

and

{lim}_{t \to T (x_{0})} x (t, x_{0}) = 0

. Here,

T (x_{0})

is called the settling time of Equation (10). If the equilibrium of Equation (10) is Lyapunov stable and finite-time convergent, then the system in Equation (10) is finite-time stable (FTS).

In addition, the concept of homogeneity [23] is also introduced.

Definition 2.

A function

W : R^{n} \to R

is homogeneous of degree d with respect to the weights

(r_{1}, \dots, r_{n}) \in R^{n}

with

r_{i} > 0 (i = 1, \dots, n)

W (λ^{r_{1}} x_{1}, \dots, λ^{r_{n}} x_{n}) = λ^{d} W (x_{1}, \dots, x_{n}), \forall λ > 0 .

(11)

A vector field f is homogeneous of degree d with respect to the weights

(r_{1}, \dots, r_{n}) \in R^{n}

with

r_{i} > 0

(i = 1, \dots, n)

f_{i} (λ^{r_{1}} x_{1}, \dots, λ^{r_{n}} x_{n}) = λ^{r_{i} + d} f_{i} (x_{1}, \dots, x_{n}), \forall λ > 0

(12)

where

f_{i}

is the ith component of f. The system in Equation (10) is said to be homogeneous of degree d if the vector field f is homogeneous of degree d.

Next, a criteria to determine whether a system is FTS is described in the following theorem.

Theorem 1.

[24]: If the origin of Equation (10) is locally asymptotically stable and homogeneous of degree

d < 0

, then it is globally FTS.

3. Finite-Time Observer of Robotic Disturbance

The objective of this paper is to design a finite-time observer such that the observation of disturbance

τ_{d}

could converge to its actual value within a finite time. In this section, a basic FTO is primarily formulated to estimate the disturbance. Then, taking advantage of the the available system signals, a reduced-order FTO is deduced in order to reduce the computation burden and phase lag. Finally, an improved expression of the FTO is conceived such that the inversion of inertia matrix is avoided.

3.1. Finite-Time Observer Design

From Equation (1), the acceleration

\ddot{q}

can be written as

\ddot{q} = M^{- 1} (q) τ_{d} + M^{- 1} (q) (τ - C (q, \dot{q}) \dot{q} - G (q) - τ_{f}) .

(13)

By designating

τ_{a} = τ - C (q, \dot{q}) \dot{q} - G (q) - τ_{f}

, the above equation can be rewritten as

\ddot{q} = M^{- 1} (q) τ_{d} + M^{- 1} (q) τ_{a} .

(14)

where

M^{- 1} (q) τ_{d}

is treated as the system disturbances with

M^{- 1} (q) τ_{a}

the system input. Incorporating the FTO design skill in Reference [20], a basic FTO for robot disturbance is consequently designed in the following manner.

{\dot{z}}_{b 1} = z_{b 2} + K_{1} {⌊e_{b}⌉}^{α_{1}}

(15)

{\dot{z}}_{b 2} = z_{b 3} + M^{- 1} (q) τ_{a} + K_{2} {⌊e_{b}⌉}^{α_{2}}

(16)

{\dot{z}}_{b 3} = K_{3} {⌊e_{b}⌉}^{α_{3}}

(17)

where

z_{b 1} = \hat{q}, z_{b 2} = \hat{\dot{q}}

z_{b 3} = M^{- 1} (q) {\hat{τ}}_{d}

and

e_{b} = q - \hat{q}

K_{1}, K_{2}, K_{3} \in R^{n \times n}

are diagonal gain matrices. Moreover, the corresponding powers are selected as

α_{1} = α, α_{2} = 2 α - 1, α_{3} = 3 α - 2

, and

\frac{2}{3} < α < 1

. The operator

{⌊\cdot⌉}^{α}

is denoted as

{⌊x⌉}^{α} = {| x |}^{α} sgn (x), x \in R^{n} and α > 0 .

(18)

Consequently, the disturbance observation

{\hat{τ}}_{d}

is computed as

{\hat{τ}}_{d} = M (q) z_{b 3} .

(19)

The proposed third-order FTO can simultaneously estimate the joint velocity

\dot{q}

and disturbance torque

{\hat{τ}}_{d}

. Indeed, the joint velocity

\dot{q}

could be immediately acquired from the robotic control system, implying the basic FTO defined in Equations (15)–(17) could be tailored with both the observer order and computation burden reduction. Thus, a reduced-order FTO could be developed as

{\dot{z}}_{r 1} = z_{r 2} + M^{- 1} (q) τ_{a} + K_{1} {⌊e_{r}⌉}^{α_{1}}

(20)

{\dot{z}}_{r 2} = K_{2} {⌊e_{r}⌉}^{α_{2}}

(21)

where

z_{b 1} = \hat{\dot{q}}, z_{b 2} = M^{- 1} (q) {\hat{τ}}_{d}

and

e_{b} = \dot{q} - \hat{\dot{q}}

α_{1} = α, α_{2} = 2 α - 1

\frac{1}{2} < α < 1

. The calculation of the disturbance estimation resembles that given in Equation (19), i.e.,

{\hat{τ}}_{d} = M (q) z_{r 2} .

(22)

The reduced-order observer should have a quicker response than the previous design, which benefits the disturbance observation. However, it is worth noting that the inversion of the inertia matrix

M (q)

is involved in the observer design, which is quiet a troublesome issue for algorithmic computation. Specifically, the matrix inversion has a cubic complexity, which inevitably brings heavy computational burden in the case of robots with large DOFs. Generally speaking, the observed system defined in Equation (14) containing the inversion of

M (q)

should be responsible for the matrix inversion in the designed observer. In order to circumvent the matrix inversion, it is necessary to rearrange the original system from Equation (14) into a transformed equation with different state variables. Multiplying both sides of Equation (14) with

M (q)

yields

M (q) \ddot{q} = τ_{a} + τ_{d} .

(23)

Additionally, the left side of Equation (23) could be altered using the generalized momentum p, namely

\dot{p} - \dot{M} (q) \dot{q} = τ_{a} + τ_{d} .

(24)

Reorganizing Equation (24) and employing Property 1, the derivative of the generalized momentum p is rewritten as

\dot{p} = τ_{d} + τ_{p}

(25)

where

τ_{p} = \dot{M} (q) (q) + τ_{a} = τ + φ (q, \dot{q}), φ (q, \dot{q}) = C^{T} (q, \dot{q}) \dot{q} - G (q) - τ_{f}

. The system to observe is now revised and has different state variables. Accordingly, a modified second-order FTO could be defined as follows.

{\dot{z}}_{m 1} = z_{m 2} + τ_{p} + K_{1} {⌊e_{m}⌉}^{α_{1}}

(26)

{\dot{z}}_{m 2} = K_{2} {⌊e_{m}⌉}^{α_{2}}

(27)

where

z_{m 1} = \hat{p}, z_{m 2} = {\hat{τ}}_{d}

and

e_{m} = p - \hat{p}

. The block diagram of the proposed FTO to estimate robotic disturbance is depicted in Figure 1.

To this end, three different types of FTO for robot disturbance estimation are introduced with a progressive optimization. The obtained FTO given in Equations (26) and (27) is structurally similar to the GMO defined in Equations (5) and (6) as both observer shares the same system states and input. Particularly, if we set

α = 1

, then the designed FTO restores to an ESO formulation defined in Reference [10]. In other words, the ESO expression given in Reference [10] is a special case of the proposed FTO. As declared in Reference [10], ESO outperforms the popular GMO in disturbance observation in robot manipulator settings. It is reasonable to believe that the performance of FTO proposed in our paper should exceed that of both ESO and GMO.

3.2. Stability and Convergence of FTO

As the proposed observer is rooted in a general FTO design scheme, the stability and convergence of the presented DOB are evidently guaranteed. For completeness and readability, the error dynamics of FTO is inspected with a convergence analysis. The observation errors are given as

{\dot{e}}_{p} = e_{d} - K_{1} {⌊e_{p}⌉}^{α_{1}}

(28)

{\dot{e}}_{d} = - K_{2} {⌊e_{p}⌉}^{α_{2}}

(29)

where

e_{p} = p - \hat{p}, e_{d} = τ_{d} - {\hat{τ}}_{d}, e = [e_{p} e_{d}]

We will first prove the stability of the proposed observer. Consider the following Lyapunov function candidate:

\begin{matrix} V & = \sum_{i = 1}^{n} k_{2 i} \int_{0}^{e_{p i}} {⌊τ⌉}^{α_{2}} d τ + \frac{e_{d}^{T} e_{d}}{2} \\ = \sum_{i = 1}^{n} \frac{k_{2 i}}{α_{2} + 1} e_{p i}^{α_{2} + 1} + \frac{e_{d}^{T} e_{d}}{2} \end{matrix}

(30)

where

k_{2 i}

is the ith diagonal element of

K_{2}

. Then its derivative is given as

\begin{matrix} \dot{V} & = \frac{\partial V}{\partial e^{T}} \dot{e} \\ = \sum_{i = 1}^{n} k_{2 i} {⌊e_{p i}⌉}^{α_{2}} (e_{d i} - K_{1} {⌊e_{p i}⌉}^{α_{1}}) - e_{d}^{T} K_{2} {⌊e_{p}⌉}^{α_{2}} \\ = e_{d}^{T} K_{2} {⌊e_{p}⌉}^{α_{2}} - \sum_{i = 1}^{n} k_{1 i} k_{2 i} {|e_{p i}|}^{α_{1} + α_{2}} - e_{d}^{T} K_{2} {⌊e_{p}⌉}^{α_{2}} \\ = - \sum_{i = 1}^{n} k_{1 i} k_{2 i} {|e_{p i}|}^{α_{1} + α_{2}} \leq 0 . \end{matrix}

(31)

where

k_{1 i}

is the ith diagonal element of

K_{1}

. The only invariant set is the origin

e_{p} = e_{d} = 0

. According to LaShalle theorem, the asymptotic convergence of e to zero is guaranteed.

Next, we will prove the finite-time convergence of the observer. According to Definition 2, Equations (28) and (29) are homogeneous of degree

α - 1

with respect to the weights

{r_{1}, r_{2}} = {1, α}

. Considering

α < 1

, thus, Equations (28) and (29) have a negative homogeneity. From Theorem 1, it follows that the error system is globally FTS. In other words, the estimation errors will vanish within a finite time. To this end, it could be concluded that the proposed FTO is stable and with finite-time convergence performance.

4. Simulation Results

In order to demonstrate the effectiveness and advantage of the proposed FTO algorithm in estimating robotic disturbance, a simulation was conducted on a simple 2-DOF planar manipulator vertical to the ground as depicted in Figure 2.

The studied manipulator is assumed to have a simple mass distribution, i.e., the mass of each link is concentrated as a point at the rod end. For simplicity, the friction effect will not be considered. The corresponding matrices in Equation (1) for this 2-DOF robot are expressed as

M (q) = [\begin{matrix} θ_{1} + 2 θ_{2} cos (q_{2}) & θ_{3} + θ_{2} cos (q_{2}) \\ θ_{3} + θ_{2} cos (q_{2}) & θ_{3} \end{matrix}]

(32)

C (q, \dot{q}) = θ_{2} sin (q_{2}) [\begin{matrix} - 2 \dot{q_{2}} & - \dot{q_{2}} \\ {\dot{q}}_{1} & 0 \end{matrix}]

(33)

G (q) = [\begin{matrix} θ_{4} cos (q_{1}) + θ_{5} cos (q_{1} + q_{2}) \\ θ_{5} cos (q_{1} + q_{2}) \end{matrix}]

(34)

where

\{\begin{matrix} θ_{1} = l_{2}^{2} m_{2} + l_{1}^{2} (m_{1} + m_{2}) \\ θ_{2} = l_{1} l_{2} m_{2} \\ θ_{3} = l_{2}^{2} m_{2} \\ θ_{4} = (m_{1} + m_{2}) l_{1} g_{0} \\ θ_{5} = m_{2} l_{2} g_{0} \end{matrix}

(35)

with

l_{i}, m_{i} (i = 1, 2)

as the length and mass for the ith link, respectively, and

g_{0}

the gravitational acceleration. The manipulator performs point-to-point motion with two predefined configurations

q_{s} = {[0, π / 4]}^{T}

and

q_{e} = {[π / 3, π / 2]}^{T}

. For a smooth tracking trajectory generation, fifth polynomial interpolation is used to ensure a continuous reference acceleration. Without the loss of generality, the implemented controller for this example is merely a proportional–integral–derivative (PID) controller. Moreover, additional noises with a normal distribution are artificially imposed on the measurement signals. Specifically,

n_{q} \sim N (0, 7 . 56^{- 10})

is the noise for joint position measurement with

n_{τ} \sim N (0, 0.01)

for torque. The simulation was based on MATLAB using a PC with a 3.5 GHz processor and 4 G memory.

As human–robot interaction is increasingly demanded in both domestic and industrial application, the necessity to quickly and accurately acquire the estimation of an interaction force is strengthened. Delayed or mismatched estimations may hinder the robot to sense its environment and human force intention. In this example, two prototypes of impact forces are employed with one step signal and the other ramp signal. The step signal may represent the fierce collision force, and the slop signals can be due to the normal interaction force. The step external torques are imposed on the time interval

[1, 1.8]

seconds, and the slop impact forces are exerted during the time interval

[0.8, 1.6]

seconds.

The proposed FTO method is then employed to estimate the external impact force and compared with other existing observers including NDOB [5], GMO [9], and ESO [10]. The gain matrix is selected to be diag

{4, 4}

for NDOB and diag

{50, 50}

for GMO. For ESO, its two gain matrices are chosen to be diag

{200, 200}

and diag{10,000, 10,000}. When it comes to FTO coefficients selection, it contains more coefficients to be tuned. For simplicity, FTO shares the same gain matrices with ESO, namely

K_{1} = diag {200, 200}

and

K_{2} = diag

{10,000, 10,000}. The power coefficient is chosen to be

α =

0.9. As noted in a previous section, when

α = 1

, FTO formulation degrades to ESO. However, this slight change in system powers significantly improves the performance of the estimation accuracy and convergent rate. Notice that the related parameters of these observers are tuned such that a similar noise level in residual signals is achieved.

The time profiles of the observation results are shown in Figure 3, and the corresponding estimation error is also plotted in Figure 4. As it can be seen from Figure 3, FTO provides the quickest response compared to other DOBs thanks to the adoption of finite-time design, while ESO has better convergent rate compared to GMO and NDOB. Moreover, FTO also shows smaller estimation errors, especially for the dynamic force estimation. As shown in the bottom view of Figure 4, the FTO estimation error is comparatively smaller than that of both GMO and ESO in simulation. This fact demonstrates the fast convergence of the proposed FTO in disturbance observing. NDOB seems to share the same performance in slop disturbance tracking with FTO. However, NDOB is prone to sharp changes in acceleration as joint 2 undergoes violent acceleration processes near 1 and 1.8 seconds induced by the step disturbance on joint 1.

Table 1 details the specific estimation performance of these DOBs with different evaluation indices. The estimation errors for joint 1 and 2 are listed in the second and third column, respectively. It is clear that the proposed FTO outperforms other methods in minimizing the estimation error as FTO can track the real value with fast response. It should be pointed out that the model errors will be included in the lumped disturbances estimation in all of these DOBs. In order to realize an accurate estimation of the external impact, the model error should be kept under a low level. The last column in Table 1 illustrates the execution time per iteration of each observer. As the matrix inversion is required in NDOB, it takes the most computational time. Compared with GMO and ESO, FTO method costs slightly more computational time as a result of the power operation.

5. Conclusions

In this paper, a finite-time observer is designed to estimate the unknown disturbances imposed on a robotic manipulator. By reducing the observer order and reselecting the state variables, three types of FTO were iteratively designed and gradually optimized in order to ease the computation burden.

The adoption of the proposed FTO provides the disturbance estimation with a fast and accurate tracking capability, along with the avoidance of the joint acceleration calculation and matrix inversion. Compared with the existing DOBs of which the convergence rate is at best exponential, FTO is able to force the estimation error to converge to zero within a finite time. Although FTO has a more complex formulation and thus a slightly increased computational time cost, the simulation results demonstrate that FTO has the quickest response to disturbance and the lowest estimation error. Future work is to apply the proposed observer to the real manipulator with applications in collision detection and disturbance observer-based control. Moreover, theoretical work to adaptively handle robot model uncertainties will also be considered.

Author Contributions

Conceptualization, methodology, and writing—original draft preparation, P.C.; investigation and writing—review and editing, Y.G.; supervision and funding acquisition, X.D.

Funding

This work was supported in part by the National Natural Science Foundation of China under Grant Nos. 61873308, 61503076, and 61175113 and by the Natural Science Foundation of Jiangsu Province under Grant No. BK20150624.

Conflicts of Interest

The authors declare no conflict of interest.

References

Pi, Y.; Wang, X. Observer-based cascade control of a 6-DOF parallel hydraulic manipulator in joint space coordinate. Mechatronics 2010, 20, 648–655. [Google Scholar] [CrossRef]
Sahabi, M.E.; Li, G.; Wang, X.; Li, S. Disturbance Compensation Based Finite-Time Tracking Control of Rigid Manipulator. Math. Probl. Eng. 2016, 2016, 2034795. [Google Scholar] [CrossRef]
Chen, W.H.; Yang, J.; Guo, L.; Li, S. Disturbance-observer-based control and related methods-An overview. IEEE Trans. Ind. Electron. 2016, 63, 1083–1095. [Google Scholar] [CrossRef]
Bona, B.; Indri, M. Friction compensation in robotics: An overview. In Proceedings of the 44th IEEE Conference on Decision and Control, Seville, Spain, 12–15 December 2005; pp. 4360–4367. [Google Scholar]
Chen, W.H.; Ballance, D.J.; Gawthrop, P.J.; O’Reilly, J. A nonlinear disturbance observer for robotic manipulators. IEEE Trans. Ind. Electron. 2000, 47, 932–938. [Google Scholar] [CrossRef] [Green Version]
Magrini, E.; Flacco, F.; De Luca, A. Control of generalized contact motion and force in physical human-robot interaction. In Proceedings of the 2015 IEEE International Conference on Robotics and Automation (ICRA), Seattle, WA, USA, 26–30 May 2015; pp. 2298–2304. [Google Scholar]
Magrini, E.; De Luca, A. Hybrid force/velocity control for physical human-robot collaboration tasks. In Proceedings of the 2016 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS), Daejeon, Korea, 9–14 October 2016; pp. 857–863. [Google Scholar]
Gaz, C.; Magrini, E.; De Luca, A. A model-based residual approach for human-robot collaboration during manual polishing operations. Mechatronics 2018, 55, 234–247. [Google Scholar] [CrossRef]
De Luca, A.; Mattone, R. Actuator failure detection and isolation using generalized momenta. In Proceedings of the IEEE International Conference on Robotics and Automation, Taipei, Taiwan, 14–19 September 2003; Volume 1, pp. 634–639. [Google Scholar]
Ren, T.; Dong, Y.; Wu, D.; Chen, K. Collision detection and identification for robot manipulators based on extended state observer. Control Eng. Pract. 2018, 79, 144–153. [Google Scholar] [CrossRef]
Haddadin, S.; De Luca, A.; Albu-Schäffer, A. Robot collisions: A survey on detection, isolation, and identification. IEEE Trans. Robot. 2017, 33, 1292–1312. [Google Scholar] [CrossRef]
Cho, C.N.; Kim, J.H.; Kim, Y.L.; Song, J.B.; Kyung, J.H. Collision detection algorithm to distinguish between intended contact and unexpected collision. Adv. Robot. 2012, 26, 1825–1840. [Google Scholar] [CrossRef]
Mohammadi, A.; Tavakoli, M.; Marquez, H.J.; Hashemzadeh, F. Nonlinear disturbance observer design for robotic manipulators. Control Eng. Pract. 2013, 21, 253–267. [Google Scholar] [CrossRef] [Green Version]
Nikoobin, A.; Haghighi, R. Lyapunov-based nonlinear disturbance observer for serial n-link robot manipulators. J. Intell. Robot. Syst. 2009, 55, 135–153. [Google Scholar] [CrossRef]
Menard, T.; Moulay, E.; Perruquetti, W. A global high-gain finite-time observer. IEEE Trans. Autom. Control 2010, 55, 1500–1506. [Google Scholar] [CrossRef]
Lopez-Ramirez, F.; Polyakov, A.; Efimov, D.; Perruquetti, W. Finite-time and fixed-time observer design: Implicit Lyapunov function approach. Automatica 2018, 87, 52–60. [Google Scholar] [CrossRef] [Green Version]
Menard, T.; Moulay, E.; Perruquetti, W. Fixed-time observer with simple gains for uncertain systems. Automatica 2017, 81, 438–446. [Google Scholar] [CrossRef] [Green Version]
Shen, Y.; Xia, X. Semi-global finite-time observers for nonlinear systems. Automatica 2008, 44, 3152–3156. [Google Scholar] [CrossRef] [Green Version]
Shtessel, Y.B.; Shkolnikov, I.A.; Levant, A. Smooth second-order sliding modes: Missile guidance application. Automatica 2007, 43, 1470–1476. [Google Scholar] [CrossRef]
Perruquetti, W.; Floquet, T.; Moulay, E. Finite-time observers: Application to secure communication. IEEE Trans. Autom. Control 2008, 53, 356–360. [Google Scholar] [CrossRef]
Siciliano, B.; Sciavicco, L.; Villani, L.; Oriolo, G. Robotics: Modelling, Planning and Control; Springer Science & Business Media: Berlin/Heidelberg, Germany, 2010. [Google Scholar]
Bhat, S.P.; Bernstein, D.S. Finite-time stability of continuous autonomous systems. SIAM J. Control Optim. 2000, 38, 751–766. [Google Scholar] [CrossRef]
Bhat, S.P.; Bernstein, D.S. Geometric homogeneity with applications to finite-time stability. Math. Control. Signals Syst. 2005, 17, 101–127. [Google Scholar] [CrossRef]
Bacciotti, A.; Rosier, L. Liapunov Functions and Stability in Control Theory; Springer Science & Business Media: Berlin/Heidelberg, Germany, 2006. [Google Scholar]

Figure 1. A block diagram of the proposed robotic disturbance finite-time observer (FTO).

Figure 2. The studied two-link manipulator for simulation. The initial and end configurations for robot movement are in dashed lines.

Figure 3. Estimation of external torque.(a) External disturbance observation results of step response signal for joint 1; (b) external disturbance observation results of slop signal for joint 2.

Figure 4. The disturbance estimation errors of external torque. (a) External disturbance estimation errors for joint 1; (b) external disturbance estimation errors for joint 2.

Table 1. A comparison of nonlinear disturbance observer (NDOB), generalized momentum observer (GMO), external state observer (ESO), and FTO methods.

Method	RMSE1 (Nm)	RMSE2 (Nm)	$T_{e}$ (μs)
NDOB	0.5361	0.1204	13.50
GMO	0.5086	0.1634	5.79
ESO	0.4802	0.1495	7.72
FTO	0.4072	0.0805	9.64

© 2019 by the authors. Licensee MDPI, Basel, Switzerland. This article is an open access article distributed under the terms and conditions of the Creative Commons Attribution (CC BY) license (http://creativecommons.org/licenses/by/4.0/).

Share and Cite

MDPI and ACS Style

Cao, P.; Gan, Y.; Dai, X. Finite-Time Disturbance Observer for Robotic Manipulators. Sensors 2019, 19, 1943. https://doi.org/10.3390/s19081943

AMA Style

Cao P, Gan Y, Dai X. Finite-Time Disturbance Observer for Robotic Manipulators. Sensors. 2019; 19(8):1943. https://doi.org/10.3390/s19081943

Chicago/Turabian Style

Cao, Pengfei, Yahui Gan, and Xianzhong Dai. 2019. "Finite-Time Disturbance Observer for Robotic Manipulators" Sensors 19, no. 8: 1943. https://doi.org/10.3390/s19081943

APA Style

Cao, P., Gan, Y., & Dai, X. (2019). Finite-Time Disturbance Observer for Robotic Manipulators. Sensors, 19(8), 1943. https://doi.org/10.3390/s19081943

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

Article Menu

Finite-Time Disturbance Observer for Robotic Manipulators

Abstract

1. Introduction

2. Preliminaries

2.1. Robot Dynamic Model

2.2. Disturbance Observer Using Generalized Momentum

2.3. Finite-Time Stability

3. Finite-Time Observer of Robotic Disturbance

3.1. Finite-Time Observer Design

3.2. Stability and Convergence of FTO

4. Simulation Results

5. Conclusions

Author Contributions

Funding

Conflicts of Interest

References

Share and Cite

Article Metrics

Article Access Statistics

Further Information

Guidelines

MDPI Initiatives

Follow MDPI