Uncalibrated Visual Servoing for Underwater Vehicle Manipulator Systems with an Eye in Hand Configuration Camera

This paper presents an uncalibrated visual servoing scheme for underwater vehicle manipulator systems (UVMSs) with an eye-in-hand camera under uncertainties. These uncertainties contain vision sensor parameters, UVMS kinematics and feature position information. At first, a linear separation approach is addressed to collect these uncertainties into vectors, and this approach can also be utilized in other free-floating based manipulator systems. Secondly, a novel nonlinear adaptive controller is proposed to achieve image error convergence by estimating these vectors, the gradient projection method is utilized to optimize the restoring moments. Thirdly, a high order disturbance observer is addressed to deal with time-varying disturbances, and the convergence of the image errors is proved under the Lyapunov theory. Finally, in order to illustrate the effectiveness of the proposed method, numerical simulations based on a 9 degrees of freedom (DOFs) UVMS with an eye-in-hand camera are conducted. In simulations, the UVMS is expected to track a circle trajectory on the image plane, meanwhile, time-varying disturbances are exerted on the system. The proposed scheme can achieve accurate and smooth tracking results during simulations.


Introduction
Nowadays, underwater vehicles play a pivotal role in the applications of oceanic explorations, submarine salvages and scientific expeditions [1,2]. Highly integrated underwater vehicles, e.g., Ocean One [3], SAUVIM I Intervention Autonomous Underwater Vehicle (I-AUV) [4], and Girona 500 I-AUV [5] are developed for the field intervention operations based on its camera-robot systems. Compared with remote operations of underwater vehicles, autonomous underwater operations by visual servoing not only reduce the dependence on the mother ship, but also decrease disturbances from the umbilical cables, which makes underwater vehicles complete manipulations autonomously with less operations from professional pilots [6,7].
Visual servoing based on the vision sensor (i.e., underwater camera) have gained significant attentions in underwater autonomous interventions. The purpose of visual servoing on underwater vehicles is to control the end-effector to complete the specific intervention tasks through visual information [8]. The visual servoing can be generously divided into two categories [9], the position-based visual servoing (PBVS) and the image-based visual servoing (IBVS). The PBVS scheme demands visual sensors to obtain three-dimensional (3 D) position of the target and then control the end-effector approach to the desired position, which means accurate calibration results of the camera-robot system are often indispensable [10]. Classical IBVS scheme guides the end-effector directly through the information of the target, its core skill is to calculate the inverse or the transpose of the image Jacobian matrix (interaction matrix) [11]. However, these mentioned schemes require intrinsic and extrinsic parameters of the camera. It is well known that camera calibrations are very costly and tedious, especially in underwater environment [12]. Therefore, in order to achieve satisfied visual servoing results in underwater interventions, it is not suitable to directly utilize either the PBVS scheme or the classical IBVS scheme.
To avoid the influences of inaccurate camera calibrations, without perfectly knowing actual parameters of the vision sensor, uncalibrated visual servoing based on the IBVS scheme has attracted great attentions in last twenty years. A large portion of works turned image Jacobian matrix calculation to a parameter identification problem by establishing proper cost functions [13]. Then, without knowing the exact knowledge of camera parameters in advance, the image Jacobian matrix in the IBVS scheme can be acquired through estimating its elements by numerical estimations (i.e., Broyden-based method [14], recursive least square method [15], Kalman method [16], SVM based method [17] etc.). However, such kinematic-based uncalibrated visual servoing schemes usually ignore the nonlinear forces in robot dynamics and assumed the controller of the system is ideal, further, they do not take control schemes into stability analysis.
Such drawbacks are largely remedied under dynamic based visual servoing schemes by using a depth-independent interaction matrix [18], this pioneering work proposed a method to deal with the case of time-varying and uncertain depth in visual servoing process. Wang et al. [19] investigated uncalibrated visual servoing problem with uncertain models, they presented the passivity properties in the overall kinematic system. In [20], Wang H. et al. proposed an adaptive controller with a velocity observer to avoid velocity measurement noises. For object grasping, a manipulator with an eye-in-hand camera is common, because the feature points should be extracted on the object, however, these articles only concern the situation about the eye-to-hand camera configuration. Liang et al. [21] proposed a unified method for both eye-in-hand and eye-to-hand camera configurations, this work also gave a separation algorithm on kinematic properties of the manipulator system, however, the uncertain kinematics of the manipulator was not considered. Wang et al. [22] proposed a dynamic uncalibrated visual servoing approach for a free-floating based manipulator, however, it assumed the system has no external disturbances, and this assumption is often hard to satisfy in underwater environment.
Although some researches that involve uncalibrated visual servoing have been launched on industrial manipulators and nonholonomic mobile robots, visual servoing for the UVMS is a largely under explored domain. Li et al. [23] presented a learning-based IBVS scheme for an absorptive underwater vehicle to realize autonomously sea-cucumbers capture. Gao et al. [24] proposed a hierarchical IBVS strategy for the underwater vehicle dynamic positioning problem. Sivčev et al. [25] proposed an engineering oriented PBVS scheme for work class hydraulic ROVs. The drawback with these strategies is, they require the accurate camera parameters in advance. In the underwater manipulation domain, there are some examples of researches on uncalibrated visual servoing, for example, Xu et al. [26] investigated a dynamic based uncalibrated visual servoing scheme for the underwater soft robot. However, to the best of our knowledge, there is limited work on dynamic based uncalibrated visual servoing concerned with the UVMS. Unlike industrial manipulators or mobile robots, the visual servoing process of the UVMS suffers from two aspects: on one hand, since the UVMS is a free-floating multibody mechanism, the inner coupling effects between the manipulator and the vehicle are strong and cannot be neglected [27]. On the other hand, the underwater environment is complex, which makes the system tend to be affected by currents, accurate calibration results of the camera-UVMS system are hard to achieve in underwater environment. These notable differences from other types of robots make it improper to directly employ previous visual servoing studies on UVMSs.
To solve these problems, we propose a novel uncalibrated visual servoing method for UVMSs with an eye-in-hand configuration camera. The main contributions of this work can be summarized as follows: firstly, we propose a novel linear separation method to collect some uncertainties into constant vectors compared with the one in [21,28]. This method can be applied for other free-floating based articulated manipulators. Secondly, to optimize the restoring moments of the UVMS, a new reference velocity term is proposed through exploiting the kinematic redundancy of the UVMS, moreover, without perfectly knowing the camera parameters, kinematics of the UVMS and the target position, a novel composite controller with new adaptive laws is proposed to solve the visual servoing problem. Thirdly, considering time-varying disturbances of the UVMSs, a high order disturbance observer is presented to estimate and compensate such disturbances, and stability analysis is given under the Lyapunov theory.
The rest of this paper is organized, as follows: in Section 2, we introduce the kinematic relationship of the system in UVMS, the dynamic model of the UVMS is also established. Thereafter, a novel adaptive controller with a disturbance observer is proposed for uncalibrated visual servoing in Section 3, stability proof analysis is also given is this section. In Section 4, numerical simulations on a 9-DOFs UVMS are carried out to demonstrate the effectiveness of the proposed scheme. The flow chart of this work is given in Figure 1.
Sensors 2020, 20, x FOR PEER REVIEW 3 of 24 based articulated manipulators. Secondly, to optimize the restoring moments of the UVMS, a new reference velocity term is proposed through exploiting the kinematic redundancy of the UVMS, moreover, without perfectly knowing the camera parameters, kinematics of the UVMS and the target position, a novel composite controller with new adaptive laws is proposed to solve the visual servoing problem. Thirdly, considering time-varying disturbances of the UVMSs, a high order disturbance observer is presented to estimate and compensate such disturbances, and stability analysis is given under the Lyapunov theory. The rest of this paper is organized, as follows: in Section 2, we introduce the kinematic relationship of the system in UVMS, the dynamic model of the UVMS is also established. Thereafter, a novel adaptive controller with a disturbance observer is proposed for uncalibrated visual servoing in Section 3, stability proof analysis is also given is this section. In Section 4, numerical simulations on a 9-DOFs UVMS are carried out to demonstrate the effectiveness of the proposed scheme. The flow chart of this work is given in Figure 1. T are the rotation matrix and the homogeneous transformation matrix from the frame a to the frame b respectively. Moreover, frames I,V,ee,fe,cam represent the inertial frame, the vehicle fixed frame, the end-effector frame, the target frame, and the camera frame respectively, frame represents the frame of the i -th joint.

