Adaptive Jacobian Tracking Control of Robots With Uncertainties in Kinematic, Dynamic and Actuator Models

Similar documents
Adaptive Robust Tracking Control of Robot Manipulators in the Task-space under Uncertainties

Adaptive Tracking Control for Robots with Unknown Kinematic and Dynamic Properties

Observer Based Output Feedback Tracking Control of Robot Manipulators

458 IEEE TRANSACTIONS ON CONTROL SYSTEMS TECHNOLOGY, VOL. 16, NO. 3, MAY 2008

ADAPTIVE FORCE AND MOTION CONTROL OF ROBOT MANIPULATORS IN CONSTRAINED MOTION WITH DISTURBANCES

A composite adaptive output feedback tracking controller for robotic manipulators* E. Zergeroglu, W. Dixon, D. Haste, and D.

Tracking Control of Robot Manipulators with Bounded Torque Inputs* W.E. Dixon, M.S. de Queiroz, F. Zhang and D.M. Dawson

Exponential Controller for Robot Manipulators

Robot Manipulator Control. Hesheng Wang Dept. of Automation

A SIMPLE ITERATIVE SCHEME FOR LEARNING GRAVITY COMPENSATION IN ROBOT ARMS

Nonlinear PD Controllers with Gravity Compensation for Robot Manipulators

Force/Position Regulation for Robot Manipulators with. Unmeasurable Velocities and Uncertain Gravity. Antonio Loria and Romeo Ortega

OVER THE past 20 years, the control of mobile robots has

Robust Control of Cooperative Underactuated Manipulators

Adaptive set point control of robotic manipulators with amplitude limited control inputs* E. Zergeroglu, W. Dixon, A. Behal and D.

Case Study: The Pelican Prototype Robot

Control of a Handwriting Robot with DOF-Redundancy based on Feedback in Task-Coordinates

Robust Control of Robot Manipulator by Model Based Disturbance Attenuation

CONTROL OF ROBOT CAMERA SYSTEM WITH ACTUATOR S DYNAMICS TO TRACK MOVING OBJECT

A new large projection operator for the redundancy framework

A Sliding Mode Controller Using Neural Networks for Robot Manipulator

PERIODIC signals are commonly experienced in industrial

538 IEEE TRANSACTIONS ON SYSTEMS, MAN, AND CYBERNETICS PART B: CYBERNETICS, VOL. 32, NO. 4, AUGUST 2002

An Adaptive Full-State Feedback Controller for Bilateral Telerobotic Systems

Integrated Design and PD Control of High-Speed Closed-loop Mechanisms

Neural Network Control of Robot Manipulators and Nonlinear Systems

Adaptive Visual Tracking for Robotic Systems Without Image-Space Velocity Measurement

Task-space Adaptive Setpoint Control for Robots with Uncertain Kinematics and Actuator Model

Control of Robotic Manipulators with Input/Output Delays

WE PROPOSE a new approach to robust control of robot

Control of industrial robots. Centralized control

Adaptive Position and Orientation Regulation for the Camera-in-Hand Problem

THE robot is one of the choices for improving productivity

q 1 F m d p q 2 Figure 1: An automated crane with the relevant kinematic and dynamic definitions.

Nonlinear Tracking Control of Underactuated Surface Vessel

Lyapunov Stability of Linear Predictor Feedback for Distributed Input Delays

Video 8.1 Vijay Kumar. Property of University of Pennsylvania, Vijay Kumar

Model Reference Adaptive Control for Robot Tracking Problem: Design & Performance Analysis

Trigonometric Saturated Controller for Robot Manipulators

MCE/EEC 647/747: Robot Dynamics and Control. Lecture 12: Multivariable Control of Robotic Manipulators Part II

Delay-Independent Stabilization for Teleoperation with Time Varying Delay

Neural Network-Based Adaptive Control of Robotic Manipulator: Application to a Three Links Cylindrical Robot

Virtual Passive Controller for Robot Systems Using Joint Torque Sensors

An Adaptive Iterative Learning Control for Robot Manipulator in Task Space

Robust Adaptive Attitude Control of a Spacecraft

A Cascaded-Based Hybrid Position-Force Control for Robot Manipulators with Nonnegligible Dynamics

Tracking Control for Robot Manipulators with Kinematic and Dynamic Uncertainty

Design and Control of Variable Stiffness Actuation Systems

GAIN SCHEDULING CONTROL WITH MULTI-LOOP PID FOR 2- DOF ARM ROBOT TRAJECTORY CONTROL

Multi-Priority Cartesian Impedance Control

RBF Neural Network Adaptive Control for Space Robots without Speed Feedback Signal

NONLINEAR PATH CONTROL FOR A DIFFERENTIAL DRIVE MOBILE ROBOT

1348 IEEE TRANSACTIONS ON SYSTEMS, MAN, AND CYBERNETICS PART B: CYBERNETICS, VOL. 34, NO. 3, JUNE 2004

Natural and artificial constraints

STABILITY OF SECOND-ORDER ASYMMETRIC LINEAR MECHANICAL SYSTEMS WITH APPLICATION TO ROBOT GRASPING

