A Numerical Study on Controlling a Nonlinear Multilink Arm Using A Retrospective Cost Model Reference Adaptive Controller

Similar documents
Retrospective Cost Model Reference Adaptive Control for Nonminimum-Phase Discrete-Time Systems, Part 1: The Adaptive Controller

Retrospective Cost Adaptive Control for Nonminimum-Phase Systems with Uncertain Nonminimum-Phase Zeros Using Convex Optimization

Cumulative Retrospective Cost Adaptive Control with RLS-Based Optimization

System Identification Using a Retrospective Correction Filter for Adaptive Feedback Model Updating

Adaptive Control of an Aircraft with Uncertain Nonminimum-Phase Dynamics

ADAPTIVE CONTROL WITH CONVEX SATURATION CONSTRAINTS

Adaptive Control of a Quadrotor UAV Transporting a Cable-Suspended Load with Unknown Mass

Adaptive Control Using Retrospective Cost Optimization with RLS-Based Estimation for Concurrent Markov-Parameter Updating

Adaptive Trim and Trajectory Following for a Tilt-Rotor Tricopter Ahmad Ansari, Anna Prach, and Dennis S. Bernstein

Adaptive Control of Mass-Spring Systems with Unknown Hysteretic Contact Friction

A Multiplay Model for Rate-Independent and Rate-Dependent Hysteresis with Nonlocal Memory

Fast Seek Control for Flexible Disk Drive Systems

Inversion-Free Adaptive Control of Uncertain Systems with Shape-Memory-Alloy Actuation

Controllability Analysis of A Two Degree of Freedom Nonlinear Attitude Control System

Experimental Results for Almost Global Asymptotic and Locally Exponential Stabilization of the Natural Equilibria of a 3D Pendulum

DSCC2012-MOVIC

Sliding Window Recursive Quadratic Optimization with Variable Regularization

Stabilization of a 3D Rigid Pendulum

Damage Localization for Structural Health Monitoring Using Retrospective Cost Model Refinement

Adaptive Output Feedback Control of the NASA GTM Model with Unknown Nonminimum-Phase Zeros

Retrospective Cost Adaptive Thrust Control of a 1D scramjet with Mach Number Disturbance

found that it is possible to achieve excellent results but with unrealistically high torques. This problem

Growing Window Recursive Quadratic Optimization with Variable Regularization

Output tracking control of a exible robot arm

ADMISSION TEST INDUSTRIAL AUTOMATION ENGINEERING

ZEROS OF MODAL MODELS OF FLEXIBLE STRUCTURES

Position Control Using Acceleration- Based Identification and Feedback With Unknown Measurement Bias

Semiparametric Identification of Wiener Systems Using a Single Harmonic Input and Retrospective Cost Optimization

An Inner-Loop/Outer-Loop Architecture for an Adaptive Missile Autopilot

DYNAMICS OF A SPINNING MEMBRANE

FEEDBACK CONTROL SYSTEMS

DSCC2012-MOVIC

The Effect of Nonminimum-Phase Zero Locations on the Performance of Feedforward Model-Inverse Control Techniques in Discrete-Time Systems

Stabilization of a Specified Equilibrium in the Inverted Equilibrium Manifold of the 3D Pendulum

A Novel Integral-Based Event Triggering Control for Linear Time-Invariant Systems

Wind Turbine Control

available online at CONTROL OF THE DOUBLE INVERTED PENDULUM ON A CART USING THE NATURAL MOTION

Minimum modelling retrospective cost adaptive control of uncertain Hammerstein systems using auxiliary nonlinearities

Kalman-Filter-Based Time-Varying Parameter Estimation via Retrospective Optimization of the Process Noise Covariance

Adaptive control with convex saturation constraints JinYan, Davi Antônio dos Santos, Dennis S. Bernstein

Modelling the Dynamics of Flight Control Surfaces Under Actuation Compliances and Losses

Adaptive Harmonic Steady State Control for Disturbance Rejection

EQUIVALENT SINGLE-DEGREE-OF-FREEDOM SYSTEM AND FREE VIBRATION

Observer Design for a Flexible Robot Arm with a Tip Load

Analysis of Bilateral Teleoperation Systems under Communication Time-Delay

Unit quaternion observer based attitude stabilization of a rigid spacecraft without velocity measurement

Joint Torque Control for Backlash Compensation in Two-Inertia System

3D Pendulum Experimental Setup for Earth-based Testing of the Attitude Dynamics of an Orbiting Spacecraft