Kinematics and Dynamics
In underwater visual servoing, camera parameters, UVMS kinematic modelling, and feature position are always difficult to accurately achieve. A linear separation method to collect camera uncertainties into vectors is given in [18,21], however this method can only be used for the fixed manipulator and under the assumption that kinematics of the manipulator is perfectly known. In this section, we propose a novel linear separation method to collect these uncertainties into constant vectors without this assumption for free-floating based articulated manipulators.

Kinematics
In this paper, we consider a 6 n + DOFs UVMS with a standard fixed pinhole camera, the camera is fixed on the end-effector. A target is fixed w.r.t. to the inertial frame, and the feature point is extracted from the target. The image coordinates [ , ] T x u v = of the feature point can be written as [18]: Notation: Throughout this paper, we define ε c a,b as the vector from the frame a to the frame b expressed in the frame c. R b a and T b a are the rotation matrix and the homogeneous transformation matrix from the frame a to the frame b respectively. Moreover, frames I, V, ee, fe, cam represent the inertial frame, the vehicle fixed frame, the end-effector frame, the target frame, and the camera frame respectively, frame i ∈ {0, 1, 2 . . . n} represents the frame of the i-th joint.

Kinematics and Dynamics
In underwater visual servoing, camera parameters, UVMS kinematic modelling, and feature position are always difficult to accurately achieve. A linear separation method to collect camera uncertainties into vectors is given in [18,21], however this method can only be used for the fixed manipulator and under the assumption that kinematics of the manipulator is perfectly known. In this section, we propose a novel linear separation method to collect these uncertainties into constant vectors without this assumption for free-floating based articulated manipulators.