Combined NN/RISE-based Asymptotic Tracking Control of a 3 DOF Robot Manipulator

Robotics 2 Robot Interaction with the Environment

Real-time Motion Control of a Nonholonomic Mobile Robot with Unknown Dynamics

Design and Stability Analysis of Single-Input Fuzzy Logic Controller

Global robust output feedback tracking control of robot manipulators* W. E. Dixon, E. Zergeroglu and D. M. Dawson

Stable Limit Cycle Generation for Underactuated Mechanical Systems, Application: Inertia Wheel Inverted Pendulum

Inverse differential kinematics Statics and force transformations

A Unified Quadratic-Programming-Based Dynamical System Approach to Joint Torque Optimization of Physically Constrained Redundant Manipulators

Lecture Schedule Week Date Lecture (M: 2:05p-3:50, 50-N202)

Dynamic Tracking Control of Uncertain Nonholonomic Mobile Robots

Adaptive servo visual robot control

Robust Adaptive Control of Nonholonomic Mobile Robot With Parameter and Nonparameter Uncertainties

Force Tracking Impedance Control with Variable Target Stiffness

THE control of systems with uncertain nonlinear dynamics

Adaptive Vision and Force Tracking Control for Robots With Constraint Uncertainty

A Backstepping control strategy for constrained tendon driven robotic finger

Force/Impedance Control for Robotic Manipulators

Vehicle Dynamics of Redundant Mobile Robots with Powered Caster Wheels

BACKSTEPPING-BASED HYBRID ADAPTIVE CONTROL OF ROBOT MANIPULATORS INCORPORATING ACTUATOR DYNAMICS

q HYBRID CONTROL FOR BALANCE 0.5 Position: q (radian) q Time: t (seconds) q1 err (radian)

Unit Quaternion-Based Output Feedback for the Attitude Tracking Problem

H State-Feedback Controller Design for Discrete-Time Fuzzy Systems Using Fuzzy Weighting-Dependent Lyapunov Functions

Linköping University Electronic Press

Trajectory Tracking Control of a Very Flexible Robot Using a Feedback Linearization Controller and a Nonlinear Observer

STABILITY OF HYBRID POSITION/FORCE CONTROL APPLIED TO MANIPULATORS WITH FLEXIBLE JOINTS

IN recent years, controller design for systems having complex

(W: 12:05-1:50, 50-N202)

Design Artificial Nonlinear Controller Based on Computed Torque like Controller with Tunable Gain

FINITE TIME CONTROL FOR ROBOT MANIPULATORS 1. Yiguang Hong Λ Yangsheng Xu ΛΛ Jie Huang ΛΛ

Lecture «Robot Dynamics»: Dynamics 2

Analytic Nonlinear Inverse-Optimal Control for Euler Lagrange System

Lecture «Robot Dynamics»: Dynamics and Control

Adaptive Control of a Class of Nonlinear Systems with Nonlinearly Parameterized Fuzzy Approximators

The Rationale for Second Level Adaptation

Stability Analysis and Robust PID Control of Cable-Driven Robots Considering Elasticity in Cables

MCE493/593 and EEC492/592 Prosthesis Design and Control

Adaptive and Robust Controls of Uncertain Systems With Nonlinear Parameterization

A Nonlinear Disturbance Observer for Robotic Manipulators

Gain Scheduling Control with Multi-loop PID for 2-DOF Arm Robot Trajectory Control

Control of Mobile Robots

NEURAL NETWORKS (NNs) play an important role in

Robot Dynamics II: Trajectories & Motion

TODAY, the developments in technology and the requirements

Operational Space Control of Constrained and Underactuated Systems

Passivity-based Control of Euler-Lagrange Systems

Transcription:

104 IEEE TRANSACTIONS ON AUTOMATIC CONTROL, VOL. 51, NO. 6, JUNE 006 Adaptive Jacobian Tracking Control of Robots With Uncertainties in Kinematic, Dynamic and Actuator Models C. C. Cheah, C. Liu, and J. J. E. Slotine Abstract Most research so far on robot trajectory control has assumed that the kinematics of the robot is known exactly. However, when a robot picks up tools of uncertain lengths, orientations, or gripping points, the overall kinematics becomes uncertain and changes according to different tasks. Recently, we derived a new adaptive Jacobian tracking controller for robots with uncertain kinematics and dynamics. This note extends the results to include redundant robots and adaptation to actuator parameters. Experimental results are presented to illustrate the performance of the proposed controller. Index Terms Actuator model, adaptive control, dynamics, robot kinematics, tracking control, uncertainty. I. INTRODUCTION Robot manipulators are required to handle various tools and, hence, the dynamic parameters of the robots vary during operation and are difficult to be predicted in advance. By exploring physical properties of the robot system, Takegaki and Arimoto [1] and Arimoto [] showed using Lyapunov s method that simple controllers such as the proportional-derivative (PD) and proportional integral-derivative (PID) feedback are effective for setpoint control despite the nonlinearity and uncertainty of the robot dynamics. To deal with trajectory tracking control, several adaptive robot control laws have been proposed and much progress has been obtained in respect to understanding how the robot can track a desired trajectory in the presence of uncertain dynamic parameters [3] [17]. However, most research on robot control has assumed that the exact kinematics and Jacobian matrix of the manipulator from joint space to Cartesian space are known. This assumption leads us to several open problems in the development of robot control laws today. In free motion [18], this implies that the exact lengths of the links, joint offsets and the object which the robot is holding, must be known. Unfortunately, no physical parameters can be derived exactly. Moreover, when the robot picks up objects or tools of different lengths, unknown orientations and gripping points, the overall kinematics are changing and, therefore, difficult to derive exactly. Therefore, the robot is not able to manipulate the tool to a desired position if the length or gripping point of the tool is uncertain. When the control problem is extended to the control of multifingered robot hands [19], such assumption also limits its potential applications because the kinematics is uncertain in many applications of robot hands. For example, the contact points of the robot fingers are uncertain and changing during manipulation. Similarly, in hybrid position force control [0], the assumption of exact kinematics also leads us to an open problem on how to control the robot if the kinematics and constraint are uncertain. To overcome the problem of uncertain kinematics, several approximate Jacobian setpoint controllers [1] [3] were proposed recently. The proposed controllers do not require the exact knowledge of kinematics and Jacobian matrix that is assumed in the literature of robot control. Using the approximate Jacobian control approach, other open problems such as force control with uncertainties [4] and control of robot fingers with uncertain contact points [5] can be resolved in a unified formulation. However, the results in [1] [3] are focusing on setpoint control of robot. In some applications, it is necessary to specify the motion in much more details than simply stating the desired final position. Thus, a desired trajectory should be specified. Recently, an adaptive Jacobian controller was proposed for trajectory tracking control of robot manipulators [6], [7]. The controller does not require the exact knowledge of kinematics and Jacobian matrix that is assumed in the literature of tracking control. However, it is assumed in [6] and [7] that the actuator model is known exactly. Since the actuator model may be uncertain in practice, calibration is necessary to identify the exact parameters of the actuator in implementing the robot controllers. In addition, the actuator parameters could change as temperature varies due to overheating of motor or changes in ambient temperature. Hence, in the presence of the modeling uncertainty or calibration error, the convergence of the tracking error may not be guaranteed. This note extends the algorithm of [6] to include redundant robots and adaptation to actuator parameters. A new adaptive Jacobian controller is proposed for trajectory tracking of robot with uncertain kinematics, dynamics and actuator model. Experimental results are presented to illustrate the performance of the proposed controller. II. ROBOT DYNAMICS AND KINEMATICS If a direct current (dc) motor driven by an amplifier is used as actuator at each joint of the robot, the dynamics of the robot with n degree of degrees of freedom can be expressed as [], [8] M (q)q + B + 1 M _ (q) +S(q; _q) _q + g(q) =Ku (1) where M (q) R nn is the inertia matrix, B R nn is a matrix of damping coefficients, u R n is either a voltage or current inputs to the amplifiers, K R nn is a diagonal transmission matrix that relates the actuator input u to the control torque S(q; _q)_q = 1 _M (q)_q 0 1 @ @q _qt M (q)_q and g(q) R n is the gravitational force. Several important properties of the dynamic equation described by (1) are given as follows [], [4], [8], [9]. Property 1: The inertia matrix M (q) is symmetric and uniformly positive definite for all q R n. Property : The matrix S(q; _q) is skew-symmetric so that T S(q; _q) =0for all R n. Property 3: The dynamic model as described by (1) is linear in a set of physical parameters d =( d1 ; 111; dp ) T as T Manuscript received October 1, 004; revised July 5, 005 and November 30, 005. Recommended by Associate Editor F. Bullo. C. C. Cheah and C. Liu are with School of Electrical and Electronic Engineering, Nanyang Technological University, Singapore 639798, Republic of Singapore (e-mail: ECCCheah@ntu.edu.sg). J. J. E. Slotine is with Nonlinear Systems Laboratory, Massachusetts Institute of Technology, Cambridge, MA 0139 USA (e-mail: jjs@mit.edu). M (q)q + B + 1 M _ (q) +S(q; _q) _q + g(q) =Y d (q; _q; _q; q) d where Y d (1) R np is called the dynamic regressor matrix. } In most applications of robot manipulators, a desired path for the end-effector is specified in task space or operation space such as Carte- 0018-986/$0.00 006 IEEE

