Bank-to-Turn Control for a Small UAV using Backstepping and Parameter Adaptation

Similar documents
Trajectory tracking & Path-following control

Handling Roll Constraints for Path Following of Marine Surface Vessels using Coordinated Rudder and Propulsion Control

NONLINEAR PATH CONTROL FOR A DIFFERENTIAL DRIVE MOBILE ROBOT

Nonlinear Landing Control for Quadrotor UAVs

Aerobatic Maneuvering of Miniature Air Vehicles Using Attitude Trajectories

Attitude Regulation About a Fixed Rotation Axis

Chapter 10. Path Following. Beard & McLain, Small Unmanned Aircraft, Princeton University Press, 2012, Chapter 10, Slide 1

Control of Mobile Robots

Design and modelling of an airship station holding controller for low cost satellite operations

Nonlinear Trajectory Tracking for Fixed Wing UAVs via Backstepping and Parameter Adaptation. Wei Ren

IEEE TRANSACTIONS ON ROBOTICS 1. Moving Path Following for Unmanned Aerial Vehicles with Applications to Single and Multiple Target Tracking Problems

Autopilot design for small fixed wing aerial vehicles. Randy Beard Brigham Young University

CLF-based Tracking Control for UAV Kinematic Models with Saturation Constraints

Unifying Behavior-Based Control Design and Hybrid Stability Theory

Coordinated Path Following for Mobile Robots

Aircraft Maneuver Regulation: a Receding Horizon Backstepping Approach

An Evaluation of UAV Path Following Algorithms

Three-Dimensional Nonlinear Path-Following Guidance Law Based on Differential Geometry

Tracking Rigid Body Motion Using Thrusters and Momentum. Wheels

Posture regulation for unicycle-like robots with. prescribed performance guarantees

Quaternion-Based Tracking Control Law Design For Tracking Mode

Towards Reduced-Order Models for Online Motion Planning and Control of UAVs in the Presence of Wind

A GLOBAL SLIDING MODE CONTROL WITH PRE-DETERMINED CONVERGENCE TIME DESIGN FOR REUSABLE LAUNCH VEHICLES IN REENTRY PHASE

Multi-layer Flight Control Synthesis and Analysis of a Small-scale UAV Helicopter

Chapter 9. Nonlinear Design Models. Beard & McLain, Small Unmanned Aircraft, Princeton University Press, 2012, Chapter 9, Slide 1

Chapter 1. Introduction. 1.1 System Architecture

Adaptive Backstepping Control for Optimal Descent with Embedded Autonomy

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

Speed Profile Optimization for Optimal Path Tracking

Model Reference Adaptive Control of Underwater Robotic Vehicle in Plane Motion

Mixed Control Moment Gyro and Momentum Wheel Attitude Control Strategies

Waypoint Guidance for Small UAVs in Wind

Pitch Control of Flight System using Dynamic Inversion and PID Controller

Path Following for Marine Surface Vessels with Rudder and Roll Constraints: an MPC Approach

Adaptive Robust Control (ARC) for an Altitude Control of a Quadrotor Type UAV Carrying an Unknown Payloads

CONTROLLER design for nonlinear systems subject to

A trajectory tracking control design for a skid-steering mobile robot by adapting its desired instantaneous center of rotation

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

Nonlinear Wind Estimator Based on Lyapunov

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

DEVELOPMENT AND MATHEMATICAL MODELLING OF PLANNING TRAJECTORY OF UNMANNED SURFACE VEHICLE

IAA-CU A Simulator for Robust Attitude Control of Cubesat Deploying Satellites

Problem 1: Ship Path-Following Control System (35%)

Three-Dimensional Motion Coordination in a Time-Invariant Flowfield

UAV Control and Guidance for Autonomous Cooperative Tracking of a Moving Target

Feedback Control of Spacecraft Rendezvous Maneuvers using Differential Drag

Visual Feedback Attitude Control of a Bias Momentum Micro Satellite using Two Wheels

Adaptive Nonlinear Control A Tutorial. Miroslav Krstić

Nonlinear Tracking Control of Underactuated Surface Vessel

Integrator Backstepping using Barrier Functions for Systems with Multiple State Constraints

Hover Control for Helicopter Using Neural Network-Based Model Reference Adaptive Controller

Robot Control Basics CS 685