Kinematics
In this paper, we consider a 6 + n DOFs UVMS with a standard fixed pinhole camera, the camera is fixed on the end-effector. A target is fixed w.r.t. to the inertial frame, and the feature point is extracted from the target. The image coordinates x = [u, v] T of the feature point can be written as [18]: where z(ζ) is the depth of the feature in the camera frame. M =ΦT cam ee , M ∈ R 3×4 is the perspective projection matrix, which contains intrinsic and extrinsic parameters of the camera. Φ ∈ R 3×4 depends on intrinsic parameters of the camera and T cam ee depends on extrinsic parameters of the camera. Since the camera is fixed on the end-effector, T cam ee is time-invariant. Therefore, the perspective projection matrix M can be concluded to be a constant. Define M = [m 1 , m 2 , m 3 ] T , m i ∈ R 1×4 is the i-th column of M. Depth z(ζ) can be obtained as: consider a UVMS with a n-DOFs manipulator, define as the generalized velocity term of the UVMS, where v v ∈ R 3×1 and ω v ∈ R 3×1 denote the linear and angular velocity of the vehicle in the vehicle fixed frame. Let T denote the generalized velocity of the vehicle. q ∈ R n×1 is the vector represents joints position of the manipulator. By differentiating (1), the relationship of . ζ and .
x can be expressed as: is the depth-independent Jacobian matrix, R ee I and t are the rotation and translation of T ee I . And it can be further divided into two parts [20]: On one hand, J zin (ζ) is so called depth-rate-independent Jacobian matrix, which maps the generalized velocity term . ζ to a plane parallel to the image plane. J zin (ζ) can be represented as: m i is the first three elements of m i . On the other hand, J zd (ζ) is so called depth-rate-dependent Jacobian matrix, which describes the relationship between . ζ and . z(ζ). J zd (ζ) and . z(ζ) can be represented as: .