IEEE TRANSACTIONS ON AUTOMATIC CONTROL, VOL. 51, NO. 6, JUNE 006 105 sian space or visual space [], [1], [30]. Let x R m be a task space vector defined by x = h(q) where m n, h(1) R m is a transformation describing the relation between the joint space and task space. The task-space velocity _x is related to joint-space velocity _q as _x = J(q)_q () where J(q) R mn is the Jacobian matrix from joint space to task space. If cameras are used to monitor the position of the end-effector, the task space is defined as image space in pixels. Let r represent the position of the end-effector in Cartesian coordinates and x represent the vector of image feature parameters [3]. The image velocity vector _x is related to the joint velocity vector _q as [3] _x = J I (r)je(q)_q where J I (r) is the image Jacobian matrix [3] and J e (q) is the manipulator Jacobian matrix of the mapping from joint space to Cartesian space. In the presence of uncertainties in the camera parameters, the exact image Jacobian matrix and the manipulator Jacobian matrix cannot be obtained. If a position sensor is used to monitor the position of the end-effector, the task space is defined as Cartesian space and, hence, J(q) =J e (q) where J e (q) is the manipulator Jacobian. A property of the kinematic equation described by () is stated as follows [6]. Property 4: The right hand side of () is linear in a set of kinematic parameters k =( k1 ; 111; kq ) T, such as link lengths and joint offsets. Hence, () can be expressed as _x = J(q)_q = Y k (q; _q) k (3) where Y k (q; _q) R mq is called the kinematic regressor matrix. } Remark 1: In the presence of kinematic uncertainty, inverse kinematics cannot be used to derive the desired trajectory in joint space. In addition, when the dynamics equation is expressed in task space by using () and its derivative, we have where l 1 and l are the link lengths, l 0 and q 0 are the length and grasping angle of the object, respectively, s 1 = sin(q 1 ), s 1 = sin(q 1 + q ), s 1o = sin(q 1 + q + q o ), c 1 = cos(q 1 ), c 1 = cos(q 1 + q ), and c 1o = cos(q1 + q + q o). In presence of kinematic uncertainty, the parameters l 1, l, l o, and q 0 are unknown. The inverse Jacobian matrix J 01 (q) can be obtained as J 01 1 (q) = l 1 l s + l 1 l o s o l c 1 + l oc 1o l s 1 + l os 1o 0(l 1 c 1 + l c 1 + l o c 1o ) 0(l 1 s 1 + l s 1 + l o s 1o ) which is nonlinear in the unknown parameters l 1, l, l o, and q 0. Therefore, the standard adaptive controller by Slotine and Li [4] cannot be applied directly to overcome the uncertainty in both kinematics and dynamics. Hence, in the presence of kinematic uncertainty, the adaptive method [4] results in tracking error or even unstable response in the end-effector s motion. The nonlinearity and uncertainty of the robot kinematics pose a difficult and challenging adaptive tracking control problem which remains unsolved for almost two decades. III. ADAPTIVE JACOBIAN TRACKING CONTROL In this section, we present an adaptive Jacobian tracking controller for robot with uncertain kinematics, dynamics, and actuator model. The main idea of the derivation is to introduce an adaptive sliding vector based on estimated task-space velocity, so that kinematic, dynamic, and actuator adaptation can be performed concurrently. In the presence of kinematic uncertainty, the parameters of the Jacobian matrix is uncertain and, hence, (3) can be expressed as ^_x = ^J(q; ^ k )_q = Y k (q; _q)^ k (4) where ^_x R m denotes an estimated task-space velocity, ^J(q; ^ k ) R mn is an approximate Jacobian matrix, and ^ k R q denotes a set of estimated kinematic parameters. Let us define a vector _x r R m as _x r = _x d 0 (x 0 x d ) (5) where x d R m is a desired trajectory, _x d = dx d =dt R m is the desired velocity specified in task space, and is a positive constant. Differentiating (5) with respect to time, we have M (q)j 01 (q)x + 0M (q)j 01 (q) J(q)+B _ + 1 M _ (q)+s(q; _q) x r =xd 0 (_x 0 _x d ) (6) J 01 (q)_x+g(q) =Ku: The aforementioned equation cannot be expressed in a form as in Property 3 because J 01 (q) is not linear in the unknown kinematic parameters. In addition, the mapping between force and torque using Jacobian transpose is also uncertain due to the unknown kinematic parameters. For example, for a two link nonredundant robot holding an object, the Jacobian matrix J(q) from joint space to Cartesian space can be derived as 0(l 1s 1 + l s 1 + l o s 1o ) 0(l s 1 + l o s 1o ) J(q) = l 1 c 1 + l c 1 + l o c 1o l c 1 + l o c 1o where x d = d _x d =dt R m is the desired acceleration in task space. Next, define an adaptive task-space sliding vector using (4) as ^s x = ^_x 0 _xr = ^J(q; ^ k )_q 0 _x r (7) where ^J(q; ^ k )_q = Y k (q; _q)^ k as indicated in (4). The above vector is adaptive in the sense that the parameters of the approximate Jacobian matrix is updated by a parameter update law (18). Differentiating (7) with respect to time, we have _^s x = ^x 0 x r = ^J(q; ^ k )q + _^J(q; ^ k )_q 0 x r (8)