Gordon G. Parker Mechanical Engineering Dept., Michigan Institute of Technology Houghton, MI

ADAPTIVE CONTROL OF A FLEXIBLE MEMBRANE USING ACOUSTIC EXCITATION AND OPTICAL SENSING

Imaginary. Axis. Real. Axis

Control of constrained spatial three-link flexible manipulators

Jerk derivative feedforward control for motion systems

Adaptive Control for Nonlinear Uncertain Systems with Actuator Amplitude and Rate Saturation Constraints

Positioning Servo Design Example

Laboratory 11 Control Systems Laboratory ECE3557. State Feedback Controller for Position Control of a Flexible Joint

IAC-11-C1.5.9 INERTIA-FREE ATTITUDE CONTROL OF SPACECRAFT WITH UNKNOWN TIME-VARYING MASS DISTRIBUTION

Controlled Lagrangian Methods and Tracking of Accelerated Motions

Application of singular perturbation theory in modeling and control of flexible robot arm

AA 242B/ ME 242B: Mechanical Vibrations (Spring 2016)

1 x(k +1)=(Φ LH) x(k) = T 1 x 2 (k) x1 (0) 1 T x 2(0) T x 1 (0) x 2 (0) x(1) = x(2) = x(3) =

H 2 Adaptive Control. Tansel Yucelen, Anthony J. Calise, and Rajeev Chandramohan. WeA03.4

Predictive Cascade Control of DC Motor

Position and Velocity Profile Tracking Control for New Generation Servo Track Writing

Assessment Schedule 2016 Physics: Demonstrate understanding of mechanical systems (91524)

Inertia Identification and Auto-Tuning. of Induction Motor Using MRAS

Mechatronics Modeling and Analysis of Dynamic Systems Case-Study Exercise

Imaginary. Axis. Real. Axis

Design and Control of Variable Stiffness Actuation Systems

H-infinity Model Reference Controller Design for Magnetic Levitation System

MAE 142 Homework #5 Due Friday, March 13, 2009

Collocated versus non-collocated control [H04Q7]

Appendix A: Exercise Problems on Classical Feedback Control Theory (Chaps. 1 and 2)

QUICK AND PRECISE POSITION CONTROL OF ULTRASONIC MOTORS USING ADAPTIVE CONTROLLER WITH DEAD ZONE COMPENSATION

Rhythmic Robot Arm Control Using Oscillators

7. FORCE ANALYSIS. Fundamentals F C

Trajectory-tracking control of a planar 3-RRR parallel manipulator

MANY adaptive control methods rely on parameter estimation

THE desire for developing an integrated control systemdesign

HIGHER ORDER SLIDING MODES AND ARBITRARY-ORDER EXACT ROBUST DIFFERENTIATION

Closed-Loop Identification of Unstable Systems Using Noncausal FIR Models

A Delay-Duhem Model for Jump-Resonance Hysteresis*

Real-Time Implementation of a LQR-Based Controller for the Stabilization of a Double Inverted Pendulum

Dynamics. Basilio Bona. Semester 1, DAUIN Politecnico di Torino. B. Bona (DAUIN) Dynamics Semester 1, / 18

Extremum Seeking for Dead-Zone Compensation and Its Application to a Two-Wheeled Robot

Research Article On the Dynamics of the Furuta Pendulum

for Articulated Robot Arms and Its Applications

Oscillations. Tacoma Narrow Bridge: Example of Torsional Oscillation

Mechanical Systems Part A: State-Space Systems Lecture AL12

Robotics & Automation. Lecture 25. Dynamics of Constrained Systems, Dynamic Control. John T. Wen. April 26, 2007

Mathematical Modeling and response analysis of mechanical systems are the subjects of this chapter.

ECSE 4962 Control Systems Design. A Brief Tutorial on Control Design

In the presence of viscous damping, a more generalized form of the Lagrange s equation of motion can be written as

Positioning Control of One Link Arm with Parametric Uncertainty using Quantitative Feedback Theory

Chapter 15 Periodic Motion

AA 242B / ME 242B: Mechanical Vibrations (Spring 2016)

Chapter 14 Oscillations. Copyright 2009 Pearson Education, Inc.

EE Homework 3 Due Date: 03 / 30 / Spring 2015

Control-Structure Interaction in Extremely Large Telescopes

Dr Ian R. Manchester

Transcription:

5th IEEE Conference on Decision and Control and European Control Conference (CDC-ECC) Orlando, FL, USA, December -5, A Numerical Study on Controlling a Nonlinear Multilink Arm Using A Retrospective Cost Model Reference Adaptive Controller Matthew W Isaacs, Jesse B Hoagg, Alexey V Morozov, and Dennis S Bernstein Abstract We address the model reference adaptive control problem for a nonlinear multilink planar arm mechanism, where links are interconnected by torsional springs and dashpots, a control torque is applied to the hub of the mechanism, and the objective is to control the angular position of the last link It is known that the linearized transfer function for the multilink planar arm has nonminimum-phase zeros when the control torque and angular position sensor are not colocated We use a retrospective cost model reference adaptive control (RC-MRAC) algorithm, which is effective for nonminimumphase systems provided that the nonminimum-phase zeros are known We demonstrate that RC-MRAC effectively controls the multilink arm for a range of reference model command signal amplitudes and frequencies I INTRODUCTION The multilink planar arm mechanism consists of N links, which are interconnected by torsional springs and dashpots This mechanism is an approximation of a flexible rotating arm or bending beam, whose dynamics and control are studied for applications such as space structures [], [] and hard drives [3], [4] The multilink planar arm presents a challenging control problem because the system is nonlinear and exhibits nonminimum-phase behavior, as shown in [5, Chap 85] for the -link case and [6] for the N-link case Nonmimum-phase zeros can create challenges for feedback control systems by limiting bandwidth and gain margins [7], and causing initial undershoot or direction reversals in the step response [8], [9] Thus, it is of interest to determine physical properties in mechanical systems that give rise to nonminimum-phase zeros The colocated force-to-velocity transfer functions for flexible structures are known to be positive real (and thus minimum phase) [] This property suggests that sensor-actuator noncolocation may cause nonminimum-phase zeros; however, [], [] demonstrate that noncolocation alone is not the source of nonminimumphase zeros In particular, [] considers a string of masses interconnected by linear springs and dashpots, and shows that the noncolocated transfer functions from the force on one mass to the position of another mass are minimum phase The bending-beam examples considered in [3], [4] suggest that nonminimum-phase zeros may arise from sensoractuator noncolocation combined with rotational motion Graduate Student, Department of Mechanical Engineering, The University of Kentucky, Lexington, KY, 456-53, email: matthewisaacs@ukyedu Assistant Professor, Department of Mechanical Engineering, The University of Kentucky, Lexington, KY, 456-53, email: jhoagg@engrukyedu Graduate Student, Department of Aerospace Engineering, University of Michigan, Ann Arbor, MI 489, email: morozova@umichedu Professor, Department of Aerospace Engineering, University of Michigan, Ann Arbor, MI 489, email: dsbaero@umichedu This conjecture is supported by the results of [6], which shows that the noncolocated transfer functions of the linearized multilink planar arm have nonminimum-phase zeros While nonminimum-phase zeros can be challenging for many control methodologies, they are particularly challenging for adaptive controllers For discrete-time systems with nonminimum-phase zeros, retrospective cost adaptive control (RCAC) techniques are known to be effective provided that the nonminimum-phase zeros are known [5] [7] In [6], RCAC is used to control the -link planar arm mechanism using knowledge of only the first non-zero Markov parameter and the nonmimum-phase zeros of the discretized linearized transfer function from hub torque to angular position In the present paper, we extend the work of [6] in two ways First, we adopt the retrospective cost model reference adaptive control (RC-MRAC) algorithm, which is presented in [8] The simulation results of this paper demonstrate that RC-MRAC effectively controls the multilink arm for a wide range of reference model command signal amplitudes and frequencies The second extension presented in this paper is the adaptive control of the multilink arm with more than links Specifically, we address the -link, 3-link, and 4-link cases II EQUATIONS OF MOTION In this section, we review the nonlinear equations of motion for an N-link planar arm, and present the linearized equations of motion For a detailed derivation, see [6] First, let p be the point where the first link is connected to the horizontal plane, and, for i =,,N, let p i be the point where the i th link is connected to the (i ) th link Next, for i =,,N, let m i be the mass of the i th link, let l i be the length of the i th link, let c i be the damping at the joint p i, let k i be the stiffness of the joint p i, and let I i = m ili be the moment of inertia of the ith link about its center of mass Next, we define the inertial frame F A with orthogonal unit vectors (î A,ĵ A,ˆk A ), where î A and ĵ A lie in the plane of motion of the N-link planar arm, and ˆk A is orthogonal to the plane of motion For simplicity, we assume that the origin of F A is located at p Finally, for i =,,N, let θ i be the angle from î A to the vector from p i to p i+ The N-link planar arm is shown in Figure A Nonlinear Equations of Motion For i =,,N, the kinetic energy of the i th link is T i = m ivi + I i θ i, where the magnitude of the translational velocity of the i th link is given by 978--684-8-3//$6 IEEE 88