Property 1.
For a vector η ∈ R (6+n)×1 , J zin (ζ)η can be represented as the product of a regressor matrix Y zin (ζ, η) and a constant vector a zin . J zin (ζ)η = Y zin (ζ, η)a zin (8) Proof. First, we will prove that , and ij r is the (i,j) elem On one side, it can be found that: , and ij r is the (i,j) element of ee I R .
On one side, it can be found that: where , i j η is the matrix composed from the element i η to j η , i.e., , , pos man J is the manipulator Jacobian matrix mapping q  to I Inspired by [29], 0 0,ee ε can be further divided as: , and r ij is the (i,j) element of R ee I .
On one side, it can be found that: where η i,j is the matrix composed from the element η i to η j , i.e., ε I 0,ee . S(·) is a function translating a vector a = [ax, ay, az] T to a skew symmetric matrix as: Inspired by [29], ε 0 0,ee can be further divided as: where pp = diag cos(q 1 ), sin(q 1 ), 1, . . . cos(q n ), sin(q n ), 1 and a ee = [a 1 , a 1 , d 1 . . . a n , a n , d n ] T . q i is the position of the i-th joint, a i , d i are the link length and link offset associated with the i-th link. Besides, where . . 0 n 3×3 and z i is the unit vector of frame i expressed in frame 0 of the manipulator.
On the other side, Therefore, by invoking (10)-(13), one can obtain: First, we will prove that ee I ee ee On one side, it can be found that: and results can be further simplified as: Sensors 2020, 20, x FOR PEER REVIEW

Property 1. For a vector
First, we will prove that ee I ee ee I I, ,I ee, I , and ij r is the ( On one side, it can be found that: To achieve the regressor matrix Y zin (ζ, η), Y α need to be transformed in to Y αs ∈ R 1×3n as: Finally, from (5), (14), and (15), it can be obtained that: where a αi is the i-th element of the vector a α .
z(ζ)φ can be represented as the product of a regressor matrix and a constant vector.
Proof. From (7) and the proof on the Property 1, it can be found that: where φ i is the i-th element of the vector φ.
Property 3. For a vector φ ∈ R 2×1 , z(ζ)φ can be represented as the product of a regressor matrix and a constant vector.
Proof. According to (2), z(ζ)φ can be extended as: where m 3i and ε I I, f ei are the i-th elements of the vector m 3 and the vector ε I I, f e , respectively. From (13), one obtains: where R= [r 11 r 21 r 31 r 12 r 22 r 32 r 13 r 23 r 33 , y eebj is the j-th row of the matrix Y eeb (q).
z(ζ)φ, z(ζ)φ can be linearly separated as the product of the regressor matrices and the constant parameter vectors.
As described in previous proofs, camera perspective projection matrix M, the manipulator kinematics parameters a ee and the manipulator relative position vector ε 0 V,0 are all collected in a zin ,a z ,a zd . The position of the target ε I I, f e is collected in a z . This work devotes to realize visual servoing under uncalibrated conditions. From the proofs of above three properties, uncertainties of the systems (i.e., uncertainties in intrinsic and extrinsic parameters of the camera, the kinematics of the UVMS, the position of the target w.r.t. the inertial frame) can be collected in these three parameter vectors in (17), (20), and (24). Because the target is fixed with the inertial frame, these vectors maintain constant and will be estimated by gradient update laws in the following section By defining ∆a = a − a d , a compensated depth-Jacobian matrix J Ω can be obtained by combining J zin (ζ) with J zd (ζ) [19,21].
where x d is the bounded desired position of the feature point on the image plane. Moreover, .
x d and ..
x d are the bounded desired velocity and desired acceleration of the feature point, respectively.
Substituting (3) and (4) into (25), (3) can be rewritten as: J Ω is used to describe the relationship from the generalized velocity term z∆x.

Dynamics
Coordinate frames of a typical UVMS with an eye-in-hand configuration camera can be represented in Figure 2. The relationship between ee η and ζ  can be expressed as: where uvms J is the Jacobian matrix of the UVMS. Besides, the dynamic equation in the vehicle-joint space of UVMS can be written as [30]: denotes the mass matrix including the added mass term, represents the centrifugal and Coriolis effect matrix, is the contribution due to the damping effects, represents the restoring matrix.
Specifically speaking, one can extend these dynamics matrices as: ζ can be expressed as: where J uvms is the Jacobian matrix of the UVMS. Besides, the dynamic equation in the vehicle-joint space of UVMS can be written as [30]: . ζ + G(ζ) = τ ctrl + τ ext (28) M(ζ) ∈ R (6+n)×(6+n) denotes the mass matrix including the added mass term, C(ζ, . ζ) ∈ R (6+n)×(6+n) represents the centrifugal and Coriolis effect matrix, D(ζ, . ζ) ∈ R (6+n)×(6+n) is the contribution due to the damping effects, G(ζ) ∈ R (6+n)×1 represents the restoring matrix. τ ctrl ∈ R (6+n)×1 is the controller output, τ ext ∈ R (6+n)×1 represents the bounded unknown external disturbances on the UVMS, mainly caused by underwater currents, variation in load. Specifically speaking, one can extend these dynamics matrices as: Subscript v and m represent vehicle and manipulator, respectively. M v ∈ R 6×6 is the mass matrix of the sole vehicle, M m ∈ R nxn is the mass matrix of the manipulator. M vm ∈ R 6xn is the coupling term between the vehicle and the manipulator. Similar properties can also be found in C(ζ, where υ 3 is a positive scalar. The 2-norm means: where λ max (·) is the maximum eigenvalue of a matrix. M(ζ) is also upper bounded. Intrinsic dynamic parameters of a UVMS, e.g., the mass and the inertia tensor of each DOF, the buoyance of each DOF etc., are always difficult to accurately obtain. Hence, it is also difficult to acquire the accurate dynamic modeling in practice. Unmodeled dynamics, in addition to external disturbances are modeling error terms, and they are defined as: ζ + G) denotes the time varying disturbance term.
Restoring moments are caused by gravity and buoyancy forces. For the UVMS, the vehicle is easily affected by the restoring moments because of the movement of the manipulator. Therefore, it is important to decrease the restoring moments by choosing proper . ζ. We assume that Ĝ (ζ) , ζ) andĜ(ζ) are obtained through choosing another set of intrinsic dynamic parameters (which is different from the actual intrinsic parameters, and it is utilized in forward dynamic routines in simulations), rather than updated by adaptive laws. In other word, we do not estimate or update nominal matrices, we directly calculate them by utilizing system states ζ,  ζ) andĜ(ζ) can be chosen to satisfy above properties.