106 IEEE TRANSACTIONS ON AUTOMATIC CONTROL, VOL. 51, NO. 6, JUNE 006 where ^x denotes the derivative of ^_x. In the redundant case, the null space of the approximate Jacobian matrix can be used to minimize a performance index [13], [31]. Next, let where 1x = x 0 x d, 1_x = _x 0 _x d, and K v R mm and K p R mm are symmetric positive definite gain matrices, ii) a dynamic adaptation law _q r = ^J + (q; ^ k )_x r + I n 0 ^J + (q; ^ k ) ^J(q; ^ k ) (9) where ^J + (q; ^ k )= ^J T (q; ^ k )( ^J(q; ^ k ) ^J T (q; ^ k )) 01 is the generalized inverse of the approximate Jacobian matrix, and R n is minus the gradient of the convex function to be optimized. In this note, we assume that the robot is operating in a finite task space such that the approximate Jacobian matrix is of full rank. From (9), we have iii) a kinematic adaptation law _^ d = 0L d Y T d (q; _q; _q r; q r)s (17) _^ k = L k Y T k (q; _q)(k v1_x + K p1x) (18) and iv) an actuator adaptation law q r = ^J + (q; ^ k )x r + _^J + (q; ^ k )_x r + I n 0 ^J + (q; ^ k ) ^J(q; ^ k ) _ 0 _^J + (q; ^ k ) ^J(q; ^ k ) 0 ^J + (q; ^ k ) _^J(q; ^k ) : (10) and Hence, we have an adaptive sliding vector in joint space as From (9) and (11), we note that s = _q 0 _q r (11) _s =q 0 q r: (1) ^J(q; ^ k )s =(^_x 0 _x d )+(x 0 x d )=^s x: (13) Substituting (11) and (1) into (1), the equations of motion can be expressed as M (q)_s + B + 1 M _ (q)+s(q; _q) s + M (q)q r + B + 1 _M (q)+s(q; _q) _q r + g(q) =Ku: (14) From Property 3, the last five terms of (14) are linear in a set of dynamics parameters d and, hence, can be expressed as _ ^ a = 0L a Y a ( o )s (19) where L k R qq and L d R pp are symmetric positive definite matrices, L a R nn is a positive definite and diagonal matrix, Y a ( o )=diagf0 o1 ; 0 o ;...; 0 on g, and oi denotes the ith element of the vector o which is defined as o = ^J T (q; ^ k )(K v 1_x + K p 1x) 0 Y d (q; _q; _q r ; q r )^ d : (0) In the adaptive control law (16), a constant ^K01 is used to transform the control torque to an approximate actuator input. The first term is an approximate Jacobian transpose feedback law of the task-space velocity and position errors; the second term is an estimated dynamic compensation term; and the last term is used to compensate for the uncertainty introduced by the constant estimated transmission matrix ^K. The estimated dynamic parameters ^ d is updated using (17), and the estimated kinematic parameters ^ k of the approximate Jacobian matrix ^J(q; ^ k ) is updated using (18). The linear parameterization of the kinematic parameters is obtained from (3). The key novelties are that the algorithm is now augmented by a kinematic adaptation law (18) and an actuator adaptation law (19) and that a specific choice of _q r is exploited throughout. In the proposed controller, x is measured from a position sensor. Many commercial sensors are available for measurement of x, such as vision systems, electromagnetic measurement systems, position sensitive detectors, or laser trackers. The closed-loop dynamics is obtained by substituting (16) into (15) to give M (q)_s + B + 1 M _ (q)+s(q; _q) s + Y d (q; _q; _q r; q r)1 d M (q)q r + B+ 1 _M (q)+s(q; _q) so the dynamic (14) can be written as _q r + g(q)=y d (q; _q; _q r; q r) d M (q)_s + B + 1 M _ (q)+s(q; _q) s + Y d (q; _q; _q r ; q r ) d = Ku: (15) The algorithm we will now derive is composed of i) a control law based on an approximate transmission matrix ^K R nn as u = 0 ^K 01 ^JT (q; ^k )(K v 1_x + K p 1x) + ^K 01 Y d (q; _q; _q r; q r)^ d + ^K 01 Y a( o)^ a (16) + ^J T (q; ^ k )(K v1_x + K p1x) +(K ^K 01 0 I) o 0 K ^K 01 Y a ( o )^ a =0 (1) where o is defined in (0) and 1 d = d 0 ^ d. The estimated kinematic parameters ^ k of the approximate Jacobian matrix ^J(q; ^ k ) is updated by the parameter update (18) and then used in the inverse approximate Jacobian matrix ^J + (q; ^ k ), _q r, and q r in the dynamic regressor matrix. Note that ^ k (like q and _q) is just part of the states of the adaptive control system and, hence, can be used in the control variables even if it is nonlinear in the variables (provided that a linear parameterization can be found elsewhere in the system model i.e., (3)). Since ^J(q; ^ k ) and its inverse ^J + (q; ^ k ) are updated by q and ^ k, _^J(q; ^k ) and _^J + (q; ^ k ) are functions of q, _q, ^ k, 1x, and 1_x because _^k is described by (18).