Fig ĵ A θ p î A p 3 θ N p N p θ All motion of the N-link planar arm is in the horizontal plane V i = 4 l θ i i i + ( lj θ ) j +l il j θi θj cos(θ j θ i ) i + j= l j l h θj θh cos(θ j θ h ) j h The total kinetic energy is defined by T = N i= T i Next, for i =,,N, the potential energy of the i th link is / U i = { k θ, i =, k i(θ i θ i ), i >, and the total potential energy is defined by U = N i= U i Thus, the Lagrangian for the N-link system is L = T U Next, for i =,,N, let F ci be the dissipation function resulting from the damping at joint p i, that is, F ci = { c θ, i =, c i( θ i θ i ), i >, and define F c = N i= F c i For i =,,N, let v i be an external torque applied at p i Thus, for i =,,N the nonlinear equations of motion are given by d L dt θ L + F c i θ i θ = v i () i B Linearized Equations of Motion Now, we present the linearized equations of motion for the N-link system First, define Θ = [ θ θ N ] T, and Υ = [ v v N ] T We linearize about the (Θ, Θ) equilibrium Let δθ be the linear approximation of Θ around the equilibrium (Θ, Θ) Linearizing the N-link system, with nonlinear equations of motion (), about (Θ, Θ) yields Mδ Θ+C d δ Θ+KδΘ = Υ, () where γ, γ,n M = γ N, γ N,N, c +c c c c +c 3 c 3 c 3 c 3 +c 4 C d =, c N k +k k k k +c 3 k 3 k 3 k 3 +k 4 K =, k N where, for g ( =,,N, and) h = g +,,N, mg γ g,g = 3 + N i=g+ m i lg, and γ g,h = ( ) mh + N i=h+ m i l g l h, and, for g,h =,,N, γ h,g = γ g,h III RETROSPECTIVE COST MODEL REFERENCE ADAPTIVE CONTROL In this section, we review the RC-MRAC algorithm presented in [8] We highlight the model information required by the adaptive controller as well as several important assumptions For additional details and a stability analysis of RC-MRAC, see [8] First, consider the linear discrete-time system n n y(k) = α i y(k i)+ β i u(k i), (3) i= i=d where k, α,,α n R, β d,,β n R, y(k) is the output, u(k) is the control, and the relative degree is d > Let q and q denote the forward-shift and backwardshift operators, respectively, and define β(q) = β d q n d + β d+ q n d + +β n q+β n Consider the factorization β(q) = β d β u (q)β s (q), where β u (q) is a monic polynomial of degree n u ; β s (q) is a monic polynomial; and if λ C, λ, and β(λ) =, then β u (λ) = and β s (λ) We assume that the polynomial β u (q) is known, which implies that the nonminimum-phase zeros from u to y are known Furthermore, we assume that the first nonzero Markov parameter β d is known Next, consider the reference model α m (q)y m (k) = β m (q)r(k), (4) where y m (k) R is the reference model output; r(k) R is the bounded reference model command; α m (q) is a monic polynomial with degreen m > ; β m (q) is a polynomial with degree n m d m, where d m d is the relative degree of (4); and if λ C, λ, and β u (λ) =, then β m (λ) = Next, define z(k) = y(k) y m (k) Our goal is to drive z(k) to zero We use a time-series controller of order n c 89

max(n n u d,n m n u d), which is given by n c n c u(k) = L i (k)y(k i)+ M i (k)u(k i) i= n c i= + N i (k)r(k i), (5) i= where, for all i =,,n c, L i : N R and M i : N R, and, for all i =,,,n c, N i : N R are determined by the adaptive law presented below The controller (5) can be expressed as u(k) = φ T (k)θ c (k), (6) where θ c (k) = [L (k) L nc (k) M (k) M nc (k) N (k) N nc (k)] T, and φ(k) = [ y(k ) y(k n c ) u(k ) u(k n c ) r(k) r(k n c )] T Now, let ˆθ R 3n c+ be an optimization variable, and define the retrospective performance ẑ f (ˆθ,k) = z f (k)+φ T (k)ˆθ β d βu (q )u(k), where β u (q ) = q nu d β u (q), the filtered tracking error is defined by z f (k) = q nm α m (q)z(k), and the filtered regressor is defined by Φ(k) = β d βu (q )φ(k) Finally, define the cumulative retrospective cost function J(ˆθ,k) = k i= λ k i ẑ f (ˆθ,i)+λ k[ˆθ θ() ] TR [ˆθ θ() ], where λ (,], R R (3nc+) (3nc+) is positive definite, and θ() R 3nc+ For each k, J(ˆθ,k) is minimized by the recursive-least-squares algorithm with a forgetting factor θ c (k +) = θ c (k) P(k)Φ(k)z f,r(k) λ+φ T (k)p(k)φ(k), (7) P(k +) = [ ] P(k) P(k)Φ(k)ΦT (k)p(k) λ λ+φ T, (8) (k)p(k)φ(k) where P() = R and z f,r (k) = ẑ f (θ c (k),k) In summary, RC-MRAC is given by (6) (8), and its architecture is shown in Figure u z y m Plant α(q)y = β(q)u Adaptive Controller u(k) = φ T (k)θ c (k) Reference Model α m (q)y m = β m (q)r r y Fig Schematic diagram of RC-MRAC given by (6), (7), and (8) IV IMPLEMENTATION OF RC-MRAC In this section, we discuss implementation of RC-MRAC on the N-link planar arm We implement RC-MRAC with a zero-order hold on the inputs and a sampling time T s = seconds Although the RC-MRAC formulation, presented in Section III, is based on a linear plant, we apply RC-MRAC to the full nonlinear N-link planar arm, given by () We assume that the control torque at the hub of the N- link planar arm (ie, v ) is the only available control input Thus,v,,v N in () are identically zero andv is the zero order hold of u(k), where u(k) is determined by RC-MRAC (6) (8) We assume that the angular position of the N th link (ie, θ N ) is the only measurement available for feedback Thus, y(k) is the sampled-data signal obtained from θ N Our objective is to force the angular position of the N th link to follow the reference model output y m (k) In order to implement RC-MRAC, we require knowledge of β u (q), which characterizes the nonminimum-phase zeros of the linearized N-link system from the control torque at the hub to the angular position of the N th link It is shown in [6] that the linearized transfer function of the -link system from v to δθ has exactly one nonminimum-phase zero Furthermore, [6] provides numerical evidence that the linearized transfer function of the N-link system from v to δθ N (ie, from the hub to the tip of the multilink mechanism) has N nonminimum-phase zeros Finally, discretizing the linearized transfer function from v to δθ N (using a zeroorder hold on the inputs) results in a discrete-time transfer function, which in general also has N nonminimumphase zeros The locations of the nonmimum-phase zeros depend on the sampling time used for the discretization In this numerical study, we let β u (q) be the polynomial whose roots are at the nonminimum-phase zero locations obtained from the discretized linearization V SIMULATION RESULTS In this section, we use RC-MRAC to control the nonlinear N-link system In particular, for the two, three, and four link cases, we numerically investigate the performance of RC- MRAC with sinusoidal reference model commandsr(k) Our goal is to explore the amplitude and frequency ranges of the reference model output y m (k) for which the output of the N-link system y(k) is able to track y m (k) We demonstrate that RC-MRAC is able to control the N-link system for a range of reference model output amplitudes and frequencies; however, for large-amplitude or high-frequency reference model outputs the N-link system s nonlinearities become difficult for RC-MRAC to control For all examples, the controller order is n c = and the reference model is given by (4) Next, define the reference model transfer function G m (z) = βm(z) α m(z) and consider the reference model command A r(k) = G m (e jωts ) sinωt sk, where ω is the frequency in rad/sec and A is the amplitude in rad Note that the amplitude of r(k) is normalized by the 8

magnitude of the reference model transfer function at the command frequency (ie, G m (e jωts ) ) The normalization is performed so that, for any frequency ω, the steadystate amplitude of y m (k) is A Thus, we can independently vary the amplitude A and frequency ω of the steady-state reference model output y m (k), which is the signal that the adaptive controller is attempting to track Finally, for all examples, θ c () = and λ = A The Two-Link Case We consider the -link system, where m = kg, m = 3 kg, l = m, l = m, k = 7 N m rad, k = 5 N m rad, c = kg m rad, and c = kg m rad In this case, β d = 845 5 and β u (q) = q 784 Additionally, we let α m (q) = (q 8) 5, β m (q) = qβ u (q), andp() = I 37 The -link system is simulated for a range of reference model output amplitudes and frequencies; specifically, A is varied from rad to rad, and ω is varied from rad/sec to π rad/sec For each choice of A and ω, the -link system is simulated for seconds, and we explore the values of A and ω for which RC-MRAC drives the performance z(k) to zero If the angular position of the second link exceeds π rad, then we consider this transient behavior to exceed acceptable limits, meaning that RC-MRAC is not effective Next, for each simulation, define the performance metric ε = max z(k), (9) k Ts which quantifies the peak transient tracking error Figure 3 is a heat map, which shows the range of reference model output amplitudes A and reference model command frequencies ω, where RC-MRAC is effective Furthermore, the color at each point on the heat map indicates the value of ε Finally, the white regions correspond to the values of A and ω where the angular position of the second link exceeds π rad Figure 3 demonstrates that RC-MRAC is effective over a large amplitude range when the frequency is low, and over a large frequency range when the amplitude is small colored region of the heat map but not near the boundary; and an (A,ω) pair, which is in the colored region of the heat map and near the boundary Example Let A = 3 and ω = π, which is in the colored region of the heat map but not near the boundary Figure 4 shows the closed-loop response of the -link system with RC-MRAC in feedback The -link system is allowed to run open loop for 5 seconds, then RC-MRAC is turned on The top plot of Figure 4 shows that y(k) asymptotically follows y m (k) The middle and bottom plots of Figure 4 provide a time history of the angles θ and θ, and the rates θ and θ θ and θ (rad) θ and θ (rad/sec) 6 4 4 4 6 8 4 6 8 6 4 4 4 6 8 4 6 8 4 6 8 4 6 8 Fig 4 Example : For the -link system with A = 3 and ω = π, the angular position of the second link y(k) follows the reference model output y m(k) Top plot shows y(k) (solid) and y m(k) (dashed); middle plot shows the angles θ (solid) and θ (dashed); bottom plot shows the angular rates θ (solid) and θ (dashed) Example Let A = and ω = π, which is in the colored region of the heat map and near the boundary Figure 5 shows the closed-loop response of the -link system with RC-MRAC in feedback The top plot of Figure 5 shows that y(k) asymptotically follows y m (k); however, the transient performance is worse than that shown in Figure 5 Note that the plots have been truncated after seconds 9 8 7 5 3 4 5 6 7 8 9 Amplitude (rad) 6 5 4 5 θ and θ (rad) 3 4 5 6 7 8 9 3 3 4 5 6 Frequency (rad/sec) 5 θ and θ (rad/sec) 5 5 5 4 5 6 7 8 9 Fig 3 Two-Link System Heat Map: The heat map for the two-link system shows that RC-MRAC effectively controls the -link system over a range of reference model output amplitudes and frequencies White regions represent a response greater than π radians Next, we explore two values of A and ω in more detail In particular, we consider an (A,ω) pair, which is in the Fig 5 Example : For the -link system with A = and ω = π, the angular position of the second link y(k) follows the reference model output y m(k) However, the transient behavior for this example is worse than the transient behavior shown in Figure 4 Top plot shows y(k) (solid) and y m(k) (dashed); middle plot shows the angles θ (solid) and θ (dashed); bottom plot shows the angular rates θ (solid) and θ (dashed) 8

B The Three-Link Case We consider the 3-link system, where m = kg, m = 3 kg, m 3 = 4 kg, l = m, l = m, l 3 = m, k = 7 N m rad, k = 5 N m rad, k 3 = 6 N m rad, c = kg m rad, c = kg m rad, and c 3 = kg m rad In this case, β d = 3 6 and β u (q) = (q 6)(q 89) Additionally, we let α m (q) = (q 9) 5, β m (q) = β u (q), and P() = 7 I 37 The 3-link system is simulated for a range of reference model output amplitudes and frequencies; specifically, A is varied from rad to 5 rad, and ω is varied from rad/sec to π rad/sec We use the performance metricεgiven by (9) and consider transient behavior to exceed acceptable limits if the angular position of the third link exceeds π rad Figure 6 is the heat map for the 3-link system Notice that the shape of Figure 6 is similar to the shape of Figure 3 (ie, the heat map for the -link system) However, RC-MRAC is effective over a smaller range of values of A and ω in the 3-link case The smaller range of (A,ω) may be a result of the additional nonlinearities that arise when additional links are added to the multilink arm θ, θ, and θ3 (rad) θ, θ, and θ3 (rad/sec) 4 6 8 4 6 8 4 6 8 4 6 8 4 4 4 6 8 4 6 8 Fig 7 Example 3: For the 3-link system with A = and ω = π, the angular position of the third link y(k) follows the reference model output y m(k) Top plot shows y(k) (solid) and y m(k) (dashed); middle plot shows the angles θ (solid), θ (dashed), and θ 3 (dotted); bottom plot shows the angular rates θ (solid), θ (dashed), and θ 3 (dotted) 3 4 5 5 5 5 45 4 5 θ, θ, and θ3 (rad) 3 4 5 5 5 Amplitude (rad) 35 3 5 5 θ, θ, and θ3 (rad/sec) 6 4 4 5 5 5 5 5 5 5 5 3 Frequency (rad/sec) Fig 6 Three-Link System Heat Map: The heat map for the three-link system shows that RC-MRAC effectively controls the 3-link system over a range of reference model output amplitudes and frequencies White regions represent a response greater than π radians Example 3 Let A = and ω = π, which is in the colored region of the heat map but not near the boundary Figure 7 shows the closed-loop response of the 3-link system with RC-MRAC in feedback The 3-link system is allowed to run open loop for 5 seconds, then RC-MRAC is turned on The top plot of Figure 7 shows that y(k) asymptotically follows y m (k) Example 4 Let A = and ω = 5π, which is in the colored region of the heat map and near the boundary Figure 8 shows the closed-loop response of the 3-link system with RC-MRAC in feedback The top plot of Figure 8 shows that y(k) asymptotically follows y m (k); however, the transient performance is worse than that shown in Figure 7 C The Four-Link Case We consider the 4-link system, where m = kg, m = 3 kg, m 3 = 4 kg, m 4 = 3 kg, l = m, l = m, l 3 = m, l 4 = m, k = 7 N m rad, k = 5 N m rad, k 3 = 6 N m rad, k 4 = 5 5 Fig 8 Example 4: For the 3-link system with A = and ω = 5π, the angular position of the third link y(k) follows the reference model output y m(k) However, the transient behavior for this example is worse than the transient behavior shown in Figure 7 Top plot shows y(k) (solid) and y m(k) (dashed); middle plot shows the angles θ (solid), θ (dashed), and θ 3 (dotted); bottom plot shows the angular rates θ (solid), θ (dashed), and θ 3 (dotted) N m rad, c = kg m rad, c = kg m rad, c 3 = kg m rad, and c 4 = 9 kg m rad In this case, β d = 44 6 and β u (q) = (q 8)(q 649)(q+4684) Additionally, we let α m (q) = (q 9) 5, β m (q) = β u (q), and P() = 9 I 37 The 4-link system is simulated for A from rad to 5 rad, and ω is varied from rad/sec to 6π rad/sec We use the performance metric ε given by (9) Figure 9 is the heat map for the 4-link system The shape of Figure 9 is similar to the shapes of Figure 3 and Figure 6, but the range of (A,ω) where RC-MRAC is effective is smaller than in the 3-link case (which is smaller than in the -link case) This provides additional numerical evidence that the range of achievable motion (ie, the amplitude and frequency of the reference model output) decreases as the number of links increases Example 5 Let A = and ω = π, which is in the colored region of the heat map but not near the boundary Figure shows the closed-loop response of the 4-link system with RC-MRAC in feedback The top plot of Figure shows that y(k) asymptotically follows y m (k) 8

4 5 4 4 5 5 5 Amplitude (rad) 8 6 5 θ, θ, θ3, and θ4 (rad) 4 4 5 5 5 4 4 6 8 4 6 Frequency (rad/sec) 5 θ, θ, θ3, and θ4 (rad/sec) 3 5 5 5 Fig 9 Four-Link System Heat Map: The heat map for the four-link system shows that RC-MRAC effectively controls the 4-link system over a range of reference model output amplitudes and frequencies White regions represent a response greater than π radians θ, θ, θ3, and θ4 (rad) θ, θ, θ3, and θ4 (rad/sec) 4 4 5 5 5 3 35 4 45 5 4 4 5 5 5 3 35 4 45 5 5 5 5 3 35 4 45 5 Fig Example 5: For the 4-link system with A = and ω = π, the angular position of the fourth link y(k) follows the reference model output y m(k) Top plot shows y(k) (solid) and y m(k) (dashed); middle plot shows the angles θ (solid), θ (dashed), θ 3 (dotted), and θ 4 (dash-dotted); bottom plot shows the angular rates θ (solid), θ (dashed), θ3 (dotted), and θ 4 (dash-dotted) Example 6 Let A = and ω = 5π, which is in the colored region of the heat map and near the boundary Figure shows the closed-loop response of the 4-link system with RC-MRAC in feedback The top plot of Figure shows that y(k) asymptotically follows y m (k); however, the transient performance is worse than that shown in Figure VI CONCLUSION This paper addressed the model reference adaptive control problem for a nonlinear N-link planar arm mechanism, where the linearized transfer function from the control torque applied at the hub to the angular position of the N th link is nonminimum-phase We used the RC-MRAC algorithm to effectively control the multilink arm for a range of reference model output signal amplitudes and frequencies We demonstrated that, for the -link, 3-link, and 4-link cases, RC-MRAC is effective for controlling the multilink arm However, the range of admissible reference model output amplitudes and frequencies decreases as the number of links increases REFERENCES [] M J Balas, Direct velocity feedback control of large space structures, AIAA J Guid Contr Dyn, vol, no 3, pp 5 53, 979 Fig Example 6: For the 4-link system with A = and ω = 5π, the angular position of the fourth link y(k) follows the reference model output y m(k) However, the transient behavior for this example is worse than the transient behavior shown in Figure Top plot shows y(k) (solid) and y m(k) (dashed); middle plot shows the angles θ (solid), θ (dashed), θ 3 (dotted), and θ 4 (dash-dotted); bottom plot shows the angular rates θ (solid), θ (dashed), θ3 (dotted), and θ 4 (dash-dotted) [] R H Cannon and D E Rosenthal, Experiments in control of flexible structures with noncolocated sensors and actuators, AIAA J Guid Contr Dyn, vol 7, no 5, pp 546 553, 984 [3] D Abramovitch and G Franklin, A brief history of disk drive control, IEEE Contr Sys Mag, vol, no 3, pp 8 4, [4] B P Rigney, L Y Pao, and D A Lawrence, Nonminimum phase dynamic inversion for settle time applications, IEEE Trans Contr Sys Tech, vol 7, pp 989 5, 9 [5] D K Miu, Mechatronics New York: Springer-Verlag, 993 [6] A V Morozov, J B Hoagg, and D S Bernstein, Retrospective cost adaptive control of a planar multilink arm with nonminimum-phase zeros, in Proc Conf Dec Contr, Atlanta, GA, December, pp 376 37 [7] J C Doyle, B A Francis, and A R Tannenbaum, Feedback Control Theory New York: Macmillan, 99 [8] M Vidyasagar, On undershoot and nonminimum phase zeros, IEEE Trans Autom Contr, vol 3, p 44, 986 [9] J B Hoagg and D S Bernstein, Nonminimum-phase zeros: Much to do about nothing, IEEE Contr Sys Mag, vol 7, pp 45 57, June 7 [] J Hong and D S Bernstein, Bode integral constraints, colocation, and spillover in active noise and vibration control, IEEE Trans Contr Sys Tech, vol 6, pp, 998 [] J B Hoagg, J Chandrasekar, and D S Bernstein, On the zeros, initial undershoot, and relative degree of lumped-mass structures, ASME J Dynamical Systems, Measurement, and Contr, vol 9, pp 493 5, 7 [] J L Lin, On transmission zeros of mass-dashpot-spring systems, J Dynamical Systems, Measurement, and Contr, vol, pp 79 83, 999 [3] D K Miu, Physical interpretation of transfer function zeros for simple control systems with mechanical flexibilities, J Dynamical Systems, Measurement, and Contr, vol 3, pp 49 44, 99 [4] E H Maslen, Positive real zeros in flexible beams, Shock and Vibration, vol, pp 49 435, 995 [5] M A Santillo and D S Bernstein, Adaptive control based on retrospective cost optimization, AIAA J Guid Contr Dyn, vol 33, pp 89 34, [6] J B Hoagg and D S Bernstein, Cumulative retrospective cost adaptive control with RLS-based optimization, in Proc Amer Contr Conf, Baltimore, MD, June, pp 46 4 [7], Retrospective cost adaptive control for nonminimum-phase discrete-time systems, Part and Part, in Proc Conf Dec Contr, Atlanta, GA, December, pp 893 94 [8], Retrospective cost model reference adaptive control for nonminimum-phase discrete-time systems, Part and Part, in Proc Amer Contr Conf, San Francisco, CA, June, pp 97 938 83