Controller Design
The control objective is to realize the convergence of image errors. In the process of designing the controller, at first, we establish a new reference velocity term to optimize the restoring moment through using the gradient projection method (GPM), moreover, novel adaptive laws are established to estimate the uncertainties in uncalibrated systems by utilizing the linear separation method which we described in the last section. Secondly, we employ a high-order disturbance observer to compensate the time-varying lumped disturbance term in (29). Thirdly, we propose a novel composite controller to guarantee the convergence of image errors, stability analysis based on the Lyapunov theory is also presented.

Adaptive Laws
To realize visual servoing, we should firstly design a reference velocity term in vehicle-joint space. If the kinematic parameters are available, then a zin ,a z ,a zd can be obtained. A reference velocity can be designed as: where α v is a positive gain. Then, if there exists an ideal controller to make ζ r , substituting (30) into (26), one can find: Consider a Lyapunov function as: take the time-derivative of V temp , yields: .
If J Ω is non-singular, .
V temp < 0 and ∆x → 0 as t → ∞ . To achieve tracking control, it is expected to acquire the accurate value of J Ω , z and . z, which equals to acquire the accurate value of a zin , a z and a zd . Unfortunately, it cannot be accurately obtained by considering the kinematic uncertainties of the system. Hence it is necessary to build adaptive laws to estimate them. The core is to estimate a zin , a z and a zd .
The compensated depth-Jacobian matrix in (25) can be estimated as: By employing the pseudo inverse and transpose ofĴ Ω in (32) and the estimation of depthẑ, a reference velocity term that similar with the ones in [19][20][21] can be represented as: whereĴ † Ω denotes the pseudo inverse ofĴ Ω ,ẑ is the estimated depth. The UVMS possesses relatively high DOFs compared with simple manipulators in [19][20][21], hence the redundancy of the UVMS should be taken into consideration when design the reference velocity. Because the UVMS is easily be affected by the restoring moment, the GPM is utilized to optimize the restoring moments through exploiting kinematic redundancy, a novel reference velocity can be represented as: where κ v is a positive gain. ∇P r is defined as ∇P r =Ĝ T (ζ)W G

