Adaptive Dynamic Feedback Tracking Control for a Robot-camera System with Unknown Parameters
-
Abstract: The tracking problem of nonholonomic mobile robots with uncertainties is investigated in this paper.An uncertain model of the nonholonomic kinematic system is presented based on the visual feedback and the state and input transformations for a kind of mobile robots in chained form with uncertainties.Two transformations are exploited based on the idea of backstepping and the structure of tracking error system.Then, both an adaptive control law and a dynamic feedback robust controller are designed to track the desired trajectory by using Lyapunov direct method and the extended Barbalat Lemma.The asymptotic convergence of a closed-loop error system is proved rigorously.Finally, simulation results demonstrate the effectiveness of the proposed strategies.
-
Key words:
- Adaptive control /
- chained system /
- feedback /
- mobile robot /
- tracking control
-
The control of nonholonomic systems has received a great deal of attention over the past twenty years[1-2]. In [3] and some references therein, it is shown that many systems with nonholonomic constraints can be transformed, either locally or globally, to chained systems by using coordinate and state-feedback transformations. Several new control strategies were developed around the important nonholonomic chained models[4-6]. A wheeled mobile robot (WMR) is one of the well-known systems with nonholonomic constraints[7]. In the control of nonholonomic WMR, it is usually assumed that the states are available using sensor measurements. But in practice, there exist uncertainties, such as uncalibrated parameters in the kinematic models, mechanical limitations, noise and so on. In recent ten years, the study of nonholonomic systems with uncertainties has received considerable attention. Many strategies have been investigated to stabilize the uncertain nonholonomic systems[8-11]. Adaptive strategies were often used to control the dynamic nonholonomic systems with modeling or parametric uncertainties[12-13].
The tracking control is a complicated problem due to coupled and nonlinear system dynamics[12-16]. In [12], adaptive force tracking controllers were proposed which not only ensure the entire state of the system to asymptotically converge to the desired trajectory but also ensure the constraint force to asymptotically converge to the desired force. In [13], Wang et al. proposed a robust adaptive tracking controller which not only can guarantee robustness to parametric and dynamics uncertainties but also can reject any bounded, immeasurable disturbances entering the system. Based on Lyapunov's direct method and backstepping technique in [6] and [15], the time-varying global adaptive controllers were presented which simultaneously solved both tracking and stabilization for mobile robots with unknown kinematic and dynamic parameters.
Visual feedback is an important approach to improve the control performance for robots and manipulators since it mimics the human sense of vision and allows for operating on the basis of noncontact measurement and unstructured environment. Since the late 1980s, tremendous effort has been made to visual servoing[16-21] and vision-based manipulations. In order to develop an adaptive tracking controller for a mobile robot that compensated for the parametric uncertainty in the camera and the mobile robot dynamics, the feedback from an uncalibrated, fixed (ceiling-mounted) camera was used in [16]. In [18], a visual servo tracking controller was developed for a monocular camera system mounted on an underactuated WMR subject to nonholonomic motion constraints. In [19], a new controller for controlling a number of feature points on a robot manipulator was presented to track desired trajectories specified on the image plane of a fixed camera. Recently, [20] presented a dynamic feedback tracking controller for the nonholonomic WMR of unicycle type with unknown camera parameters. In [11], a series of new chained models of nonholonomic mobile robots with uncalibrated visual parameters were shown. In [21], the trajectory tracking control problem of another kind of uncertain dynamic nonholonomic mobile robot (called type (1, 1) robot) was addressed where a new adaptive torque tracking controller was presented for tracking error model. For type (1, 2) robot, which has two steering wheels and one castor wheel with unknown visual parameters, a new and simple robust stabilization controller[11, 22] was designed for a particular case. However, the corresponding tracking problem has not been discussed. Comparing with [16], in this paper, we design an adaptive dynamic feedback controller to compensate for the unknown camera parameter. Based on Lyapunov direct method and the idea of back-stepping technique, two transformations are chosen. The controllers can make the mobile robot tracking the desired trajectory in the image space and work-space.
The paper is organized as follows. Section 1 addresses robot-camera system configuration. In Section 2, an uncertain chained form model is presented, and the tracking problems are proposed. Section 3 addresses the designs of adaptive and dynamic feedback tracking controllers for the uncertain kinematic error system and gives the rigorous proof of the asymptotical convergence of the closed-loop error system. Then, the tracking problems in work-space of the mobile robot are presented. In Section 4, simulation results are provided to illustrate the effectiveness of the proposed control strategy. Finally, the major contributions of the paper are summarized in Section 5.
1. Robot-camera system
In this section, we will address robot-camera system configuration.
In Fig. 1, a robot-camera system is shown. It is assumed that a pinhole camera is fixed to the ceiling, the type (1, 2) mobile robot is under the camera. The movement of the mobile robot can be measured by using a fixed camera. It is assumed that the camera plane runs parallel to the mobile robot plane, and the camera can capture images throughout the entire robot workspace. In the robot-camera system, three coordinate frames exist, namely the inertial frame $X-Y-Z$, the camera frame $i-j-k$ and the image frame $i_{1}-o_{1}-j_{1}$. Assume that the $i-j$ plane of the camera frame is parallel to the plane of the image coordinate plane. The direction of corresponding coordinate axis is identical. But the coordinate of the original point of the camera frame with respect to the image frame is defined by $ (O_{c1},O_{c2}).$ $C(c_{x},c_{y})$ is the crossing point between the optical axis of the camera and $X-Y$ plane.
1.1 Robot kinematic system
In Fig. 1, the type (1, 2) mobile robot[7] is in the $X-Y$ plane which has two steering wheels (conventional centered orientable wheels) and one castor wheel (conventional off-centered orientable wheel). $P$ is the mid-distance point between the centers of these two steering wheels, with $i_{2}$ aligned along the line joining their centers. $A$ and $B$ are the center points of two steering wheels respectively. $L$ is the distance between point $P$ and point $A$ (or point $P$ and point $B$). It is also the distance between point $P$ and the joint point of the castor wheel. $\theta $ denotes the angle between $i_{2}$ axis and $X$ axis, $\beta _{1}$ and $\beta _{2}$ denote the angles between the orientation of the plane of steering wheels and $i_{2}$ axis respectively. Assume that the geometric center point and the mass center point of the robot are the same. The nonholonomic constraints are described[7] by
$\begin{align} & (\cos {{\beta }_{1}},\sin {{\beta }_{1}},L\sin {{\beta }_{1}})G(\theta )\dot{q}=0 \\ & (-\cos {{\beta }_{2}},-\sin {{\beta }_{2}},L\sin {{\beta }_{2}})G(\theta )\dot{q}=0 \\ \end{align}$
where $q =(x,y,\theta )^{\rm T},$ and
$G(\theta )=\left[ \begin{matrix} \cos \theta & \sin \theta & 0 \\ -\sin \theta & \cos \theta & 0 \\ 0 & 0 & 1 \\ \end{matrix} \right]$
Then the nonholonomic kinematic system[7] can be given by
$ \begin{align} \begin{cases} \dot{x}=-Lv_{1}[\sin \beta _{1}\sin (\theta +\beta _{2})+\sin \beta _{2}\sin (\theta +\beta _{1})] \\ \dot{y}=Lv_{1}[\sin \beta _{1}\cos (\theta +\beta _{2})+\sin \beta _{2}\cos (\theta +\beta _{1})] \\ \dot{\theta}=v_{1}\sin (\beta _{2}-\beta _{1}) \\ \dot{\beta}_{1}=v_{2} \\ \dot{\beta}_{2}=v_{3} \end{cases} \label{h4} \end{align} $
(1) where $v_{1}$ is the velocity of the robot, $v_{2}$ and $v_{3}$ are the angular velocities of two steering wheels respectively.
For system (1), if $\sin(\beta_{2}-\beta_{1})=0$, then $\beta_{1}=\beta_{2}=0$ or $\beta_{2}=\beta_{1}+k\pi$ $(k=\pm1,\pm2,\cdots)$. Consider the two nonholonomic constraints along the wheel plane given by [7]. One obtains that the type (1, 2) mobile robot is stopped (i.e., $v_{1}=0$) or this robot is vestigial to type (2, 0) robot. The tracking and stabilization problems are discussed in many papers such as [20-21].
For system (1), if $\sin (\beta _{2}-\beta _{1})\neq0,$ choose the state-input transformation[3] as
$\left\{ \begin{array}{*{35}{l}} {{z}_{0}}=\theta \\ {{z}_{1}}=x\cos \theta +y\sin \theta \\ {{z}_{2}}=-x\sin \theta +y\cos \theta -2L\frac{\sin {{\beta }_{1}}\sin {{\beta }_{2}}}{\sin ({{\beta }_{2}}-{{\beta }_{1}})} \\ {{z}_{3}}=x\sin \theta -y\cos \theta \\ {{z}_{4}}=x\cos \theta +y\sin \theta -L\frac{\sin ({{\beta }_{1}}+{{\beta }_{2}})}{\sin ({{\beta }_{2}}-{{\beta }_{1}})} \\ {{\sigma }_{0}}={{v}_{1}}\sin ({{\beta }_{2}}-{{\beta }_{1}}) \\ \begin{align} & {{\sigma }_{1}}=-{{x}_{4}}{{v}_{1}}\sin ({{\beta }_{2}}-{{\beta }_{1}})-\frac{2L{{v}_{2}}{{\sin }^{2}}{{\beta }_{2}}}{{{\sin }^{2}}({{\beta }_{2}}-{{\beta }_{1}})}+\frac{2L{{v}_{3}}{{\sin }^{2}}{{\beta }_{1}}}{{{\sin }^{2}}({{\beta }_{2}}-{{\beta }_{1}})} \\ & {{\sigma }_{2}}={{x}_{2}}{{v}_{1}}\sin ({{\beta }_{2}}-{{\beta }_{1}})-\frac{L{{v}_{2}}\sin (2{{\beta }_{2}})}{{{\sin }^{2}}({{\beta }_{2}}-{{\beta }_{1}})}+\frac{L{{v}_{3}}\sin (2{{\beta }_{1}})}{{{\sin }^{2}}({{\beta }_{2}}-{{\beta }_{1}})} \\ \end{align} \\ \end{array} \right.$
(2) We obtain the following chained system
$\left\{ \begin{array}{*{35}{l}} {{{\dot{z}}}_{0}}={{\sigma }_{0}} \\ {{{\dot{z}}}_{1}}={{z}_{2}}{{\sigma }_{0}} \\ {{{\dot{z}}}_{2}}={{\sigma }_{1}} \\ {{{\dot{z}}}_{3}}={{z}_{4}}{{\sigma }_{0}} \\ {{{\dot{z}}}_{4}}={{\sigma }_{2}} \\ \end{array} \right.$
(3) System (3) is called canonical chained form system[8]. Generally, $(x,y)$ in (1) needs to be measured for feedback. The encoders can be used to do it. However, over-shoot and low precision are their main drawbacks. Camera is a convenient sensor to implement non-contact and unstructured measurement. The data from a camera can be used for the robot tracking problem.
1.2 Camera system model
In Fig. 1, the coordinate of the mass center $P$ is $(x,y)$ for the robot with respect to $X-Y$ plane. Suppose that ${{P}_{m}}({{x}_{m}},{{y}_{m}})$ is the coordinate of $(x,y)$ relative to the image frame. Pinhole camera model yields
$ \begin{equation} \left[ \begin{array}{c} x_{m} \\ y_{m} \end{array} \right] =\left[ \begin{array}{cc} \alpha _{1} & 0 \\ 0 & \alpha _{2} \end{array} \right]H(\theta_{0}) \left[\left[ \begin{array}{c} x \\ y \end{array} \right] -\left[ \begin{array}{c} c_{x} \\ c_{y} \end{array} \right] \right] +\left[ \begin{array}{c} O_{c1} \\ O_{c2} \end{array} \right] \label{h1} \end{equation} $
(4) where $\alpha _{1}$ and $\alpha _{2}$ are positive constants and dependent on the depth information, focal length, scale factors[16] defined as follows
$ \begin{align*} \alpha _{1}=\rho_{1}\frac{f}{z},\ \ \alpha _{2}=\rho_{2}\frac{f}{z} \end{align*} $
where $z\in {\bf R}^{1}$ represents the constant height of the camera optical center with respect to the task-space plane, $f\in {\bf R}^{1}$ is a constant representing the camera's focal length, the positive constants denoted by $\rho_{1}$, $\rho_{2}\in {\bf R}^{1}$, represent the camera’s constant scale factors (in pixels/m) along their respective Cartesian directions, respectively[16]. And
$ \begin{align*} H(\theta_{0})=\left[ \begin{array}{cc} \cos \theta _{0} & \sin \theta _{0} \\ -\sin \theta _{0} & \cos \theta _{0} \end{array} \right] \end{align*} $
where $\theta _{0}$ denotes the angle between $j$ axis and $X$ axis which represents the constant, anticlockwise rotation angle of the camera coordinate system with respect to the task-space coordinate system.
Therefore, the kinematic system in the image frame can be rewritten as
$ \begin{equation} \left[ \begin{array}{c} \dot{x}_{m} \\ \dot{y}_{m} \end{array} \right] =\left[ \begin{array}{cc} \alpha _{1} & 0 \\ 0 & \alpha _{2} \end{array} \right]\left[\begin{array}{cc} \cos \theta _{0} & \sin \theta _{0} \\ -\sin \theta _{0} & \cos \theta _{0} \end{array}\right] \left[ \begin{array}{c} \dot{x} \\ \dot{y} \end{array} \right] \label{h2} \end{equation} $
(5) In this paper, it is assumed that $(x,y)$ in (1) is measured by using a camera with uncalibrated visual parameters shown in Fig. 1. The pose of the mobile robot in the workspace is $(x,y,\theta)$. the pose of the robot in the image plane is $(x_{m},y_{m},\theta_{m})$. Then, by using the state and input transformations in Section 2, a kinematic model with unknown visual parameters will be deduced in the following section.
Remark 1. The first formula $H(\theta_{0})$ on this page is a rotation matrix which is different from that denoted by $R(\theta_{0})$ in [16]. In our paper, $H(\theta_{0})$ is a matrix of anticlockwise rotation, but $R(\theta_{0})$ in [16] is a matrix of clockwise rotation.
2. Problem formulation
In this section, we will present an uncertain chained system by using (5) and using the state and input transformations for type (1, 2) mobile robot with unknown visual parameters. Then, we will propose the tracking problem for the uncertain chained system and type (1, 2) mobile robot.
For system (1), suppose $\sin(\beta _{2}-\beta _{1})\neq0,$ and consider (5). We have[22]
$\begin{array}{*{35}{l}} \left[ \begin{array}{*{35}{l}} {{{\dot{x}}}_{m}} \\ {{{\dot{y}}}_{m}} \\ \end{array} \right]=\left[ \begin{array}{*{35}{l}} \begin{align} & -{{\alpha }_{1}}L{{v}_{1}}(\sin {{\beta }_{1}}{{s}_{\Delta 2}}+\sin {{\beta }_{2}}{{s}_{\Delta 1}}) \\ & {{\alpha }_{2}}L{{v}_{1}}(\sin {{\beta }_{1}}{{c}_{\Delta 2}}+\sin {{\beta }_{2}}{{c}_{\Delta 1}}) \\ \end{align} \\ \end{array} \right] \\ \end{array}$
(6) where
$ \begin{align*} s_{\Delta i}=\sin (\theta -\theta _{0}+\beta _{i}),\ c_{\Delta i}=\cos (\theta -\theta _{0}+\beta _{i}),\ \ i=1,2 \end{align*} $
Considering kinematic system (1) in the robot workspace, we have
$ \tan\theta=\frac{\dot{y}}{\dot{x}}=-\frac{\sin\beta_{1}\cos(\theta+\beta_{2})+\sin\beta_{2}\cos(\theta+\beta_{1})}{\sin\beta_{1}\sin(\theta+\beta_{2})+\sin\beta_{2}\sin(\theta+\beta_{1})} $
Then,
$ \tan(\theta-\theta_{0})=-\frac{\sin\beta_{1}c_{\Delta 2}+\sin\beta_{2}c_{\Delta 1}}{\sin\beta_{1}s_{\Delta 2}+\sin\beta_{2}s_{\Delta 1}} $
Now, considering (6) in the image space, we have
$ \tan\theta_{m}=\frac{\dot{y}_{m}}{\dot{x}_{m}}=-\frac{\alpha_{2}}{\alpha_{1}}\displaystyle\frac{\sin\beta_{1}c_{\Delta 2}+\sin\beta_{2}c_{\Delta 1}}{\sin\beta_{1}s_{\Delta 2}+\sin\beta_{2}s_{\Delta 1}} $
Hence, we obtain the following relationships
$\begin{align} & \tan {{\theta }_{m}}=\frac{{{\alpha }_{2}}}{{{\alpha }_{1}}}\tan (\theta -{{\theta }_{0}}) \\ & {{\sec }^{2}}{{\theta }_{m}}=\frac{\alpha _{1}^{2}{{\cos }^{2}}(\theta -{{\theta }_{0}})+\alpha _{2}^{2}\sin (\theta -{{\theta }_{0}})}{\alpha _{1}^{2}{{\cos }^{2}}(\theta -{{\theta }_{0}})} \\ \end{align}$
(7) After taking the time derivative of (7), we have that
$ (\sec^{2}\theta_{m})\dot{\theta}_{m}=\left[\frac{\alpha_{2}}{\alpha_{1}}\sec^{2}(\theta-\theta_{0})\right]\dot{\theta} $
Therefore, we obtain
$ \dot{\theta}=\left[\frac{\alpha_{1}}{\alpha_{2}}\cos^{2}(\theta-\theta_{0})+\ \frac{\alpha_{2}}{\alpha_{1}}\sin^{2}(\theta-\theta_{0})\right]\dot{\theta}_{m} $
If $\alpha _{1}=\alpha _{2}=\alpha$, we have $\dot{\theta}_{m}=\dot{\theta}$ and $\theta_{m}=\theta-\theta_{0}+k\pi$ ($k=$ $0$, $\pm1$, $\pm2,\cdots$). Then, the nonholonomic kinematic system with uncalibrated parameters in the image-plane can be described by the following system
$ \begin{equation} \left[ \begin{array}{l} \dot{x}_{m} \\ \dot{y}_{m} \\ \dot{\theta} \\ \dot{\beta}_{1} \\ \dot{\beta}_{2} \end{array} \right] =\left[ \begin{array}{c} -\alpha Lv_{1}(\sin\beta_{1}s_{\Delta 2}+\sin\beta_{2}s_{\Delta 1}) \\ \alpha Lv_{1}(\sin\beta_{1}c_{\Delta 2}+\sin\beta_{2}c_{\Delta 1}) \\ v_{1}\sin(\beta_{2}-\beta_{1}) \\ v_{2} \\ v_{3} \end{array} \right] \label{h6} \end{equation} $
(8) where $\theta_{m}$ is expressed by $\theta$. For $i=1,2$, denote
$\begin{align} & {{s}_{\Lambda i}}=\sin (2\theta -{{\theta }_{0}}+{{\beta }_{i}}),\ \ {{s}_{\Theta }}=\sin (2{{x}_{0}}-{{\theta }_{0}}) \\ & {{c}_{\Lambda i}}=\cos (2\theta -{{\theta }_{0}}+{{\beta }_{i}}),\ \ {{c}_{\Theta }}=\cos (2{{x}_{0}}-{{\theta }_{0}}) \\ \end{align}$
(9) and consider the following expressions
$\begin{align} & \sin \theta {{c}_{\Delta i}}=-\frac{1}{2}\sin ({{\beta }_{i}}-{{\theta }_{0}})+\frac{1}{2}{{s}_{\Lambda i}},\ \ i=1,2 \\ & \cos \theta {{c}_{\Delta i}}=\frac{1}{2}\cos ({{\beta }_{i}}-{{\theta }_{0}})+\frac{1}{2}{{c}_{\Lambda i}},\quad \ i=1,2 \\ \end{align}$
Then, note that
$\begin{align} & \sin {{\beta }_{1}}\sin ({{\beta }_{2}}-{{\theta }_{0}})+\sin {{\beta }_{2}}\sin ({{\beta }_{1}}-{{\theta }_{0}})= \\ & 2\sin {{\beta }_{1}}\sin {{\beta }_{2}}\cos {{\theta }_{0}}-\sin {{\theta }_{0}}\sin ({{\beta }_{1}}+{{\beta }_{2}}) \\ & \sin {{\beta }_{1}}\cos ({{\beta }_{2}}-{{\theta }_{0}})+\sin {{\beta }_{2}}\cos ({{\beta }_{1}}-{{\theta }_{0}})= \\ & 2\sin {{\beta }_{1}}\sin {{\beta }_{2}}\sin {{\theta }_{0}}+\cos {{\theta }_{0}}\sin ({{\beta }_{1}}+{{\beta }_{2}}) \\ \end{align}$
and
$\begin{align} & \sin {{\beta }_{1}}{{s}_{\Lambda 2}}+\sin {{\beta }_{2}}{{s}_{\Lambda 1}}= \\ & 2\sin {{\beta }_{1}}\sin {{\beta }_{2}}{{c}_{\Theta }}+\sin ({{\beta }_{1}}+{{\beta }_{2}}){{s}_{\Theta }} \\ & \sin {{\beta }_{1}}{{c}_{\Lambda 2}}+\sin {{\beta }_{2}}{{c}_{\Lambda 1}}= \\ & -2\sin {{\beta }_{1}}\sin {{\beta }_{2}}{{s}_{\Theta }}+\sin ({{\beta }_{1}}+{{\beta }_{2}}){{c}_{\Theta }} \\ \end{align}$
Hence, by taking the following state and input transformations
$\left\{ \begin{array}{*{35}{l}} {{x}_{0}}=\theta \\ {{x}_{1}}={{x}_{m}}\cos \theta +{{y}_{m}}\sin \theta \\ {{x}_{2}}=-{{x}_{m}}\sin \theta +{{y}_{m}}\cos \theta -2L\frac{\sin {{\beta }_{1}}\sin {{\beta }_{2}}}{\sin ({{\beta }_{2}}-{{\beta }_{1}})} \\ {{x}_{3}}={{x}_{m}}\sin \theta -{{y}_{m}}\cos \theta \\ {{x}_{4}}={{x}_{m}}\cos \theta +{{y}_{m}}\sin \theta -L\frac{\sin ({{\beta }_{1}}+{{\beta }_{2}})}{\sin ({{\beta }_{2}}-{{\beta }_{1}})} \\ {{u}_{0}}={{v}_{1}}\sin ({{\beta }_{2}}-{{\beta }_{1}}) \\ \begin{align} & {{u}_{1}}=-{{x}_{4}}{{v}_{1}}\sin ({{\beta }_{2}}-{{\beta }_{1}})-\frac{2L{{v}_{2}}{{\sin }^{2}}{{\beta }_{2}}}{{{\sin }^{2}}({{\beta }_{2}}-{{\beta }_{1}})}+\frac{2L{{v}_{3}}{{\sin }^{2}}{{\beta }_{1}}}{{{\sin }^{2}}({{\beta }_{2}}-{{\beta }_{1}})} \\ & {{u}_{2}}={{x}_{2}}{{v}_{1}}\sin ({{\beta }_{2}}-{{\beta }_{1}})-\frac{L{{v}_{2}}\sin (2{{\beta }_{2}})}{{{\sin }^{2}}({{\beta }_{2}}-{{\beta }_{1}})}+\frac{L{{v}_{3}}\sin (2{{\beta }_{1}})}{{{\sin }^{2}}({{\beta }_{2}}-{{\beta }_{1}})} \\ \end{align} \\ \end{array} \right.$
(10) One obtains the uncertain chained system[22]
$\left\{ \begin{align} & {{{\dot{x}}}_{0}}={{u}_{0}} \\ & {{{\dot{x}}}_{1}}={{x}_{2}}{{u}_{0}}+({{x}_{1}}-{{x}_{4}})(\alpha \sin {{\theta }_{0}}){{u}_{0}}- \\ & \ \ \ \ \ \ ({{x}_{2}}+{{x}_{3}})(1-\alpha \cos {{\theta }_{0}}){{u}_{0}} \\ & {{{\dot{x}}}_{2}}={{u}_{1}}-({{x}_{2}}+{{x}_{3}})(\alpha \sin {{\theta }_{0}}){{u}_{0}}- \\ & \ \ \ \ \ \ \ ({{x}_{1}}-{{x}_{4}})(1-\alpha \cos {{\theta }_{0}}){{u}_{0}} \\ & {{{\dot{x}}}_{3}}={{x}_{4}}{{u}_{0}}+({{x}_{2}}+{{x}_{3}})(\alpha \sin {{\theta }_{0}}){{u}_{0}}+ \\ & \ \ \ \ \ \ \ ({{x}_{1}}-{{x}_{4}})(1-\alpha \cos {{\theta }_{0}}){{u}_{0}} \\ & {{{\dot{x}}}_{4}}={{u}_{2}}+({{x}_{1}}-{{x}_{4}})(\alpha \sin {{\theta }_{0}}){{u}_{0}}- \\ & \ \ \ \ \ \ \ ({{x}_{2}}+{{x}_{3}})(1-\alpha \cos {{\theta }_{0}}){{u}_{0}} \\ \end{align} \right.$
(11) where $u_{0}=v_{1}\sin(\beta_{2}-\beta_{1})$ and $\sin(\beta_{2}-\beta_{1})\neq0$.
In contrast to canonical chained form (3), model (11) has two new parameters $\alpha$ and $\theta _{0}$. In practice, they are usually uncalibrated. Comparing with model (3), the first term on the right side of each equation of (11) is identical except uncertain coefficient gains. Note that the second and third terms on the right side of the second equation are dependent on $x_{1}$, $x_{2}$, $x_{3}$ and $x_{4}$. Therefore, (11) does not satisfy the so-called {triangular structure[8] which is required in many papers. So (11) is called an {uncertain chained system.
For uncertain system (11), the tracking problem is how to design $u_{0},$ $u _{1}$ and $u_{2}$ such that the trajectory $(x_{0},x_{1},$ $x_{2},x_{3},x_{4})$ can track a desired reference trajectory $(x_{0r},$ $x_{1r},x_{2r},x_{3r},x_{4r})$. In the work-space of type (1, 2) mobile robot, the adaptive dynamic tracking problem is how to design adaptive control law and dynamic feedback control to make the trajectory $q=(x,y,\theta)$ tracking a desired reference trajectory $q_{r}=(x_{r},y_{r},\theta_{r})$ in the work-space of the robot with the help of the reference trajectories in the image space.
3. Tracking controller design
In this section, our objective is to design adaptive dynamic feedback tracking controllers to solve the tracking problem for uncertain chained system (11) and the type (1, 2) mobile robot in the work-apace. In order to design the controller, three Assumptions and a Lemma are needed as follows.
Assumption 1. Uncertain chained system (11) satisfies ${{u}_{0}}\ne 0$.
Assumption 2. $\theta _{0}$ is known, and $\alpha_{1}=\alpha_{2}=\alpha$ are unknown. There exist two constants $\underline{\alpha}$ and $\bar{\alpha}$ such that $\underline{\alpha}\leq \alpha \leq \overline{\alpha}$.
Assumption 3. ${{x}_{ir}}(i=0,1,\cdots ,4)$ are bounded. ${{u}_{0r}}({{u}_{0r}}\ne 0)$, $u_{1r}$, $u_{2r}$ and their derivatives are all bounded too.
Remark 2. System (11) is based on the assumption $\sin ({{\beta }_{2}}-{{\beta }_{1}})\ne 0$. This means $u_{0}\neq0$ for (11).
Remark 3. For Assumption 2, $\alpha _{1}=\alpha _{2}=\alpha$ means that the scale factor along $i_{1}$ axis is the same with that one along $j_{1}$ axis. Some CCD cameras are made like this. However, $\alpha _{1}=\alpha_{2}=\alpha$ are limitations. As for the tracking problem of the case $\alpha _{1}\neq \alpha_{2}$ and unknown, we will further investigate it in the future.
Remark 4. Assumption 3 is rational. Commonly, the positive upper and lower bounds of the scale factor can be estimated in advance. In practice, the robot often has the same structure feature with a reference target when the robot tracks the reference trajectory.
Remark 5. Consider system (11) under Assumptions $1\tilde{\ }3$. By substituting $\theta-\theta_{0}$ for $\theta,$ (11) will become the system with $\theta _{0}=0$. This implies that the direction of $j$ axis is identical to that one of $X$ axis. Hence, we only need to discuss the case: $\theta _{0}=0$, $\alpha_{1}=\alpha _{2}=\alpha$ are unknown for (11).
Based on the Assumptions $1\tilde{\ }3$ and the analysis above, system (11) can be rewritten as
$ \begin{align*} \begin{cases} \dot{x}_{0}=u_{0} \\ \dot{x}_{1}=[x_{2}- (x_{2}+x_{3})(1-\alpha )]u_{0} \\ \dot{x}_{2}=u_{1}- [(x_{1}-x_{4})(1-\alpha )]u_{0} \\ \dot{x}_{3}=[x_{4}+(x_{1}-x_{4})(1-\alpha) ]u_{0} \\ \dot{x}_{4}=u_{2}-[(x_{2}+x_{3})(1-\alpha)]u_{0}\ \end{cases} \end{align*} $
where $\alpha$ is the unknown camera parameter, $u_{0},$ $u_{1}$ and $u_{2}$ are the control inputs to be designed. It can also be rewritten as
$ \begin{align} \begin{cases} \dot{x}_{0}=u_{0} \\ \dot{x}_{1}=-x_{3}u_{0}+\alpha x_{23}u_{0} \\ \dot{x}_{2}=u_{1}+(1-\alpha)x_{41}u_{0}\\ \dot{x}_{3}=x_{1}u_{0}+\alpha x_{41}u_{0}\\ \dot{x}_{4}=u_{2}-(1-\alpha)x_{23}u_{0} \end{cases} \label{a2} \end{align} $
(12) where
$ \begin{align*} x_{23}=x_{2}+x_{3},\ \ x_{41}=x_{4}-x_{1} \end{align*} $
The desired reference system for (12) is
$ \begin{align} \begin{cases} \dot{x}_{0r}=u_{0r} \\ \dot{x}_{1r}=-x_{3r}u_{0r}+\alpha x_{23r}u_{0r}\\ \dot{x}_{2r}=u_{1r}+(1-\alpha)x_{41r}u_{0r}\\ \dot{x}_{3r}=x_{1r}u_{0r}+\alpha x_{41r}u_{0r}\\ \dot{x}_{4r}=u_{2r}-(1-\alpha)x_{23r}u_{0r} \end{cases} \label{a3} \end{align} $
(13) where
$ \begin{align*} x_{23r}=x_{2r}+x_{3r},\ \ x_{41r}=x_{4r}-x_{1r} \end{align*} $
Denote
$ \begin{align} \begin{cases} e_{i}=x_{i}- x_{ir},& i=0,1,2,3,4 \\ e_{23}=e_{2}+e_{3},& e_{41}=e_{4}-e_{1} \end{cases} \label{a4} \end{align} $
(14) By using (12) and (13), the following kinematic tracking error system is obtained
$ \begin{align} \begin{cases} \dot{e}_{0}=p \\ \dot{e}_{1}=-(x_{3}p+e_{3}u_{0r})+\alpha (x_{23}p+e_{23}u_{0r})\\ \dot{e}_{2}=u_{1}- u_{1r}+(1-\alpha)(x_{41}p+e_{41}u_{0r} )\\ \dot{e}_{3}=(x_{1}p+ e_{1}u_{0r})+\alpha (x_{41}p+e_{41}u_{0r} )\\ \dot{e}_{4}=u_{2}- u_{2r}-(1-\alpha)(x_{23}p+e_{23}u_{0r} ) \end{cases} \label{a5} \end{align} $
(15) where $p := u_{0}-u_{0r}$.
Based on the idea of backstepping and the structure of model (15), choose two new transformations as
$ \begin{align} \xi=e_{23}+k_{1} e_{1}u_{0r},\ \ \eta=e_{41}+k_{3}e_{3}u_{0r} \label{a6} \end{align} $
(16) where $k_{1}$ and $k_{3}$ are positive constant control gains. Then, we have
$ \begin{align*} &e_{23}=-k_{1}e_{1}u_{0r}+\xi \\ &e_{41}=-k_{3}e_{3}u_{0r}+\eta\\ &\dot{e}_{23}=u_{1}-u_{1r}+x_{4}p+e_{4}u_{0r}\\ &\dot{e}_{41}=u_{2}-u_{2r}-x_{2}p-e_{2}u_{0r} \end{align*} $
Choose the Lyapunov function candidate
$ \begin{align} V=&\ V_{1}+V_{2}+V_{3}=\notag\\ &\ \displaystyle\frac{1}{2}\left(k_{0}e_{0}^{2}+e_{1}^{2}+e_{3}^{2}\right) +\displaystyle\frac{1}{2}\left(\xi^{2}+\eta^{2}\right)+\displaystyle\frac{1}{2}\left(p^{2}+\Lambda \widetilde{\alpha}^{2}\right) \label{a111} \end{align} $
(17) where $k_{0}$ is a positive constant gain. $\tilde{\alpha}$ is the parameter error defined as $\tilde{\alpha}=\alpha-\hat{\alpha}$. $\hat{\alpha}$ is the estimation of $\alpha$.
By using (16), we have
$\begin{align} & {{{\dot{V}}}_{1}}={{k}_{0}}{{e}_{0}}{{{\dot{e}}}_{0}}+{{e}_{1}}{{{\dot{e}}}_{1}}+{{e}_{3}}{{{\dot{e}}}_{3}}= \\ & {{k}_{0}}{{e}_{0}}p+{{e}_{1}}[(-{{x}_{3}}p-{{e}_{3}}{{u}_{0r}})+\alpha ({{x}_{23}}p+{{e}_{23}}{{u}_{0r}})]+ \\ & {{e}_{3}}[({{x}_{1}}p+{{e}_{1}}{{u}_{0r}})+\alpha ({{x}_{41}}p+{{e}_{41}}{{u}_{0r}})]= \\ & ({{k}_{0}}{{e}_{0}}-{{e}_{1}}{{x}_{3}}+{{e}_{3}}{{x}_{1}})p+\alpha ({{e}_{1}}{{x}_{23}}+{{e}_{3}}{{x}_{41}})p- \\ & {{k}_{1}}\alpha e_{1}^{2}u_{0r}^{2}-{{k}_{3}}\alpha e_{3}^{3}u_{0r}^{2}+\alpha {{u}_{0r}}({{e}_{1}}\xi +{{e}_{3}}\eta ) \\ & {{{\dot{V}}}_{2}}=\xi \dot{\xi }+\eta \dot{\eta }= \\ & \xi [({{{\dot{e}}}_{2}}+{{{\dot{e}}}_{3}})+{{k}_{1}}({{{\dot{e}}}_{1}}{{u}_{0r}}+{{e}_{1}}{{{\dot{u}}}_{0r}})]+ \\ & \eta [({{{\dot{e}}}_{4}}-{{{\dot{e}}}_{1}})+{{k}_{3}}({{{\dot{e}}}_{3}}{{u}_{0r}}+{{e}_{3}}{{{\dot{u}}}_{0r}})]= \\ & \xi [({{u}_{1}}-{{u}_{1r}}+{{x}_{4}}p+{{e}_{4}}{{u}_{0r}})+ \\ & {{k}_{1}}{{u}_{0r}}(-{{x}_{3}}p-{{e}_{3}}{{u}_{0r}}+\alpha {{x}_{23}}p+\alpha {{e}_{23}}{{u}_{0r}})+ \\ & {{k}_{1}}{{e}_{1}}{{{\dot{u}}}_{0r}}]+\eta [({{u}_{2}}-{{u}_{2r}}-{{x}_{2}}p-{{e}_{2}}{{u}_{0r}})+ \\ & {{k}_{3}}{{u}_{0r}}({{x}_{1}}p+{{e}_{1}}{{u}_{0r}}+\alpha {{x}_{41}}p+\alpha {{e}_{41}}{{u}_{0r}})+{{k}_{3}}{{e}_{3}}{{{\dot{u}}}_{0r}}] \\ & {{{\dot{V}}}_{3}}=p\dot{p}+\Lambda \tilde{\alpha }\overset{\cdot }{\mathop{{\tilde{\alpha }}}}\, \\ \end{align}$
Hence, the time derivative of V along the solution of (15) satisfies
$ \begin{align} & \dot{V}={{{\dot{V}}}_{1}}+{{{\dot{V}}}_{2}}+{{{\dot{V}}}_{3}}= \\ & -{{k}_{1}}\alpha e_{1}^{2}u_{0r}^{2}-{{k}_{3}}\alpha e_{3}^{3}u_{0r}^{2}+ \\ & ({{k}_{0}}{{e}_{0}}-{{e}_{1}}{{x}_{3}}+{{e}_{3}}{{x}_{1}})p+\alpha ({{e}_{1}}{{x}_{23}}+{{e}_{3}}{{x}_{41}})p+ \\ & \alpha {{u}_{0r}}({{e}_{1}}\xi +{{e}_{3}}\eta )+\xi [({{u}_{1}}-{{u}_{1r}}+{{x}_{4}}p+{{e}_{4}}{{u}_{0r}})+ \\ & {{k}_{1}}{{u}_{0r}}(-{{x}_{3}}p-{{e}_{3}}{{u}_{0r}}+\alpha {{x}_{23}}p+\alpha {{e}_{23}}{{u}_{0r}})+ \\ & {{k}_{1}}{{e}_{1}}{{{\dot{u}}}_{0r}}]+\eta [({{u}_{2}}-{{u}_{2r}}-{{x}_{2}}p-{{e}_{2}}{{u}_{0r}})+ \\ & {{k}_{3}}{{u}_{0r}}({{x}_{1}}p+{{e}_{1}}{{u}_{0r}}+\alpha {{x}_{41}}p+\alpha {{e}_{41}}{{u}_{0r}})+ \\ & {{k}_{3}}{{e}_{3}}{{{\dot{u}}}_{0r}}]+p\dot{p}+\Lambda \tilde{\alpha }\overset{\cdot }{\mathop{{\tilde{\alpha }}}}\,= \\ & -{{k}_{1}}\alpha e_{1}^{2}u_{0r}^{2}-{{k}_{3}}\alpha e_{3}^{2}u_{0r}^{2}+p[{{k}_{0}}{{e}_{0}}-{{e}_{1}}{{x}_{3}}+ \\ & {{e}_{3}}{{x}_{1}}+\hat{\alpha }({{e}_{1}}{{x}_{23}}+{{e}_{3}}{{x}_{41}})+({{x}_{4}}\xi -{{x}_{2}}\eta )+ \\ & {{u}_{0r}}(-{{k}_{1}}{{x}_{3}}\xi +{{k}_{3}}{{x}_{1}}\eta )+\hat{\alpha }{{u}_{0r}}({{k}_{1}}{{x}_{23}}\xi +{{k}_{3}}{{x}_{41}}\eta )+\dot{p}]+ \\ & \tilde{\alpha }[({{e}_{1}}{{x}_{23}}+{{e}_{3}}{{x}_{41}})p+{{u}_{0r}}({{e}_{1}}\xi +{{e}_{3}}\eta )+ \\ & {{u}_{0r}}p({{k}_{1}}{{x}_{23}}\xi +{{k}_{3}}{{x}_{41}}\eta )+u_{0r}^{2}({{k}_{1}}{{e}_{23}}\xi +{{k}_{3}}{{e}_{41}}\eta )- \\ & \Lambda \dot{\hat{\alpha }}]+\xi ({{u}_{1}}-{{u}_{1r}}+{{e}_{4}}{{u}_{0r}}+\hat{\alpha }{{e}_{1}}{{u}_{0r}}- \\ & {{k}_{1}}{{e}_{3}}u_{0r}^{2}+{{k}_{1}}\hat{\alpha }{{e}_{23}}u_{0r}^{2}+{{k}_{1}}{{e}_{1}}{{{\dot{u}}}_{0r}})+ \\ & \eta ({{u}_{2}}-{{u}_{2r}}-{{e}_{2}}{{u}_{0r}}+\hat{\alpha }{{e}_{3}}{{u}_{0r}}+ \\ & {{k}_{3}}{{e}_{1}}u_{0r}^{2}+{{k}_{3}}\hat{\alpha }{{e}_{41}}u_{0r}^{2}+{{k}_{3}}{{e}_{3}}{{{\dot{u}}}_{0r}}) \\ \end{align} $
where $\alpha$ is a constant and $\dot{\tilde{\alpha}}=-\dot{\hat{\alpha}}$.
Take the adaptive law and dynamic feedback controller as follows
$ \begin{align} \begin{cases} \dot{\hat{\alpha}}=\Lambda^{-1}[(e_{1}x_{23}+e_{3}x_{41})p+u_{0r}(e_{1}\xi+e_{3}\eta) +\\ ~~~~~~u_{0r}p(k_{1}x_{23}\xi+ k_{3}x_{41}\eta) +\\ ~~~~~~u^{2}_{0r}(k_{1} e_{23}\xi+k_{3}e_{41}\eta)]\\ \dot{p}=-k_{5}p-k_{0}e_{0}+e_{1}x_{3}-e_{3}x_{1} -\\ ~~~~~~\hat{\alpha }(e_{1}x_{23}+ e_{3}x_{41})-(x_{4}\xi - x_{2}\eta) -\\ ~~~~~~u_{0r}(-k_{1} x_{3}\xi+k_{3}x_{1}\eta) -\hat{\alpha}u_{0r}(k_{1}x_{23}\xi +k_{3}x_{41}\eta ) \end{cases} \label{a7} \end{align} $
(18) $ \begin{align} \begin{cases} u_{0}=u_{0r}+p\\ u_{1}=-k_{2}\xi+u_{1r}-e_{4}u_{0r}-\hat{\alpha}e_{1}u_{0r}+k_{1}e_{3}u^{2}_{0r} -\\ ~~~~~~~ k_{1}\hat{\alpha}e_{23}u^{2}_{0r}-k_{1}e_{1}\dot{u}_{0r} \\ u_{2}=-k_{4}\eta+u_{2r}+e_{2}u_{0r}-\hat{\alpha}e_{3}u_{0r}-k_{3}e_{1}u^{2}_{0r} -\\ ~~~~~~~ k_{3}\hat{\alpha}e_{41}u^{2}_{0r}-k_{3}e_{3}\dot{u}_{0r} \end{cases} \label{a8} \end{align} $
(19) One obtains
$ \begin{equation} \dot{V}=-k_{1}\alpha e^{2}_{1}u^{2}_{0r}-k_{3}\alpha e^{3}_{3}u^{2}_{0r}-k_{2}\xi^{2}-k_{4}\eta^{2}-k_{5}p^{2} \label{a112} \end{equation} $
(20) where ${{k}_{i}}(i=1,2,3,4,5)$ are positive constant control gains.
Now, in order to prove the convergence of ${{e}_{i}}(i=0,1,2,3,4)$, an important lemma is introduced as follows. It is called "the extended Barbalat theorem". Its proof was given in [23].
Lemma 1. If the differentiable function $f(t)$ has a finite limit as $t\rightarrow\infty$, and $\dot{f}(t)$ can be divided into two parts, one is uniformly continuous and the other is convergent to zero as $t\rightarrow\infty$, then $\dot{f}(t)\rightarrow0$, and the part of the uniform continuity tends to zero, too[23].
Theorem 1. Under Assumptions 1~3, the adaptive law (18) and dynamic feedback controller (19) can guarantee that all the variables of the closed-loop system (15), (18) and (19) are bounded. In addition, $p$ and kinematic tracking errors ${{e}_{i}}(i=0,1,2,3,4)$ asymptotically converge to zero.
Proof. Considering (17), (20) and Assumptions 1~3, we find that the Lyapunov function $V(t)$ is nonincreasing and converges to a limiting value $(\text{lim}V(t)\ge 0)$. This means that ${{e}_{1}},{{e}_{3}},\xi ,\eta $ and $p$ are all bounded. Then, $e_{2}$, $e_{4}$ are all bounded too by using (16). ${{x}_{i}}(i=1,2,3,4)$ are bounded further by Assumption 3. In view of (15), (18) and (19) again, we have ${{\dot{e}}_{i}}(i=0,1,2,3),\dot{\xi },\dot{\eta },\dot{p},{{u}_{0}},{{u}_{1}},{{u}_{2}}$ and $\ddot{V}$ are all bounded too. So, $\dot{V}$ is uniformly continuous. By using Lemma 1, we obtain that $\dot{V}$ tends to zero and
$ \lim\limits_{t\rightarrow\infty} (e_{1}u_{0r}, e_{3}u_{0r}, \xi, \eta, p)=\textbf{0} $
Consider that $u_{0r}$ is bounded and $u_{0r}\neq0$ in Assumption 3. We have $(e_{1},e_{3})\rightarrow\textbf{0}$ as $t\rightarrow\infty$. By the definitions of $\xi$ and $\eta$, one obtains $(e_{2},e_{4})\rightarrow\textbf{0}$ as $t\rightarrow\infty$. Using the Extended Barbalat Theorem in Lemma 1 on the second equation of (18), we have $\dot{p}\rightarrow0$ and $ k_{0}e_{0}\rightarrow0$ where $k_{0}$ is a bounded control gain. Hence, we have $e_{i}\rightarrow0$ $(i= 0,1$,$2,3,4)$ asymptotically as $t\rightarrow\infty$. $\square$
Remark 6. For the uncertain chained system (12), the tracking problem can be solved by using the control law $u_{0}$, $u_{1}$ and $u_{2}$. However, in practice, the controllers usually are $v_{1}$, $v_{2}$ and $v_{3}$ in the robot running place for (1) or (8). By using (8) and (10), they can be deduced as follows.
$ \begin{align} \begin{cases} v_{1}=\frac{u_{0}}{\sin(\beta_{2}-\beta_{1})}\\ v_{2}=\frac{[u_{2}\sin\beta_{1}-u_{1}\cos\beta_{1}-(x_{2}\sin\beta_{1}+x_{4}\cos\beta_{1})u_{0}]\sin(\beta_{2}-\beta_{1})}{2L\sin\beta_{2}}\\ v_{3}=\frac{[u_{2}\sin\beta_{2}-u_{1}\cos\beta_{2}-(x_{2}\sin\beta_{2}+x_{4}\cos\beta_{2})u_{0}]\sin(\beta_{2}-\beta_{1})}{2L\sin\beta_{1}}\\ \dot{\beta}_{1}=v_{2}\\ \dot{\beta}_{2}=v_{3} \end{cases}\label{600} \end{align} $
(21) Theorem 2. Under the Assumptions 1~3, $e_{i}\rightarrow 0$ $(i=0,1,2,3,4)$ ensure the trajectory $(x,y,\theta)$ of type (1, 2) mobile robot in the task-place tracking the reference trajectory $(x_{r},y_{r},\theta_{r})$ by using the controllers (18) and (19), or using control law (18), (19) and (21).
Proof. For (10), we have
$ \begin{align} {\small \begin{cases} x_{0r}=\theta_{r} \\ x_{1r}=x_{mr}\cos \theta_{r} +y_{mr}\sin \theta_{r}\\ x_{2r}=-x_{mr}\sin \theta_{r}+y_{mr}\cos \theta_{r}-2L\displaystyle\frac{\sin \beta _{1r}\sin \beta _{2r}}{\sin (\beta _{2r}-\beta _{1r})} \\ x_{3r}=x_{mr}\sin \theta_{r} -y_{mr}\cos \theta_{r} \\ x_{4r}=x_{mr}\cos \theta_{r} +y_{mr}\sin \theta_{r}-L\displaystyle\frac{\sin (\beta _{1r}+\beta _{2r})}{ \sin (\beta_{2r}-\beta _{1r})}\\ u_{0r}=v_{1r}\sin(\beta_{2r}-\beta_{1r}) \\ u_{1r}=-x_{4r}v_{1r}\sin (\beta _{2r}-\beta _{1r}) -\\ ~~~~~~~~ \displaystyle\frac{2Lv_{2r}\sin ^{2}\beta _{2r}}{\sin ^{2}(\beta _{2r}-\beta _{1r})}+\displaystyle\frac{2Lv_{3r}\sin ^{2}\beta _{1r}}{\sin ^{2}(\beta _{2r}-\beta _{1r})} \\ u_{2r}=x_{2r}v_{1r}\sin (\beta _{2r}-\beta _{1r}) -\\ ~~~~~~~~ \displaystyle\frac{Lv_{2r}\sin (2\beta _{2r})}{\sin ^{2}(\beta _{2r}-\beta _{1r})}+\displaystyle\frac{Lv_{3r}\sin (2\beta _{1r})}{\sin ^{2}(\beta _{2r}-\beta _{1r})} \end{cases} \label{h71}} \end{align} $
(22) Considering (4), we have
$ \begin{equation} \left[ \begin{array}{c} x_{mr} \\ y_{mr} \end{array} \right] =\alpha H(\theta_{0}) \left[\left[ \begin{array}{c} x_{r} \\ y_{r} \end{array} \right] -\left[ \begin{array}{c} c_{x} \\ c_{y} \end{array} \right] \right] +\left[ \begin{array}{c} O_{c1} \\ O_{c2} \end{array} \right] \label{h91} \end{equation} $
(23) Equation (4) minus (23) gives
$ \begin{equation} \left[ \begin{array}{c} x-x_{r} \\ y-y_{r} \end{array} \right] =\alpha^{-1}H^{-1}(\theta_{0}) \left[ \begin{array}{c} x_{m}-x_{mr} \\ y_{m}-y_{mr} \end{array} \right] \label{h92} \end{equation} $
(24) where $H^{-1}(\theta_{0})=H^{\rm T}(\theta_{0})$.
Consider the second and forth equations in (10). We have
$\left[ \begin{matrix} {{x}_{m}} \\ {{y}_{m}} \\ \end{matrix} \right]=\left[ \begin{matrix} \cos \theta & \sin \theta \\ \sin \theta & -\cos \theta \\ \end{matrix} \right]\left[ \begin{matrix} {{x}_{1}} \\ {{x}_{3}} \\ \end{matrix} \right]$
(25) $\left[ \begin{matrix} {{x}_{mr}} \\ {{y}_{mr}} \\ \end{matrix} \right]=\left[ \begin{matrix} \cos {{\theta }_{r}} & \sin {{\theta }_{r}} \\ \sin {{\theta }_{r}} & -\cos {{\theta }_{r}} \\ \end{matrix} \right]\left[ \begin{matrix} {{x}_{1r}} \\ {{x}_{3r}} \\ \end{matrix} \right]$
(26) It is obvious that
$ \begin{equation} \left[ \begin{array}{c} x_{1} \\ x_{3} \end{array} \right] =\left[ \begin{array}{c} x_{1r}+e_{1} \\ x_{3r}+e_{3} \end{array} \right]=\left[ \begin{array}{c} x_{1r} \\ x_{3r} \end{array} \right]+\left[ \begin{array}{c} e_{1} \\ e_{3} \end{array} \right] \label{h95} \end{equation} $
(27) Substracting (26) from (25), we obtain the following relationship
$ \left[ \begin{matrix} {{x}_{m}}-{{x}_{mr}} \\ {{y}_{m}}-{{y}_{mr}} \\ \end{matrix} \right]=\left[ \begin{matrix} {{e}_{1}}\cos \theta +{{e}_{3}}\sin \theta \\ {{e}_{3}}\sin \theta -{{e}_{3}}\cos \theta \\ \end{matrix} \right]+2\sin \frac{{{e}_{0}}}{2}\left[ \begin{matrix} -{{x}_{1r}}\sin \left( {{\theta }_{r}}+\frac{{{e}_{0}}}{2} \right)+{{x}_{3r}}\cos \left( {{\theta }_{r}}+\frac{{{e}_{0}}}{2} \right) \\ {{x}_{1r}}\cos \left( {{\theta }_{r}}+\frac{{{e}_{0}}}{2} \right)+{{x}_{3r}}\sin \left( {{\theta }_{r}}+\frac{{{e}_{0}}}{2} \right) \\ \end{matrix} \right] $
(28) Then, for (24), we have
$ \begin{align} &\left[ \begin{array}{l} x-x_{r} \\ y-y_{r} \end{array} \right] =\displaystyle\frac{1}{\alpha}\left[ \begin{array}{c} e_{1}\cos(\theta-\theta_{0})+e_{3}\sin(\theta-\theta_{0}) \\ e_{1}\sin(\theta-\theta_{0})-e_{3}\cos(\theta-\theta_{0}) \end{array} \right]+\notag\\ &\ \ \displaystyle\frac{2}{\alpha}\sin\displaystyle\frac{e_{0}}{2}\left[\!\!\! \begin{array}{c} -x_{1r}\sin\left(\theta-\theta_{0}-\frac{e_{0}}{2}\right) + x_{3r}\cos\left(\theta-\theta_{0}-\frac{e_{0}}{2}\right)\\ x_{1r}\cos\left(\theta-\theta_{0}-\frac{e_{0}}{2}\right)+ x_{3r}\sin\left(\theta-\theta_{0}-\frac{e_{0}}{2}\right) \end{array} \!\!\!\right] \label{h98}\notag\\ \end{align} $
(29) Note that $\theta=x_{0}=x_{0r}+e_{0}=\theta_{r}+e_{0}$. Then, we have $\theta \to {{\theta }_{r}}$, $\sin\frac{e_{0}}{2}\rightarrow0$ and $|\frac{2}{\alpha}\sin\frac{e_{0}}{2}|\leq\frac{|e_{0}|}{\underline{\alpha}}\rightarrow0$ because of ${{e}_{i}}\to 0(i=0,1,2,3)$. For $\sin(\theta_{r}+\frac{e_{0}}{2}) $, $\cos ({{\theta }_{r}}+\frac{{{e}_{0}}}{2}),{{x}_{1r}},{{x}_{3r}}$, $\cos(\theta-\theta_{0})$, $\sin(\theta-\theta_{0})$, $\sin(\theta-\theta_{0}-\frac{e_{0}}{2})$, $\cos(\theta-\theta_{0}-\frac{e_{0}}{2})$ are all bounded. Therefore, $(x_{m},y_{m})\rightarrow(x_{mr},y_{mr})$ and $(x,y)\to ({{x}_{r}},{{y}_{r}})$ by relationships (28) and (29). $\square$
To sum up, under the Assumptions 1~3, the trajectory $(x,y,\theta)$ for type (1, 2) mobile robot in the task-space can track the reference trajectory of $(x_{r},y_{r},\theta_{r})$ by using controller (18), (19) and (21). Simulation results are addressed in the next section.
4. Simulation
In this section, the simulations have been implemented mainly for the states ${{e}_{i}}(i=0,1,2,3,4)$ of the error system (15), the adaptive law (18), the control law (19), the tracking errors $(e_{x_m},e_{y_m},e_{\theta_m})=(x_{m}-x_{mr},y_{m}-y_{mr},\theta_{m}-\theta_{mr})$ in the image frame, and the tracking errors $({{e}_{x}},{{e}_{y}},{{e}_{\theta }})=(x-{{x}_{r}},y-{{y}_{r}},\theta -{{\theta }_{r}})$ in the task-space for type (1, 2) mobile robot. Two cases are considered for the different choices of the bounded control gains ${{k}_{i}}(i=0,1,2,3,4,5)$. Given a sensor noise on the velocities, the tracking simulations results are also implemented and addressed in Case 3.
Case 1. Consider (12), (15), (18) and (19). Then, take the initial error value $[{{e}_{0}}(0),{{e}_{1}}(0),{{e}_{2}}(0),{{e}_{3}}(0),{{e}_{4}}(0)]=[0.2,0.4,0.1,-0.2,0]$ for the configuration of (15). Further, choose the parameters as ${{\theta }_{0}}=\pi /3,{{u}_{0r}}=0.1,{{u}_{1r}}=1,{{u}_{2r}}=1.5,{{k}_{0}}=500,{{k}_{1}}=12,{{k}_{2}}=20,{{k}_{3}}=15,{{k}_{4}}=18,{{k}_{5}}=20$ and the control gain $\Lambda=1$. The trajectories of error states ${{e}_{i}}(i=0,1,2,3,4)$ and the control inputs ${{u}_{i}}(i=0,1,2)$ are plotted in Figs. 2~4 respectively. The estimates of the parameter $\hat{\alpha}$ and the dynamic feedback factor $p$ are plotted respectively in Figs. 5 and 6. In addition, the control laws ${{v}_{1}},{{v}_{2}}$ and $v_{3}$ in the task-space are also plotted in Figs. 7 and 8 by using (12), (15), (19) and (21).
Assume that the reference trajectory of the mobile robot in the image frame is chosen as $x_{mr}=2\cos\theta_{r}$, $y_{mr}=\sin\theta_{r}$. Then, $x_{1r}=\cos^{2}\theta_{r}$, $x_{3r}=\cos\theta_{r}\sin\theta_{r}$ by (22). The tracking error trajectories for $e_{x_m}=x_{m}-x_{mr}$, ${{e}_{{{y}_{m}}}}={{y}_{m}}-{{y}_{mr}}$ and $e_{\theta_m}=\theta_{m}-\theta_{mr}$ in the image space are presented in Fig. 9. By using (4), (10), (15)and (29), the tracking error trajectories for $e_x=x-x_{r}$, $e_y=y-y_{r}$ and ${{e}_{\theta }}=\theta -{{\theta }_{r}}$ in the robot work-space are addressed in Fig. 10.
Case 2. Given the initial error values $[{{e}_{0}}(0),{{e}_{1}}(0),{{e}_{2}}(0),{{e}_{3}}(0),{{e}_{4}}(0)]=[0.2,0.4,0.1,-0.2,0]$. Then, the parameters such as ${{\theta }_{0}},{{u}_{0r}},{{u}_{1r}},{{u}_{2r}},\alpha ,\Lambda $ and the reference trajectory of the mobile robot in the image frame are the same as in Case 1. However, choose ${{k}_{0}}=900,{{k}_{1}}=22,{{k}_{2}}=30,{{k}_{3}}=25,{{k}_{4}}=38$ and $k_{5}=50$. Then, ${{e}_{i}}(i=0,1,2,3,4)$ are plotted in Fig. 11. The tracking error trajectories for ${{e}_{{{x}_{m}}}},{{e}_{{{y}_{m}}}}$ and $e_{\theta_{m}}$ in the image space are presented in Fig. 12. The tracking error trajectories for ${{e}_{x}},{{e}_{y}}$ and $e_\theta$ in the robot work-space are addressed in Fig. 13.
Case 3. For the type (1, 2) mobile robot, assume ${{v}_{1}}={{v}_{2}}={{v}_{3}}=0$ in the initial state. The initial values for system (8) are $[{{x}_{m}}(0),{{y}_{m}}(0),\theta (0),{{\beta }_{1}}(0),{{\beta }_{2}}(0)]=[0,0,0,0.2,0.1]$. Given a sensor noise on the velocities $\Delta v_{1}=1$, $\Delta v_{2}=2$, $\Delta v_{3} = 1$. By using (8), we have $[x_{m},y_{m},\theta$, $\beta_{1},\beta_{2}]=[0.0165,0.0042,-0.0046,0.4,0.2]$ when $t_{0}=0.1$ s (without loss of generality, $t_{0}$ is a finite constant). Then, $[x_{0},x_{1},x_{2},x_{3},x_{4}] = [-0.046,0.0165,0.7831,0.0041,5.7007]$ by (10). Take the reference trajectories in the image space $x_{mr} = 2\cos\theta_{r}$, $y_{mr} =\sin\theta_{r}$. $\beta_{1r} = \theta_{r}$ and $\beta_{2r} =2\theta_{r}$. Considering (22), the reference states are $[{{x}_{0r}},{{x}_{1r}},{{x}_{2r}},{{x}_{3r}},{{x}_{4r}}]=[0.05,1.9975,0.1498,0.0499,7.9775]$ when $t_{0}=0.1$ s. So, at this moment, we get new initial values $[{{e}_{0}}({{t}_{0}}),{{e}_{1}}({{t}_{0}}),{{e}_{2}}({{t}_{0}}),{{e}_{3}}({{t}_{0}}),{{e}_{4}}({{t}_{0}})]=[-0.056,-1.9810,0.6333,-0.0458,-2.2096]$. Choose the controllers (18) and (19) where ${{k}_{0}}=1200,{{k}_{1}}=30,{{k}_{2}}=40,{{k}_{3}}=50,{{k}_{4}}=46$ and $k_{5}=100$. Then, ${{e}_{i}}(i=0,1,2,3,4)$ converge to zero asymptotically. The trajectories are plotted in Fig. 14. The tracking error trajectories for $e_{x_{m}}$, $e_{y_{m}}$ and $e_{\theta_{m}}$ in the image space are presented in Fig. 15. The tracking error trajectories for ${{e}_{x}},{{e}_{y}}$ and $e_{\theta}$ are addressed in the robot work-space in Fig. 16.
Remark 7. Comparing the tracking errors in Case 1 with those in Case 2, we find that the bigger gains ${{k}_{i}}(i=0,1,\cdots ,5)$ make the better convergence. However, they could not be big enough in the practice. Considering the tracking control problems in [16], an adaptive controller is designed to compensate for uncertain camera and mechanical parameters in the kinematic and dynamic systems for type (2, 0) mobile robot. The tracking errors for $X$-coordinate and $Y$-coordinate converged to zero within ten seconds. In our paper, two transformations are exploited based on the idea of backstepping with the help of camera-robot system. An adaptive control law and dynamic feedback robust controllers are designed to track the desired trajectory for the type (1, 2) robot by using Lyapunov direct method and the extended Barbalat Lemma. The tracking errors for $X$-coordinate and $Y$-coordinate can also converge to zero within 10 seconds (see Figs. 12 and 13). Simulation results (Figs. 2~13) demonstrate the feasibility of the proposed adaptive and dynamic feedback laws.
5. Conclusions and future work
Based on the visual servoing feedback and the transformations for the canonical chained form of type (1, 2) mobile robot, we present an uncertain chained model of nonholonomic kinematic system. Then an adaptive law and dynamic feedback controller has been proposed for the kinematic error system of the nonholonomic mobile robot. The asymptotical convergence of closed-loop error system is rigorously proved by Lyapunov stability theory and the extended Barbalat Lemma. Simulation results illustrate the performance of the proposed controller.
In this paper, the adaptive dynamic feedback tracking controller is investigated for known $\theta_{0}$, but $\alpha_{1}=\alpha_{2}=\alpha$ are unknown. As for other cases, such as ${{\theta }_{0}},{{\alpha }_{1}}$ and $\alpha_{2}$ all unknown, they will be dealt with in the future. In addition, dynamics tracking control problems with uncertain parameters are not neglected, and we will further investigate them.
-
-
[1] Kolmanovsky I, McClamroch N H. Developments in nonholonomic control problems. IEEE Control Systems Magazine, 1995, 15(6):20-36 http://cn.bing.com/academic/profile?id=2120944681&encoded=0&v=paper_preview&mkt=zh-cn [2] Wang C L. Semiglobal practical stabilization of nonholonomic wheeled mobile robots with saturated inputs. Automatica, 2008, 44(3):816-822 http://cn.bing.com/academic/profile?id=1967598091&encoded=0&v=paper_preview&mkt=zh-cn [3] Leroquais W, d'Andréa-Novel B. Transformation of the kinematic models of restricted mobility wheeled mobile robots with a single platform into chain forms. In:Proceedings of the 34th Conference on Decision and Control. New Orleans, LA:IEEE, 1995. 3811-3816 [4] Pang Hai-Long, Ma Bao-Li. Adaptive unified controller of arbitrary trajectory tracking for wheeled mobile robots with unknown parameters. Control Theory and Applications, 2014, 31(3):285-292(in Chinese) http://en.cnki.com.cn/Article_en/CJFDTOTAL-KZLY201403003.htm [5] Cao K C. Global κ-exponential tracking control of nonholonomic systems in chained-form by output feedback. Acta Automatica Sinica, 2009, 35(5):568-576 http://cn.bing.com/academic/profile?id=2145479289&encoded=0&v=paper_preview&mkt=zh-cn [6] Ma B L, Tso S K. Unified controller for both trajectory tracking and point regulation of second-order nonholonomic chained systems. Robotics and Autonomous Systems, 2008, 56(4):317-323 http://cn.bing.com/academic/profile?id=2038047332&encoded=0&v=paper_preview&mkt=zh-cn [7] Campion G, Bastin G, Dandrea-Novel B. Structural properties and classification of kinematic and dynamic models of wheeled mobile Robots. IEEE Transactions on Robotics and Automation, 1996, 12(1):47-62 http://cn.bing.com/academic/profile?id=2149012351&encoded=0&v=paper_preview&mkt=zh-cn [8] Jiang Z P. Robust exponential regulation of nonholonomic systems with uncertainties. Automatica, 2000, 36(2):189-209 http://cn.bing.com/academic/profile?id=2079519375&encoded=0&v=paper_preview&mkt=zh-cn [9] Ma Bao-Li. Robust smooth time-varying exponential stabilization of dynamic nonholonomic mobile cart with parameter uncertainties. Acta Automatica Sinica, 2005, 31(2):314-319(in Chinese) http://cn.bing.com/academic/profile?id=2380252068&encoded=0&v=paper_preview&mkt=zh-cn [10] Wang C L, Liang Z Y, Jia Q W. Dynamic feedback robust stabilization of nonholonomic mobile robots based on visual servoing. Journal of Control Theory and Applications, 2010, 8(2):139-144 http://cn.bing.com/academic/profile?id=2084185762&encoded=0&v=paper_preview&mkt=zh-cn [11] Liang Z Y, Wang C L. Robust stabilization of nonholonomic chained form systems with uncertainties. Acta Automatica Sinica, 2011, 37(2):129-142 http://cn.bing.com/academic/profile?id=2081318309&encoded=0&v=paper_preview&mkt=zh-cn [12] Dong W J. On trajectory and force tracking control of constrained mobile manipulators with parameter uncertainty. Automatica, 2002, 38(9):1475-1484 http://cn.bing.com/academic/profile?id=2093817182&encoded=0&v=paper_preview&mkt=zh-cn [13] Wang Y N, Peng J Z, Sun W, Yu H S, Zhang H. Robust adaptive tracking control of robotic systems with uncertainties. Journal of Control Theory and Applications, 2008, 6(3):281-286 http://cn.bing.com/academic/profile?id=1997765899&encoded=0&v=paper_preview&mkt=zh-cn [14] Allen P K, Timcenko A, Yoshimi B, Michelman P. Automated tracking and grasping of a moving object with a robotic hand-eye system. IEEE Transactions on Robotics and Automation, 1993, 9(2):152-165 http://cn.bing.com/academic/profile?id=2109618870&encoded=0&v=paper_preview&mkt=zh-cn [15] Do K D, Jiang Z P, Pan J. Simultaneous tracking and stabilization of mobile robots:an adaptive approach. IEEE Transactions on Automatic Control, 2004, 49(7):1147-1152 http://cn.bing.com/academic/profile?id=2128698518&encoded=0&v=paper_preview&mkt=zh-cn [16] Dixon W E, Dawson D M, Zergeroglu E, Behal A. Adaptive tracking control of a wheeled mobile robot via an uncalibrated camera system. IEEE Transactions on Systems, Man, and Cybernetics——Part B:Cybernetics, 2001, 31(3):341-352 http://cn.bing.com/academic/profile?id=2171694674&encoded=0&v=paper_preview&mkt=zh-cn [17] Jia Bing-Xi, Liu Shan, Zhang Kai-Xiang, Chen Jian. Survey on robot visual servo control:vision system and control strategies. Acta Automatica Sinica, 2015, 41(5):861-873(in Chinese) [18] Chen J, Dixon W E, Dawson M, McIntyre M. Homography-based visual servo tracking control of a wheeled mobile robot. IEEE Transactions on Robotics, 2006, 22(2):406-415 http://cn.bing.com/academic/profile?id=2097671019&encoded=0&v=paper_preview&mkt=zh-cn [19] Wang H S, Liu Y H, Zhou D X. Dynamic visual tracking for manipulators using an uncalibrated fixed camera. IEEE Transactions on Robotics, 2007, 23(3):610-617 http://cn.bing.com/academic/profile?id=2016213375&encoded=0&v=paper_preview&mkt=zh-cn [20] Wang C L, Mei Y C, Liang Z Y, Jia Q W. Dynamic feedback tracking control of non-holonomic mobile robots with unknown camera parameters. Transactions of the Institute of Measurement and Control, 2010, 32(2):155-169 http://cn.bing.com/academic/profile?id=2083474219&encoded=0&v=paper_preview&mkt=zh-cn [21] Yang F, Wang C L. Adaptive tracking control for dynamic nonholonomic mobile robots with uncalibrated camera parameters. In:Proceedings of the 8th Asian Control Conference. Kaohsiung, China:IEEE, 2011. 269-274 http://cn.bing.com/academic/profile?id=2141389837&encoded=0&v=paper_preview&mkt=zh-cn [22] Liang Z Y, Wang C L. Robust exponential stabilization of nonholonomic wheeled mobile robots with unknown visual parameters. Journal of Control Theory and Applications, 2011, 9(2):295-301 http://cn.bing.com/academic/profile?id=2061563135&encoded=0&v=paper_preview&mkt=zh-cn [23] Samson C. Control of chained systems application to path following and time-varying point-stabilization of mobile robots. IEEE Transactions on Automatic Control, 1995, 40(1):64-77 http://cn.bing.com/academic/profile?id=2127988032&encoded=0&v=paper_preview&mkt=zh-cn 期刊类型引用(3)
1. 董莉莉,梁振英,金增珂,徐玉镜. 不确定链式系统的动力学自适应跟踪控制. 控制工程. 2020(06): 962-970 . 百度学术
2. 王立玲,董力元,马东,刘秀玲,王洪瑞. 移动机器人速度饱和约束下的轨迹跟踪控制. 机床与液压. 2019(21): 1-4 . 百度学术
3. 陈志勇,张婷婷,郭益深. 弹性基和弹性关节空间机器人的自适应鲁棒抗扰控制及振动抑制. 自动化学报. 2018(07): 1271-1281 . 本站查看
其他类型引用(4)
-