x [mm] Meter 250 y [mm] no I.D.Z. I.D.Z. x [mm] y [mm]

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

Robust Stabilization of Non-Minimum Phase Nonlinear Systems Using Extended High Gain Observers

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

COMBINED ADAPTIVE CONTROLLER FOR UAV GUIDANCE

CHAPTER 1. Introduction

Chapter 11. Path Manager. Beard & McLain, Small Unmanned Aircraft, Princeton University Press, 2012,

UAV Coordination for Autonomous Target Tracking

Chapter 2 Review of Linear and Nonlinear Controller Designs

UAV Navigation: Airborne Inertial SLAM

Curve Tracking Control for Autonomous Vehicles with Rigidly Mounted Range Sensors

Three-Dimensional Motion Coordination in a Spatiotemporal Flowfield

Observability-based Local Path Planning and Collision Avoidance Using Bearing-only Measurements

Chapter 7 Control. Part Classical Control. Mobile Robotics - Prof Alonzo Kelly, CMU RI

Localizer Hold Autopilot

Aerial Robotics. Vision-based control for Vertical Take-Off and Landing UAVs. Toulouse, October, 2 nd, Henry de Plinval (Onera - DCSD)

TTK4190 Guidance and Control Exam Suggested Solution Spring 2011

Robust Adaptive Attitude Control of a Spacecraft

The Role of Zero Dynamics in Aerospace Systems

Chapter 3 Numerical Methods

A Blade Element Approach to Modeling Aerodynamic Flight of an Insect-scale Robot

Distributed Coordination and Control of Formation Flying Spacecraft

Vector Field Path Following for Miniature Air Vehicles

INTEGRATED INTERCEPT MISSILE GUIDANCE AND CONTROL WITH TERMINAL ANGLE CONSTRAINT

Exponential Controller for Robot Manipulators

Cooperative Control of Unmanned Vehicles in a Time-Varying Flowfield

6th USA/Europe ATM 2005 R&D Seminar Statistical performance evaluation between linear and nonlinear designs for aircraft relative guidance

Further results on global stabilization of the PVTOL aircraft

Final Exam TTK 4190 Guidance and Control

Formation Control of Nonholonomic Mobile Robots

Exam - TTK 4190 Guidance & Control Eksamen - TTK 4190 Fartøysstyring

Distributed Estimation for Motion Coordination in an Unknown Spatially Varying Flowfield

Adaptive, Non-Singular Path-Following Control of Dynamic Wheeled Robots

COUPLED ORBITAL AND ATTITUDE CONTROL SIMULATION

The PVTOL Aircraft. 2.1 Introduction

arxiv: v2 [math.oc] 18 Sep 2014

Autonomous Helicopter Landing A Nonlinear Output Regulation Perspective

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

Investigation of the Dynamics and Modeling of a Triangular Quadrotor Configuration

Dynamic backstepping control for pure-feedback nonlinear systems

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

Autonomous Robotic Vehicles

arxiv: v2 [cs.ro] 15 Feb 2017

CDS 101/110a: Lecture 8-1 Frequency Domain Design

Robot Manipulator Control. Hesheng Wang Dept. of Automation

On the stability of nonholonomic multi-vehicle formation

KINEMATIC EQUATIONS OF NONNOMINAL EULER AXIS/ANGLE ROTATION

TERMINAL ATTITUDE-CONSTRAINED GUIDANCE AND CONTROL FOR LUNAR SOFT LANDING

Transcription:

Bank-to-Turn Control for a Small UA using Backstepping and Parameter Adaptation Dongwon Jung and Panagiotis Tsiotras Georgia Institute of Technology, Atlanta, GA 333 USA (e-mail: dongwon.jung, tsiotras@gatech.edu) Abstract: In this research we consider the problem of path following control for a small fixedwing unmanned aerial vehicle (UA). Assuming the UA is equipped with an autopilot for low level control, we adopt a kinematic error model with respect to the moving Serret-Frenet frame attached to a path for tracking controller design. A kinematic path following control law that commands heading rate is presented. Backstepping is applied to derive the roll angle command by taking into account the approximate closed-loop roll dynamics. A parameter adaptation technique is employed to account for the inaccurate time constant of the closed-loop roll dynamics during actual implementation. The path following control algorithm is validated in real-time through a high-fidelity hardware-in-the-loop simulation (HILS) environment showing the applicability of the algorithm on a real system. 1. INTRODUCTION For decades unmanned aerial vehicles (UAs) have been proposed as replacements of human pilots during several missions. In recent years small UAs, in particular, are increasingly receiving attention in universities, national research institutes, etc., because of their envisioned missions in both the military and civilian sectors. In order to accomplish these missions with minimal human intervention, the operation of a UA should be fully automated from the top level of path planning, down to the inner control loop level. At the top level of the control hierarchy, the path planning algorithm computes a rough approximation of the optimal path toward the goal. A path generation algorithm then smooths the path yielding a dynamically feasible, flyable path, by taking into account the kinematic constraints of the UA. Finally, the path following algorithm is responsible for guiding the UA to stay close to the designed path. arious control approaches in the literature have been proposed to address the path following problem: Niculescu (1) introduced a lateral track control law, Park et al. (4) proposed a simple, yet effective, nonlinear control logic and demonstrated it experimentally, Ren and Beard (4) considered the problem of constrained trajectory tracking, Nelson et al. (6) proposed a path following control using vector fields to guide the UA on the desired path, and Rysdyk (3) proposed a guidance law based on good helmsman behavior. Motivated by the method proposed by Micaelli and Samson (1993), kinematic control laws have been used to regulate the distance error from the reference path for unicycletype mobile robots [Lapierre and Soetanto (7); Lapierre et al. (7)]. The key aspect of the proposed algorithms is that the control laws explicitly incorporate the controlled motion of a virtual target along the path to be tracked. In this article, we present a nonlinear path following algorithm, which is an extension of the one by Lapierre and Soetanto (7) for UA path following control. We apply a standard backstepping technique to compute the roll angle command from the heading rate command of the kinematic control law. A parameter adaptation technique is then applied to compensate for the inaccurate time constant of the roll closed loop, yielding robust performance during controller implementation. Besides rigorous proofs for convergence of errors, the proposed path following algorithm has an advantage of following a parametric reference path with less stringent initial conditions, as compared to the path following algorithms in the literature. The path following control algorithm is validated through a highfidelity hardware-in-the-loop simulation (HILS) environment to show the applicability of the presented algorithm on the actual system.. PROBLEM DESCRIPTION A fixed-wing UA is equipped with a low-level autopilot with on-board sensors that provides feedback control for attitude angles, air speed, and altitude. In a typical search mission, the air speed and the altitude are kept constant, so that the UA stays inside the safe flying envelope. Suppose that the inertial speed ( ) and the course angle (χ; inertial speed heading) are directly measured using an on-board GPS sensor. A simplified kinematic model in the two dimensional plane is utilized as follows, ẋ = cos χ, ẏ = sin χ, (1) χ = ω, where (x, y) denotes the inertial position, and ω is the heading rate of the UA. By expressing the equations of motion in terms of the ground speed and the course angle, the equations of motion become independent of the wind velocity. Furthermore, by using inertial measurements for path planning control, wind disturbance is naturally rejected so that the performance of path following can be improved significantly. For a fixed-wing UA at a bankedturn maneuver with no sideslip, and assuming that < max <π/, the heading rate ω is induced by the roll angle with the inertial speed as follows, ω = g tan, ()