∂Ĝ(ζ)
∂ζ , W G is a positive weight matrix. (I −Ĵ † ΩĴ Ω ) projects ∇P r into the null space ofĴ Ω , hence ∇P r is only effective in the null space.
Although some previous works utilize the GPM to optimize restoring moments for UVMSs [32][33][34], there are two main differences. One is the Jacobian matrix in [32][33][34] is used to describe the velocity relationship between the configuration space and the Cartesian space (i.e., the Jacobian matrix in (27)), rather than the Jacobian matrix described in (26). The other one is previous works [32][33][34] all depend on the accurate Jacobian matrix, rather than the estimated Jacobian matrix.
Then, a sliding vector can be defined as: estimation error terms can be defined as: ∆a zin =â zin − a zin , ∆a zd =â zd − a zd , ∆a z =â z − a z . Then, substituting (7), (18) into (25), one can find: (36) From (21) and (34), one has: Invoking (26), (34)-(36), the closed-loop kinematics system can be represented as: To calculate the reference velocity term in (34) and guarantee the stability of the system, it is necessary to estimate the unknown parameters of the systems (i.e., the constant vectors in (8), (18) and (21)). The adaptive update laws are designed as: ζ, λ zin , λ zd and λ z are the positive gain matrices, respectively. The novel reference velocity term (34), update laws (39)-(41) and stability analysis in the end of this section is one of the main contributions of this work.

Remark 2.
We assume that the update laws (39) and (40) will not lead to the singularity ofĴ Ω . In other words, J Ω is supposed to be non-singular. This is a common assumption in uncalibrated visual servoing works [19][20][21]. Besides, one may adopt the strategy presented in [35] to avoid the singular onĴ Ω .

High Order Disturbance Observer
When compared with nonlinear disturbance observer in [31,36], the performance under high order disturbance observer (HODO) is better, because the disturbance model refers to high order information of the disturbance. Besides, in order to prove the asymptotic stability of the system, the disturbance term is often supposed to be constant in previous works [31,36]. This assumption can be cancelled under the high order disturbance observer.
The purpose of employing a disturbance observer is to estimate and compensate the time-varying unknown lumped disturbance term τ d . The philosophy of designing the disturbance observer is to estimate the unmeasurable term τ d through measurable states. To establish the high order disturbance observer, we first rewrite the closed loop system (29) as a form as state space: ζ denote the system variable states. Besides, f =M −1 (τ ctrl −Ĉx 2 −Dx 2 −Ĝ) is available in the system, d =M −1 τ d is the unknown disturbance term to be estimated.
Suppose the disturbance term d has a bounded r th derivative, where δ 0 is the upper bound. The disturbance term d can be described through a linear system, given by [37] where ξ ∈ R (6+n)·r is an auxiliary variable. W ∈ R (6+n)·r×(6+n)·r , E ∈ R (6+n)·r×(6+n) , and L ∈ R (6+n)×(6+n)·r can be represented as the following forms: .
Then a new extended system can be derived through introducing an auxiliary variable γ = γ 1 γ 2 T as follows: where p(x 2 ) is a polynomial vector to be designed. Differentiating (45) with respect to time and substituting (44), the dynamics of γ can be represented as: .
Then, a high order disturbance observer can be derived as: Finally, the estimation of τ d follows:τ The estimation error is defined as e ξ = ξ −ξ. And it is governed by following dynamic system: The principle of designing l(γ 1 ) is to make the dominant pole of (49) lie in the left-half plane, then the system described in (49) is bounded-input bounded-output (BIBO) stable. If l(γ 1 ) is available, then p(γ 1 ) can be obtained from the relationship l(γ 1 ) = ∂p(γ 1 ) ∂γ 1 . Since the system is BIBO stable, the disturbance estimation error is bounded and satisfies: where δ 1 is the upper bound. SinceM is bounded, it can be deduced that: where σ is an unknown bounded constant.