IEEE TRANSACTIONS ON AUTOMATIC CONTROL, VOL. 51, NO. 6, JUNE 006 107 Since K, ^K, and Y a( o) are diagonal matrices, the last two terms of (1) can be expressed as (K ^K 01 0 I) o 0 K ^K 01 Y a ( o )^ a = Y a ( o )( a 0 K ^K 01 ^ a ) () where ai =10 (k i=^k i) and k i and ^k i are the ith diagonal elements of K and ^K, respectively. Substituting () into (1), we have M (q)_s + B + 1 _M (q)+s(q; _q) s + Y d (q; _q; _q r; q r)1 d + ^J T (q; ^ k )(K v1_x + K p1x) +Y a( o)1 a =0 (3) Proof: Since M (q) is uniformally positive definite, V in (4) is positive definite in s, 1x, 1 k, 1 d, and 1 a. Since V _ 0, V is also bounded, and, therefore, s, 1x, 1 k, 1 d, and 1 a are bounded vectors. This implies that ^ k, ^ d, and ^ a are bounded, x is bounded if x d is bounded, and ^s x = ^J(q; ^ k )s is bounded. Since 1x is bounded, _x r in (5) is also bounded if _x d is bounded. Therefore, _q r in (9) is also bounded if the approximate Jacobian matrix is of full rank. From (11), _q is bounded and the boundedness of _q means that _x is bounded since the Jacobian matrix is bounded. Hence, 1_x is bounded and x r in (6) is also bounded if x d is bounded. From (18), _^ k is, therefore, bounded since 1x, 1_x, and _q are bounded and Y k (1) is a trigonometric function of q. Therefore, q r in (10) is bounded. From the closed-loop (3), we can conclude that _s is bounded. The boundedness of _s imply the boundedness of q as seen from (1). From (8), _^s x is, therefore, bounded. Finally, differentiating (6) with respect to time and rearranging yields where 1 a = a 0 K ^K 01 ^ a and, hence, 1 _ a = 0K ^K 01 _^ a. Let us define a Lyapunov-like function candidate as V = 1 M (q)s st + 1 1T d L 01 1 d d + 1 1T k L 01 1 k k 1x + 1_x = _^s x + _ Y k (q; _q; q)1 k 0 Y k (q; _q) _^ k which means that 1x =x 0 x d is also bounded. To apply Barbalat s lemma, let us check the uniform continuity of _V. Differentiating (8) with respect to time gives + 1 1 T a L 01 a ^KK 01 1 a + 1 1xT (K p + K v)1x (4) where 1 k = k 0 ^ k. Differentiating with respect to time and using Property 1, wehave _V = s T M (q)_s + 1 M _ (q)s 0 1 T st d L 01 _^ d d 0 1 T k L 01 _^ k k V = 0s T B _s 0 1 _x T K v1x 0 1x T K p1_x: This shows that V is bounded since 1x, 1_x, and 1x are all bounded. Hence, _ V is uniformly continuous. Using Barbalat s lemma, we have 1x = x 0 x d! 0, 1_x = _x 0 _x d! 0, and s! 0 as t!1.444 Remark : If the kinematic parameter update (18) is modified as 01 T a L 01 a _^ a +1x T (K p + K v )1 _x: Substituting M (q)_s from (3), _^ k from (18), _^ d from (17), and _^ a from (19) into the aforementioned, using Property and (13), yields _V = 0s T Bs 0 ^s T x (K v1_x + K p1x) +1x T (K p + K v)1 _x 01 T k Y T k (q; _q)(k v 1_x + K p 1x): (5) From (7), (3), and (5), we have _^ k = 0PY T k (q; _q)p (^_x 0 _x) +L k Y T k (q; _q)(k v 1_x + K p 1x) where P is a symmetric positive definite matrix, this adds to V _ minus the P square norm of Y k (q; _q)1 k. Hence, Y k (q; _q)1 k also converges to zero. In addition, if the persistent excitation condition is satisfied, the convergence of ^ k to k can be achieved. Remark 3: From (6), the adaptive sliding vector can be expressed as where ^s x =1_x + 1x 0 Y k (q; _q)1 k (6) Y k (q; _q)1 k = J(q)_q 0 ^J(q; ^ k )_q = _x 0 ^_x: (7) Substituting (6) into (5) yields _V = 0s T Bs 0 1_x T K v 1_x 0 1x T K p 1x 0: (8) We are now in a position to state the following theorem. Theorem: The adaptive Jacobian tracking control law (16) and the parameter update laws(17) (19) guarantee the stability and result in the convergence of position and velocity tracking errors of the adaptive control system, that is x 0 x d! 0 and _x 0 _x d! 0 as t!1. ^s x =1_x + 1x + Y k (q; _q)^ k 0 Y k (q; _q) k : (9) Hence, the signs of the parameter update laws in (18) and (17) are different because the last term in (16) is positive, while the last term in the aforementioned is negative. Remark 4: As seen from (11) and (9), if Y k (q; _q)1 k also converges to zero, the convergence of 1x and 1_x to zero implies that _q converges to _q r (even if B =0). Remark 5: In this note, we assume that the robot is operating in a finite task space such that the approximate Jacobian matrix is of full rank. Note from (9) that ^J + (q; ^ k ) is used only in the definition of control variable _q r. Therefore, we should be able to control this by bounding the variable or using a singularity-robust inverse of the approximate Jacobian matrix [31]. A projection algorithm can be used to ensure that ^ k remains bounded in an appropriate region [3]. Hence, singularities only depend on q, not ^ k. It may also be possible to avoid boundary singularities by originally overestimating the size of the robot.