X I Y s p e s q χ r ṡ χf F Fig. 1. Definition of the Serret-Frenet frame for the path following problem. where the roll angle is assumed to be controlled by an inner PID loop. Properly tuned PID gains result in closed-loop roll dynamics which resemble a first-order system, = 1 ( c ), (3) where c is the roll angle command and > is the time constant. Consider now a UA flying along a planar path as shown in Fig. 1. Denote the inertial position of the UA by p =[xy] T R. The geometric path is defined in terms of the arc-length parameter s. For any given s, the inertial position of the point associated with s is denoted by q(s) R, at which the Serret-Frenet frame is attached, and moves along the path with speed ṡ. Thex-axis of the Serret-Frenet frame is aligned with the tangent vector to the path at q(s) and has an angle χ f (s) with respect to the inertial frame I. Let the error vector e in the Serret- Frenet frame be decomposed in the along-track error e s and the cross-track error e d. Then the inertial error vector r = p q(s) expressed in the Serret-Frenet frame is obtained by e = R T (χ f ) ( p q(s) ), (4) where, [ ] cos χf sin χ R(χ f )= f sin χ f cos χ, (5) f is the rotation matrix from the Serret-Frenet frame to the inertial frame. By differentiating Eq. (4) with respect to time, it follows that ė = Ṙ T (χ f ) ( p q(s) ) + R T (χ f ) ( ṗ q(s) ), (6) where, Ṙ(χ f )=R(χ f )S( χ f ), (7) where, S( χ f ) is the skew-symmetric matrix, [ ] χf S( χ f )= χ f. (8) It follows from Eq. (1) that ṗ = R(χ) e d [ ]. (9) Notice that q is the time derivative of the point q(s), whose speed is represented by ṡ when expressed in the Serret- Frenet frame. It follows that [ṡ ] q = R(χ f ). (1) Subsequently, by substituting Eqs. (9) and (1) in Eq. (6), we obtain, [ ] [ṡ ] ė = S( χ f )e + R(χ χ f ), (11) where R T (χ f )R(χ) =R(χ χ f ). Let now the error course angle χ be defined by χ χ χ f. (1) Hence, χ = χ χ f = ω χ f, (13) and χ f dχ f = dχ f ds = κ(s)ṡ, (14) dt ds dt where κ(s) is the curvature of the path at q(s). The error kinematic model of a fixed-wing UA for the path following problem with respect to the Serret-Frenet frame is summarized as follows, ė s = cos χ (1 κ(s)e d )ṡ, (15a) ė d = sin χ κ(s)e s ṡ, (15b) χ = ω κ(s)ṡ. (15c) From Eqs. (15), the path following problem reduces into a problem of driving the errors to zero as the UA approaches the given path. In Micaelli and Samson (1993), the point q is found by projecting p on the path, assuming the projection is well defined. Hence, the control law derived by Micaelli and Samson (1993) requires a stringent restriction on the initial position of q in order to avoid singularities. In contrast, Lapierre and Soetanto (7) proposed to employ a moving Serret-Frenet frame along the path, which effectively provides an extra control parameter ṡ allowing q(s) to evolve along the error states. This control parameter then mitigates the stringent restriction on the initial condition arose in Micaelli and Samson (1993). 3. PATH FOLLOWING CONTROLLER DESIGN In this section we present a nonlinear path following control logic, which steers the UA to the reference path with an inaccurately known time constant. Beginning with the derivation of a kinematic control law for the heading rate command, we apply backstepping to derive a roll control command for a fixed-wing UA, which, in turn, induces an equivalent control effort to the kinematic control law. In addition, we apply a parameter adaptation technique to deal with an inaccurately known. 3.1 Kinematic controller design Following an approach similar to Lapierre and Soetanto (7) we first derive a kinematic control law for the heading rate. We introduce a bounded differentiable function with respect to the cross-track error e d, as follows δ(e d ) χ eke d 1 e ke (16) d +1 where, k > andχ (,π/) [Micaelli and Samson (1993)]. This function is so-called the approach angle, since it provides the desired relative course transition of the UA to the path as a function of the cross-track error e d. When the cross-track error e d is zero, the approach angle vanishes, thus imposing the condition that the course angle of the UA must be tangential to the path. The positive constant k sets the effectiveness of the transient maneuver during approach. The approach angle provides a behavior similar to that of a good helmsman [Rysdyk (3)] since it satisfies the following condition: e d sin ( δ(e d ) ), for all e d. (17)