Composite Controller
Now, by using the reference velocity . ζ r , the sliding vector s, the image error ∆x, the disturbance estimationτ d and the approximation of unknown boundσ, a composite controller with the HODO for uncalibrated visual servoing can be designed as: ζ +Ĝ is the feed-forward control term. In vehicle-joint space, the reference velocity term . ζ r is provided by (34), (39)-(41) through estimating J Ω and z.τ d is the estimation term from the disturbance observer in (48).σ is the estimated value of the constant bound σ, and it is updated as the following adaptive law: Substituting (50) into (29), The close-loop dynamics equation of the UVMS can be represented as: The whole architecture of the proposed scheme can be found in Figure 3.
The whole architecture of the proposed scheme can be found in Figure 3.

Proof.
Consider a Lyapunov candidate function as:  x → 0 as t → ∞ .
Proof. Consider a Lyapunov candidate function as: From Properties 1-3, unknown parameter vectors expressed in (8), (18) and (21) Let s T K −1 s = η s , since K s is a positive diagonal matrix, it can be found: sinceĴ Ω is non-singular andM is positive, one can find a nonnegative definite continuous function W(ζ) satisfies: .
x is bounded too, and ∆ .
x is uniformly continuous. Since the boundness of ∆x is achieved, it can be concluded ∆ .

Performance Analysis
In order to demonstrate the effectiveness of the proposed controller, numerical simulations have been performed on a UVMS platform. As shown in Figure 4, the UVMS carries a 3 DOFs manipulator and the whole system contains 9 DOFs.
Therefore, 0 W → as t → ∞ , which means 0 x Δ → , 0 s → as t → ∞ . By differentiating (3), it is clear that x  is bounded. Hence x Δ is bounded too, and x Δ  is uniformly continuous. Since the boundness of x Δ is achieved, it can be concluded 0 x Δ →  as t → ∞ by applying Barbalat's lemma. □