108 IEEE TRANSACTIONS ON AUTOMATIC CONTROL, VOL. 51, NO. 6, JUNE 006 Fig. 1. Path and position errors of first experiment. Fig.. Path and position errors of second experiment. Remark 6: Following [13], a simplification of the computation of (10) can be written as q r = ^J + (q; ^ k ) x r 0 _^J(q; ^ k )_q r +(I n 0 ^J + (q; ^ k ) ^J(q; ^ k ) effector. The task-space velocities are obtained from differentiation of the measured position. The robot is required to hold an object with uncertain length and grasping angle and follow a circular trajectory specified in Cartesian space as _ + _^J T (q; ^ k ) ^J +T (q; ^ k )( _q r 0 ) X d =0:33 + 0:1 sin(0:54 + 3t); Y d =0:41 + 0:1 cos(0:54 + 3t): where the derivative of the generalized inverse is not required. IV. EXPERIMENTAL RESULTS To illustrate the performance of the adaptive Jacobian tracking controller, we implemented the proposed controller on a two-link direct drive robot [6], using a personal computer (PC) with Pentium II processor. The controller is running in Microsoft Windows NT together with VenturCom s RTX, a hard real-time extension. The sampling period is set as 3 ms. A position sensitive detector (PSD) camera manufactured by Hamamatsu is used to measure the position of the robot end The relationship between the velocities in task space and the velocities of the joints is given by _x = J(q)_q 0s1 _q1 0s1(_q1 + _q) 0c1(_q1 + _q) = c 1 _q 1 c 1(_q 1 + _q ) 0s 1(_q 1 + _q ) l 1 l + l o c o l o s o (30)

IEEE TRANSACTIONS ON AUTOMATIC CONTROL, VOL. 51, NO. 6, JUNE 006 109 where l 1 and l are the link lengths, l 0 and q 0 are the length and grasping angle of the object, respectively, c 1 =cosq 1, s 1 =sinq 1, c 1 = cos(q 1 + q ), s 1 = sin(q 1 + q ), c 1o = cos(q 1 + q + q o ), s 1o = sin(q 1 + q + qo), co = cos qo, and so = sin qo,. The proposed controller in the Theorem was implemented on the robot holding an object with uncertain length and grasping angle. The length of the object was approximately set as 0.06 m and the grasping angle was approximately set as 45. The object length and grasping angle were estimated as ^l o (0) = 0:1 m and ^qo(0) = 0, respectively, and the link lengths were set as ^l1 (0) = 0:5 mand ^l (0) = 0:7 m. The initial position of the robot end effector was specified as (X(0); Y(0)) = (0:8; 0:5). The actuator model is estimated as ^K = [:45; 0:95]. Experimental results with L a =diagf0:15; 0:10g, L k = diagf0:13; 0:15; 0:015g, L d = diagf0:01; 0:00; 0:00; 0:00; 0:015; 0:01; 0:01g, K v = diagf; g, Kp = diagf40; 380g, and = 1: are presented in Fig. 1. As seen from the results, the tracking errors converge with updating of the estimated actuator, kinematic, and dynamic parameters. In the second experiment, we varied the actual length and grasping angle of the object. The length of the object was approximately set as 0.1 m and the grasping angle was approximately set as 60. The experiment results are shown in Fig.. V. CONCLUSION We have proposed an adaptive Jacobian controller for the tracking control of robot with uncertain kinematics, dynamics, and actuator model. Novel parameter update laws are proposed to update uncertain kinematics, dynamics, and actuator parameters. We have shown that the robot end effector is able to track a desired trajectory with the uncertain parameters being updated online by the proposed parameter update laws. Experimental results illustrate the performance of the proposed controller. REFERENCES [1] M. Takegaki and S. Arimoto, A new feedback method for dynamic control of manipulators, ASME J. Dynam. Syst., Meas. Control, vol. 10, pp. 119 15, 1981. [] S. Arimoto, Control Theory of Nonlinear Mechanical Systems A Passivity-Based and Circuit-Theoretic Approach. Oxford, U.K.: Clarendon Press, 1996. [3] J. J. Craig, P. Hsu, and S. S. Sastry, Adaptive control of mechanical manipulators, Int. J. Robot. Res., vol. 6, no., pp. 16 8, 1987. [4] J. J. E. Slotine and W. Li, On the adaptive control of robot manipulators, Int. J. Robot. Res., no. 6, pp. 49 59, 1987. [5], Adaptive manipulator control: a case study, IEEE Trans. Autom. Control, vol. 33, no. 11, pp. 995 1003, Nov. 1988. [6] R. H. Middleton and G. C. Goodwin, Adaptive computed torque control for rigid link manipulators, Syst. Control Lett., vol. 10, pp. 9 16, 1988. [7] D. E. Koditschek, Adaptive techniques for mechanical systems, in Proc. 5th Yale Workshop Applications of Adaptive Systems Theory, New Haven, CT, 1987, pp. 59 65. [8] J. T. Wen and D. Bayard, New class of control laws for robotic manipulators Part. Adaptive case, Int. J. Control, vol. 47, no. 5, pp. 1387 1406, 1988. [9] B. Paden and R. Panja, A globally asymptotically stable PD+ controller for robot manipulator, Int. J. Control, vol. 47, no. 6, pp. 1697 171, 1988. [10] R. Kelly, R. Carelli, and R. Ortega, Adaptive motion control design of robot manipulators. An input-output approach, Int. J. Control, vol. 50, no. 6, pp. 563 581, 1989. [11] R. Ortega and M. W. Spong, Adaptive motion control of rigid robots: a tutorial, Automatica, vol. 5, no. 6, pp. 877 888, 1989. [1] N. Sadegh and R. Horowitz, Stability and robustness analysis of a class of adaptive controllers for robotic manipulators, Int. J. Robot. Res., vol. 9, no. 3, pp. 74 9, 1990. [13] G. Niemeyer and J. J. E. Slotine, Performance in adaptive manipulator control, Int. J. Robot. Res., vol. 10, no., pp. 149 161, 1991. [14] H. Berghuis, R. Ortega, and H. Nijmeijer, A robust adaptive robot controller, IEEE Trans. Robot. Autom., vol. 9, no. 6, pp. 85 830, Dec. 1993. [15] L. L. Whitcomb, A. Rizzi, and D. E. Koditschek, Comparative experiments with a new adaptive controller for robot arms, IEEE Trans. Robot. Autom., vol. 9, no. 1, pp. 59 70, Feb. 1993. [16] K. W. Lee and H. Khalil, Adaptive output feedback control of robot manipulators using high gain observer, Int. J. Control, vol. 67, no. 6, pp. 859 868, 1997. [17] P. Tomei, Robust adaptive friction compensation for tracking control of robot manipulators, IEEE Trans. Autom. Control, vol. 45, no. 11, pp. 164 169, Nov. 000. [18] S. Arimoto, Robotics research toward explication of everyday physics, Int. J. Robot. Res., vol. 18, no. 11, pp. 1056 1063, 1999. [19] A. Bicchi, Hands for dexterous manipulation and robust grasping: a difficult road toward simplicity, IEEE Trans. Robot. Autom., vol. 16, no. 6, pp. 65 66, Dec. 000. [0] T. Yoshikawa, Force control of robot manipulators, in Proc. IEEE Conf. Robotics and Automation, San Francisco, CA, 000, pp. 0 6, Invited session on robot control. [1] C. C. Cheah, S. Kawamura, and S. Arimoto, Feedback control for robotic manipulators with an uncertain Jacobian matrix, J. Robot. Syst., vol. 1, no., pp. 119 134, 1999. [] C. C. Cheah, M. Hirano, S. Kawamura, and S. Arimoto, Approximate Jacobian control for robots with uncertain kinematics and dynamics, IEEE Trans. Robot. Autom., vol. 19, no. 4, pp. 69 70, Aug. 003. [3] W. E. Dixon, Adaptive regulation of amplitude limited robot manipulators with uncertain kinematics and dynamics, in Proc. Amer. Control Conf., Boston, MA, 004, pp. 3844 3939. [4] C. C. Cheah, S. Kawamura, and S. Arimoto, Stability of hybrid position and force control for robotic manipulator with uncertain kinematics and dynamics, Automatica, vol. 39, no. 5, pp. 847 855, 003. [5] C. C. Cheah, H. Han, S. Kawamura, and S. Arimoto, Grasping and position control of multi-fingered robot hands with uncertain jacobian matrices, in Proc. IEEE Int. Conf. Robotics Automation, Leuven, Belgium, 1998, pp. 403 408. [6] C. C. Cheah, C. Liu, and J. J. E. Slotine, Approximate jacobian adaptive control for robot manipulators, in Proc. IEEE Int. Conf. Robotics Automation, New Orleans, LA, 004, pp. 3075 3080. [7], Adaptive Jacobian tracking control of robots based on visual task-space information, in Proc. IEEE Int. Conf. Robotics Automation, 005, pp. 3509 3514. [8] F. L. Lewis, C. T. Abdallah, and D. M. Dawson, Control of Robot Manipulators. New York: Macmillan, 1993. [9] J. J. E. Slotine and W. Li, Applied Nonlinear Control. Englewood Cliffs, NJ: Prentice-Hall, 1991. [30] O. Khatib, A unified approach for motion and force control of robot manipulators: the operation space formulation, IEEE Trans. Robot. Autom., vol. 3, no. 1, pp. 43 53, Feb. 1987. [31] Y. Nakamura, Advanced Robotics. Reading, MA: Addison-Wesleyn, 1985. [3] G. H. S. Hutchinson and P. Corke, A tutorial on visual servo control, IEEE Trans. Robot. Autom., vol. 1, no. 5, pp. 651 670, Oct. 1996.