A Fig.. Local vector fields generated with respect to two distinct points on the path. This condition steers the UA to the path along the correct direction (turn left when the UA is on the right side of the path, and turn right in the opposite situation). The kinematic controller for path following using the error kinematic model in Eq. (15) is given below. Proposition 1. [Lapierre et al. (7)] Consider the kinematic error model of the UA described in Eq. (15) and the approach angle δ(e d ) defined in Eq. (16). Assume that the speed of the UA is non-negative. Suppose that the reference path is parameterized by the arc-length s, and at each s the variables κ, e s, e d,andχ f are well defined. Then, the following kinematic control law, ω = k ω ( χ δ(ed ) ) + κ(s)ṡ + δ (e d ) ( sin χ κ(s)e s ṡ ) e d ( ( sin χ sin δ(ed ) ) ), (18a) χ δ(e d ) ṡ = k s e s + cos χ, (18b) where k s, k ω and are positive constants, asymptotically drives e s, e d,and χ towards zero. Remarks. The objective of the closed loop system is to steer the error states towards zero, so that the UA follows the virtual target moving on the path. It should be noted that the approach angle plays an important role in steering the UA to the reference path. By constructing a vector field with respect to a reference point on the path the UA is guided to the path, as shown in Fig.. As mentioned earlier, the moving reference frame in conjunction with the extra control command ṡ helps the errors converge to zero. In particular, the term k s e s in Eq. (18) ensures the convergence of e s to zero, providing the momentum induced by the virtual target to reduce e s. Figure shows the vector fields with respect to the corresponding reference points on the path, which takes into account the relative momentum induced by the virtual target (drawn by dashed arrows). During implementation, the new location of the virtual target on the path is propagated using ṡ obtained via a numerical integration scheme, such as the forward Euler method. Hence, if the reference path is well defined in terms of the arc-length parameter s, then the corresponding variables e s, e d, χ f,andκ as also well defined, and thus the proposed path following algorithm is well-posed. 3. Roll angle command via backstepping For a fixed-wing UA flying at a constant altitude, a roll angle command is often used for heading control. A simple way is to compute the roll angle command directly from the heading rate command ω d using the kinematic relationship in Eq. (), d = tan 1 ( ωd g B ). (19) Note that the actual response of the roll angle differs from the commanded value of Eq. (19), but it can be approximated by a first-order system described as in Eq. (3). Taking into account the approximated model of Eq. (3), one can design a steering logic for the roll angle command c in order to achieve ω ω d through d. Following the standard backstepping technique [Spooner et al. ()], we introduce an auxiliary control input ν for the roll angle by augmenting the error model in Eq. (15) with = ν. Thus, the system is given as follows, ė s = cos χ (1 κ(s)e d )ṡ, (a) ė d = sin χ κ(s)e s ṡ, (b) χ = g tan κ(s)ṡ, (c) = ν, (d) where the auxiliary control input ν is associated with the roll command by ν = 1 ( c ). (1) Suppose that the desired heading rate ω d is obtained from Eq. (18a) and let ω e ω ω d =(g/ ) tan ω d be an error state for the heading rate, whose time derivative is calculated using (tan ) =sec, as follows ω e = g sec ω d. () Proposition. Consider the kinematic error model of the UA described in Eqs. () and the approach angle δ(e d ) defined in Eq. (16). Assume that the speed of the UA is non-negative. Suppose that the reference path is parameterized by the arc-length s, and at each s the variables κ, e s, e d, and χ f are well defined. Then, the control input, ( ) ν = g sec k e ω e χ + δ(e d )+ ω d, (3) where k e is a positive constant and ω d is given in Eq. (18a), asymptotically drives e s, e d,and χ towards zero, while ω ω d.itshouldbenotedthat ω d can be calculated by numerical differentiation of ω d. However, in order to avoid any high frequency noise effect due to differentiation, ω d in the actual implementation is obtained by using a pseudo differentiation filter in conjunction with saturation, as a transfer function D(s) =sat ( s/(τs +1) ) where τ>is employed. Proof. Let 1 be a candidate Lyapunov function given by, 1 1 ( e s + e 1 d) + ( χ δ(ed ) ) 1 + ω e. (4) Differentiating with respect to time one obtains, 1 = 1 ( ) esės + e d ė d + ( χ )( δ(ed ) χ δ(e ) d ) + ω e ω e = 1 es( cos χ ṡ)+ 1 ( ) e d sin δ(e d ) + ( χ δ(e d ) ){ g tan + ω d ω d κ(s)ṡ δ (e d ) ( sin χ κ(s)e sṡ ) + e d ( ) sin χ sin δ(e d ) } χ δ(e d ) (5) ( g + ω e sec ω d ). By the definition of ω e, and substituting the desired ω d from Eq. (18a) and ṡ from Eq. (18b), the term inside of the bracket collapses to