Performance Analysis
In order to demonstrate the effectiveness of the proposed controller, numerical simulations have been performed on a UVMS platform. As shown in Figure 4, the UVMS carries a 3 DOFs manipulator and the whole system contains 9 DOFs. The dynamic parameters of the UVMS are displayed Table 1. The Denavit-Hartenberg table of the manipulator is showed in Table 2.  The dynamic parameters of the UVMS are displayed Table 1. The Denavit-Hartenberg table of the manipulator is showed in Table 2.  In simulations, an eye-in-hand camera with parameters α u = 50 pixels, α v = 50 pixels, u 0 = 200 pixels, v 0 = 100 pixels is employed.
As we noted before, these uncertainties can be represented in three constant vectors ∆a z , ∆a zd and ∆a zin . Details can be found in the proofs of Properties 1-3.
In simulations, the controller gains are set as follows: 10,10,15,15,15,5,5, 5}, The desired trajectory is given as: The proposed scheme is utilized to track the desired circle trajectory in 70 s. Figure 5a,b show the actual trajectory and the desired trajectory of the feature point. Figure   As we noted before, these uncertainties can be represented in three constant vectors z a Δ , zd a Δ and zin a Δ . Details can be found in the proofs of Properties 1-3.
In simulations, the controller gains are set as follows: The desired trajectory is given as: The proposed scheme is utilized to track the desired circle trajectory in 70 s. Figure 5a,b show the actual trajectory and the desired trajectory of the feature point. Figure 5c describes the error trajectory during the tracking routine. Figure  As expectation, rapid convergences have been achieved in both position and velocity tracking performances.
From (18) and (21), one can obtain the connection between zd a and z  , z a and z . Since the dimensions of z a and zd a are all too large, therefore we choose to display the estimation of feature depth and its derivative to reflect the adaption process, the results can be found in Figures 6 and 7. As expectation, rapid convergences have been achieved in both position and velocity tracking performances.
From (18) and (21), one can obtain the connection between a zd and . z, a z and z. Since the dimensions of a z and a zd are all too large, therefore we choose to display the estimation of feature depth and its derivative to reflect the adaption process, the results can be found in Figures 6 and 7.     Compared with the reference velocity term (33), the proposed method with (34) provide restoring moments optimization by using the GPM. Figure 9 illustrates the two-norm of restoring From (8), we can define following vector: ζ)a zin And its estimation follows: According to the same reason, we choose to exhibit the actual and estimated values of α and β to illustrate the adaption process of a zin . As Figure 8 illustrates, estimation errors stay bounded.  Compared with the reference velocity term (33), the proposed method with (34) provide restoring moments optimization by using the GPM. Figure 9 illustrates the two-norm of restoring From stability analysis in previous section, ∆a z , ∆a zd and ∆a zin are bounded. Therefore, it is reasonable that estimation errors represented in Figures 6-8 are bounded.
Compared with the reference velocity term (33), the proposed method with (34) provide restoring moments optimization by using the GPM. Figure 9 illustrates the two-norm of restoring moments based on (33) and (34), respectively. RMS values of tracking errors based on (33) and (34) can be found in Table 3.  (33) and (34) can be found in Table 3.    Because the initial error is relatively large, we calculate RMS values from the time point t = 4 s to the end of the simulation. From Table 3, the controller under reference velocity from (33) provides slightly better results in both position tracking and velocity tracking than the one under (34). However, from Figure 9, the results obtained under the GPM from (34) substantially reduce the influence of the restoring moments compared with the one under (33). Considering all these factors, the scheme with the GPM provides better overall performances.
In addition, we compare he tracking performances between the proposed method and the one but without the HODO. As showed in Figure 10, the proposed scheme achieves accurate and smooth results compared with the other one.  Because the initial error is relatively large, we calculate RMS values from the time point t = 4 s to the end of the simulation. From Table 3, the controller under reference velocity from (33) provides slightly better results in both position tracking and velocity tracking than the one under (34). However, from Figure 9, the results obtained under the GPM from (34) substantially reduce the influence of the restoring moments compared with the one under (33). Considering all these factors, the scheme with the GPM provides better overall performances.
In addition, we compare he tracking performances between the proposed method and the one but without the HODO. As showed in Figure 10, the proposed scheme achieves accurate and smooth results compared with the other one. From theoretical analysis in previous section, the HODO achieves BIBO stable, rather than asymptotical stable. But in simulations, the HODO still shows good performances in estimating disturbances in all DOFs. The results can be found in Figure 11. Disturbance estimation error RMS values are given in Table 4. From theoretical analysis in previous section, the HODO achieves BIBO stable, rather than asymptotical stable. But in simulations, the HODO still shows good performances in estimating disturbances in all DOFs. The results can be found in Figure 11. Disturbance estimation error RMS values are given in Table 4.

Conclusions
In this paper, an uncalibrated visual servoing scheme is proposed for the UVMS with an eye-inhand configuration camera. Parameters of the vision sensor, kinematics of the UVMS and the target position are supposed to be unknown. Firstly, we introduce a linear separation method to collect kinematics uncertainties into vectors, and this method can be utilized in other free-floating based articulated manipulators. Then, to deal with these kinematics uncertainties, novel adaptive laws are proposed to estimate these vectors, the GPM is utilized to optimize the restoring moments of the system. Moreover, a high order disturbance observer is presented to estimate and compensate lumped disturbances. A novel composite controller is addressed in order to realize the convergence of image errors. The stability of the closed-loop system is proved by utilizing Lyapunov theory. Finally, trajectory tracking simulations based on a 9 -DOFs UVMS are carried out to test the proposed scheme under uncertainties and disturbances.

Conclusions
In this paper, an uncalibrated visual servoing scheme is proposed for the UVMS with an eye-in-hand configuration camera. Parameters of the vision sensor, kinematics of the UVMS and the target position are supposed to be unknown. Firstly, we introduce a linear separation method to collect kinematics uncertainties into vectors, and this method can be utilized in other free-floating based articulated manipulators. Then, to deal with these kinematics uncertainties, novel adaptive laws are proposed to estimate these vectors, the GPM is utilized to optimize the restoring moments of the system. Moreover, a high order disturbance observer is presented to estimate and compensate lumped disturbances. A novel composite controller is addressed in order to realize the convergence of image errors. The stability of the closed-loop system is proved by utilizing Lyapunov theory. Finally, trajectory tracking simulations based on a 9 -DOFs UVMS are carried out to test the proposed scheme under uncertainties and disturbances.