1 = k s e s + e d sin ( δ(e d ) ) k ω ( χ δ(ed ) ) + ω e ( g sec + χ δ(e d ) ω d ). (6) Choosing through the auxiliary control input in Eq. (3), that is, ( ) = ν = g sec k e ω e χ + δ(e d )+ ω d, (7) results in, 1 = ks e s + e d ( ) sin δ(e d ) k ω ( χ ) δ(ed ) keω e. (8) The last inequality implies, in particular, that e s,e d, χ and ω e are bounded. Furthermore, δ(e d ) is also bounded from (16) since e d is bounded. It is also easy to show, using (18a), that ω d is bounded. To this end, notice that all signals in the rhs of (18a) except the last are bounded. Moreover, since sin χ sin ( δ(e d ) ) χ ( δ(e d ) ) ( 1 =sinc ( χ δ(ed ) )) ( (9) 1 )) cos ( χ + δ(ed ) and since the sinc function is bounded, the last term in the rhs of (18a) is also bounded. Since ω d and ω e are bounded, it follows that <π/and the control (3) is well defined. To complete the proof, note that 1 is radially unbounded, hence the set Ω c = { 1 (e s,e d, χ, ω e ) c} is a compact, positively invariant set. Let E 1 be the set of all points in Ω c where 1 =. The set E 1 is given by E 1 = {e s = e d =, χ = δ, and (g/ ) tan = ω d }. Noticing that δ( ) is a function of the cross-track error e d, one can easily verify that any point starting from the set E 1 will remain in the set, i.e. E 1 is an invariant set. By the LaSalle s invariance principle, we have that every trajectory starting inside the set Ω c approaches E 1 as t. Therefore, lim t e s =, lim t e d =, and lim t χ = since δ(e d ). We also have (g/ ) tan ω d as t. 3.3 Parameter adaptation Note that the actual roll angle command is computed from Eq. (3) and (3), c = ν +, (3) where, is the time constant of the system. In practice, is determined by the characteristics of the UA airframe and PID gains, thus it is not known accurately. The actual roll command c is then given by c = ν +, (31) where is an estimate of. In order to compensate for any uncertainty in, we apply a parameter adaptation technique. To this end, let be a candidate Lyapunov function defined by 1 + 1 1 λ k a, (3) where 1 is given in Eq. (4) and is the estimate error. Differentiating with respect to time, we get = 1 + 1 k a λ λ = ks e s + e d sin ( δ(e d ) ) k ω ( χ δ(ed ) ) (33) ( ) g + ω e sec + χ δ(e d ) ω d + 1 λ λ. k a The actual value of is calculated from Eq. (3) in conjunction with the actual roll command in Eq. (31) and ν given in Eq. (3). Subsequently, substituting the actual in Eq. (33), we get = ks e s + e d ( ) sin δ(e d ) k ω ( χ ) λ δ(ed ) k eωe + ω e λ ( χ δ(ed ) ω d ) + 1 k a λ λ. (34) Choosing λ as, ) = k a ω e ( χ δ(ed ) ω d, (35) where k a is a positive constant. It follows that = k s e s + e d sin ( δ(e d ) ) k ω ( χ δ(ed ) ) λ (36) k e ωe. Assuming is constant, the parameter update law is readily obtained from Eq. (35) as follows, ) = k a ω e ( χ δ(ed ) ω d. (37) Proposition 3. Let the control law in Eqs. (18) and (3). With the parameter update law given by Eq. (37) the actual roll command of Eq. (31) guarantees that the signals e s, e d,and χ asymptotically tend to zero, while (g/ ) tan ω d. Proof. In order to prove the proposition notice that lim t (t) exists since is bounded from below and is non-increasing. It therefore suffices to show that is uniformly continuous, in which case we can invoke Barbalat s lemma to ensure that lim t (t) =. To this end, consider the expression of in Eq. (36), from which it follows that e d, e s, χ, ω e, ˆ,and are all bounded. As with the proof of Proposition, it follows from (18b) that ṡ is bounded, and from (18a) that ω d is bounded as well. The boundedness of ω d and ω e imply that <π/. Using () we conclude that ė s, ė d, χ are also bounded. Differentiating Eq. (18a) with respect to time, one can show that all terms are bounded, while the last term is also bounded since the derivative of the sinc function is bounded (see also Eq. (9)). Hence, it can be shown that ω d is bounded. Furthermore, δ(e d ) and its time derivative δ(e d )=δ (e d )ė d are bounded. A straightforward calculation shows that ω e = ( ke ω e χ + δ(e d ) ) ω d. (38) From the previous equation it follows that ω e is bounded. Furthermore, λ is also bounded from (37). Consider now the expression for, given by = ks esės + ė ( ) d sin δ(e d ) + e d δ(e ( ) d )cos δ(e d ) k ω ( χ δ(ed ) )( χ δ(e d ) ) k eω e ω e, (39)

Computer Table 1. Simulation parameters. = [m/s] k =.1 k s =.4 k ω =.1 max c = π/6 k e =1.1 k a =.7 = 4 1.1 8 7 6 : Ref. path : Position where, all expressions in the rhs of the equation have been shown to be bounded. It follows that is bounded and hence is uniformly continuous. Applying Barbalat s lemma, it follows that ast. North [meter] 5 4 3 4. HARDWARE IN-THE-LOOP SIMULATION RESULTS 4.1 Simulation environment A realistic hardware-in-the-loop simulation (HILS) environment has been developed to validate the UA autopilot hardware and software development utilizing Matlab R and Simulink R. A full 6-DOF nonlinear aircraft model is used in conjunction with a linear approximation of the aerodynamic forces and moments, along with Earth gravitational (WGS-84) and magnetic field models. Detailed models for the sensors and actuators have also been incorporated. Four independent computer systems are used in the hardware-in-the-loop simulation (HILS) as illustrated in Fig. 3. A 6-DOF simulator, the flight visualization computer, the autopilot micro-controller, and the ground station computer console are involved in the simulation. Further details about the UA platform, autopilot and HILS set-up can be found in Jung et al. (5); Jung and Tsiotras (7a) and Jung and Tsiotras (7b). Flight Dynamics isualization ;FlightGear v1.9 ;Cockpit view isualization (UDP) Flight Dynamics Simulator ;Matlab/Simulink ;6DOF nonlinear model ;Real-time simulation ;Remote pilot switching States ;RS3 Simulink library ;Real-time Simulink execution ;Bi-directional communication Control HIL Bridge (RS3) Binary RC to USB Adpator autopilot 9MHz Wireless Binary ;Flight control executable - Inner/Outer loop controller ;Sensor data processing (Hz) ;Communication to GS Wireless RF Modem Ground Station ;Ground station GUI ;Communication to autopilot ;Data logging / monitoring ;High-level controller Fig. 3. High fidelity hardware-in-the-loop simulation (HILS) environment for validating the path following algorithm 4. Simulation results This section illustrates the performance of the derived path-following control law. The reference path is given by a quartic B-spline over a non-decreasing knot parameter u which is monotonic to the arc-length s. Hence, we can compute q(s), χ f (s), and κ(s) in terms of the knot parameter as follows, 1 y χ f (s) = tan x, κ(s) = x y x y. (4) (x + y ) 3/ where ( ) and ( ) are the derivatives with respect to u. The knot parameter is propagated along with Eq. (18) as follows, du dt = ds / ds dt du =ṡ/ x + y. (41) The parameters used in the simulations are shown in Table 1. We present the results from two simulations. In the first case, we calculate the roll angle command 1 1 3 4 5 6 7 8 9 1 East [meter] Fig. 4. Reference path and actual trajectory of the UA without parameter adaptation. Error states [meter] Kinematic controller output, ω d [deg/sec] 4 4 6 8 1 1 14 1 3 4 5 6 7 8 5 4 3 1 1 (a) Track errors : e s : e d 1 3 4 5 6 7 8 (c) Heading rate command Error course angle [deg] Roll angle and command [deg] 8 6 4 4 1 3 4 5 6 7 8 1 3 (b) Course angle error 4 3 1 4 1 3 4 5 6 7 8 (d) v/s c Fig. 5. Error states and command inputs without parameter adaptation. from Eq. (3) using a time constant =.4 whichis inaccurately known. Without parameter adaptation, as shown in Fig. 4, we observe a sluggish and low damped response of the actual trajectory. The error variables are shown in Fig. 5. In the second case, we calculate the roll angle command from Eq. (31) with the parameter update law of Eq. (37). Figures 6-8 show the results. The error states tend to zero asymptotically as shown in Fig. 7. Because the roll angle command is limited within ±π/6, the UA is unable to exactly follow the path where the curvature exceeds the maximum curvature achievable by the UA at the speed of [m/sec]. Nevertheless, the path following control law forces the UA converge to the path asymptotically after a short transient. It should be noted that the simulation was carried out in conjunction with realistic sensor noises and constant wind disturbance, showing that the adaptation law is more or less robust to the presence of such measurement noises and disturbances. Fig. 8 displays the time history of the estimate of, which shows that from the initial guess of =.4, the parameter estimate converges to the actual value of 1.1. : c :

North [meter] 8 7 6 5 4 3 : Ref. path : Position that gives rise to the desired heading rate has been derived by taking into account the inaccurate system time constant. The path following control algorithm is validated through a high-fidelity hardware-in-the-loop simulation (HILS) environment, which verifies the applicability of the presented algorithm to the actual UA. ACKNOWLEDGEMENTS Partial support for this work has been provided by NSF award CMS-5159. 1 1 3 4 5 6 7 8 9 East [meter] Fig. 6. Reference path and actual trajectory of the UA with parameter adaptation. Error states [meter] Kinematic controller output, ω d [deg/sec] 4 4 6 8 1 1 14 1 3 4 5 6 7 8 5 4 3 1 1 (a) Track errors : e s : e d 1 3 4 5 6 7 8 (c) Heading rate command Error course angle [deg] Roll angle and command [deg] 8 6 4 4 1 3 4 5 6 7 8 1 3 (b) Course angle error 4 3 1 4 1 3 4 5 6 7 8 (d) v/s c Fig. 7. Error states and command inputs with parameter adaptation. Estimated paramter, λ 1.3 1. 1.1 1.9.8.7.6.5.4 1 3 4 5 6 7 8 Fig. 8. Parameter estimate of. 5. CONCLUSION In this research a nonlinear path following control law has been developed for a small UA using backstepping of the heading rate command. The kinematic control law realizes cooperative path following so that the motion of a virtual target is controlled by an extra control input to help the convergence of the error variables. A roll command : c : REFERENCES D. Jung, E. Levy, D. Zhou, R. Fink, J. Moshe, A. Earl, and P. Tsiotras. Design and Development of a Low- Cost Test-Bed for Undergraduate Education in UAs. In Proceedings of the 44 th IEEE Conference on Decision and Control, pages 739 744, Seville, Spain, December 5. D. Jung and P. Tsiotras. Inertial Attitude and Position Reference System Development for a Small UA. In AIAA Infotech at Aerospace, Rohnert Park, CA, May 7a. AIAA Paper 7-768. D. Jung and P. Tsiotras. Modelling and Hardware-in-theloop Simulation for a Small Unmanned Aerial ehicle. In AIAA Infotech at Aerospace, Rohnert Park, CA, May 7b. AIAA 7-763. L. Lapierre and D. Soetanto. Nonlinear Path-following Control of an AU. Ocean Engineering, 34:1734 1744, 7. L. Lapierre, R. Zapata, and P. Lepinay. Combined Pathfollowing and Obstacle Avoidance Control of a Wheeled Robot. The International Journal of Robotics Research, 6(4):361 375, April 7. A. Micaelli and C. Samson. Trajectory Tracking for Unicycle-type and Two-Steering-Wheels Mobile Robots. Technical Report 97, INRIA, Sophia- Antipolis, November 1993. D. R. Nelson, D. B. Barber, T. W. McLain, and R. W. Beard. ector Field Path Following for Small Unmanned Air ehicles. In Proceedings of the 6 American Control Conference, pages 5788 5794, Minneapolis, MN, June 6. M. Niculescu. Lateral Track Control Law for Aerosonde UA. In 39 th AIAA Aerospace Sciences Meeting and Exhibit, Reno, N, January 1. A1-1613. S. Park, J. Deyst, and J. P. How. A New Nonlinear Guidance Logic for Trajectory Tracking. In AIAA Guidance, Navigation, and Control Conference and Exhibit, Providence, RI, August 4. AIAA-4-49. W. Ren and R. W. Beard. Trajectory Tracking for Unmanned Air ehicles with elocity and Heading Rate Constraints. IEEE Transactions on Control Systems Technology, 1(5):76 716, September 4. R. Rysdyk. UA Path Following for Constant Line-Of- Sight. In nd AIAA Unmanned Unlimited Conference and Workshop and Exhibit, San Diego, CA, 3. AIAA- 3-666. J. T. Spooner, M. Maggiore, R. Ordóñez, and K. M. Passino. Stable Adaptive Control and Estimation for Nonlinear Systems. A John Wiley & Sons, Inc., New York, NY,.