基于非线性制导的四旋翼轨迹跟踪控制

四旋翼是一种欠驱动、强耦合的可垂直起降的飞行器,为了实现其能够以设定速度跟踪空间轨迹,设计了一种基于非线性制导算法的轨迹跟踪控制方法。该方法分为了导引与控制两部分组成,导引部分以任务轨迹与期望速度为输入量通过非线性制导算法输出当前四旋翼的期望加速度,控制部分以得到的期望加速度为输入量采用串级PID算法对四旋翼进行姿态控制,从而实现四旋翼保持设定速度对任务轨迹的跟踪。仿真结果表明,所提方法能够实现四旋翼对复杂任务轨迹的精确跟踪,二维复杂轨迹跟踪距离偏差不超过±0.6m,速度偏差不超过2m/s;三维复杂轨迹除了受自身控制力限制的飞行段外,跟踪距离偏差基本控制在±4m以内,速度偏差不超过2m/s。     

Quadrotor Control Via Robust Generalized Dynamic Inversion and Adaptive Non‐Singular Terminal Sliding Mode

A robust two‐loops structured control system design for quadrotor's position/attitude trajectory tracking is proposed. The aim of the outer loop is to provide the roll/pitch tilting commands to the inner loop, which in turns generates the tilting angles that control the quadrotor's center of gravity in the horizontal plane. The outer loop utilizes Robust Generalized Dynamic Inversion (RGDI) of a prescribed asymptotically stable differential equation in the deviation function of the horizontal position coordinates from their reference trajectories. The inner loop employs an Adaptive Non‐singular Terminal Sliding Mode (ANTSM) to control the tilting angles, in addition to controlling the yaw attitude angle and the vertical position coordinate. The proposed scheme solves the singularity avoidance problems of generalized inversion and terminal sliding mode control. The stability of outer and inner loop is ensured by utilizing positive definite Lyapunov energy function for stable tracking performance against parametric variations and bounded unknown external disturbances. Numerous simulations are conducted on a six Degrees of Freedom (DoF) quadrotor model in the presence of parametric variations, un modeled dynamics, and external disturbances.     

Model‐assisted extended state observer and dynamic surface control–based trajectory tracking for quadrotors via output‐feedback mechanism

In this paper, an output‐feedback trajectory tracking controller for quadrotors is presented by integrating a model‐assisted extended state observer (ESO) with dynamic surface control. The quadrotor dynamics are described by translational and rotational loops with lumped disturbances to promote the hierarchical control design. Then, by exploiting the structural property of the quadrotor, a model information–assisted high‐order ESO that relies only on position measurements is designed to estimate not only the unmeasurable states but also the lumped disturbances in the rotational loop. In addition, to account for the problem of “explosion of complexity” inherent in hierarchical control, the output feedback–based trajectory tracking and attitude stabilization laws are respectively synthesized by utilizing dynamic surface control and the corresponding estimated signals provided by the ESO. The stability analysis is given, showing that the output‐feedback trajectory tracking controller can ensure the ultimate boundedness of all signals in the closed‐loop system and make the tracking errors arbitrarily small. Finally, flight simulations with respect to an 8‐shaped trajectory command are performed to verify the effectiveness of the proposed scheme in obtaining the stable and accurate trajectory tracking using position measurements only.     

Robust dynamic surface trajectory tracking control for a quadrotor UAV via extended state observer

In this paper, we present an extended state observer–based robust dynamic surface trajectory tracking controller for a quadrotor unmanned aerial vehicle subject to parametric uncertainties and external disturbances. First, the original cascaded dynamics of a quadrotor unmanned aerial vehicle is formulated in a strict form with lumped disturbances to facilitate the backstepping design. Second, based on the separate outer‐ and inner‐loop control methodologies, the extended state observers are constructed to online estimate the unmeasurable velocity states and lumped disturbances existed in translational and rotational dynamics, respectively. Third, to overcome the problem of “explosion of complexity” inherent in backstepping control, the technique of dynamic surface control is utilized for trajectory tracking and attitude stabilization, and with the velocity and disturbance estimates incorporated into the dynamic surface control, a robust dynamic surface flight controller that guarantees asymptotic tracking in the presence of lumped disturbances is synthesized. In addition, the stability analysis is given, showing that the present robust controller can ensure the ultimate boundedness of all signals in the closed‐loop system and make the tracking errors arbitrarily small. Finally, comparisons and extensive simulations under different flight scenarios are performed to validate the effectiveness and superiority of the proposed scheme in accurate tracking performance and enhanced antidisturbance capability.     

Quaternion-based robust trajectory tracking control for uncertain quadrotors

This paper presents a robust nonlinear controller design approach for uncertain quadrotors to implement trajectory tracking missions. The quaternion representation is applied to describe the rotational dynamics in order to avoid the singularity problem existing in the Euler angle representation. A nonlinear robust controller is proposed, which consists of an attitude controller to stabilize the rotational motions and a position controller to control translational motions. The quadrotor dynamics involves uncertainties such as parameter uncertainties, nonlinearities, and external disturbances and their effects on closed-loop control system can be guaranteed to be restrained. Simulation results on the quadrotor demonstrate the effectiveness of the designed control approach.     

Switching model predictive attitude control for a quadrotor helicopter subject to atmospheric disturbances

In this article a switching model predictive attitude controller for an unmanned quadrotor helicopter subject to atmospheric disturbances is presented. The proposed control scheme is computed based on a piecewise affine (PWA) model of the quadrotor's attitude dynamics, where the effects of the atmospheric turbulence are taken into consideration as additive disturbances. The switchings among the PWA models are ruled by the rate of the rotation angles and for each PWA system a corresponding model predictive controller is computed. The suggested algorithm is verified in experimental studies in the execution of sudden maneuvers subject to forcible wind disturbances. The quadrotor rejects the induced wind disturbances while performing accurate attitude tracking.     

基于加速度补偿的无人机吊挂飞行抗摆控制

为了抑制四旋翼无人机（UAV）吊挂飞行中的载荷摆动,研究了一种新的基于加速度补偿的抗摆控制方法。首先,基于拉格朗日法建立了四旋翼UAV吊挂系统的非线性动态特性方程,并构建了能量函数来设计飞行控制系统,使四旋翼UAV跟踪参考轨迹;然后,利用吊挂载荷运动轨迹广义误差设计抗摆控制器,对四旋翼UAV进行加速度补偿以修正UAV的运动轨迹,进而抑制因四旋翼UAV快速运动造成的吊挂载荷摆动;最后,通过仿真对加速度补偿前后的UAV吊挂飞行控制效果进行对比分析。仿真结果表明,基于加速度补偿的飞行控制方法不仅能保证UAV吊挂飞行的平稳,而且能为飞行控制系统提供足够的稳定裕度。     

基于RFID技术的四旋翼无人机轨迹跟踪控制系统设计

为促进四旋翼无人机的飞行自主性,增强无人监管情况下飞行器主机所具备的避障行进能力,设计基于RFID技术的四旋翼无人机轨迹跟踪控制系统;采用RFID标签识别技术,调制处理既定控制信号,利用标签识别协议,连接微型四旋翼轨迹控制器与内环姿态控制器,通过数据通信链路,提取轨迹跟踪控制所需的传输电子量,完成轨迹跟踪控制系统硬件设计;利用动力系统中的参数辨识策略,确定与轨迹姿态控制相关的物理规律标注,实现四旋翼无人机轨迹跟踪控制;实验结果表明,与机器视觉型控制系统相比,基于RFID技术的控制系统的SSI避障行进指标数值相对较高,全局最大值达到了 79％,四旋翼无人机滚转角平均值为85°,能够有效抑制四旋翼无人机滚转角的数值上升趋势,增强无人监管情况下飞行器主机避障行进能力.     

基于扩张状态观测器的四旋翼无人机快速非奇异终端滑模轨迹跟踪控制

针对受多源干扰影响的四旋翼无人机系统的轨迹跟踪控制问题进行研究,充分考虑位置回路和姿态回路动态特性,提出一种全回路复合快速非奇异终端滑模轨迹跟踪控制方案.首先,通过变换将轨迹跟踪问题转化为位置回路和姿态回路的指令跟踪控制问题;然后,将各通道之间的耦合以及多源干扰影响视作集总干扰,并基于扩张状态观测器对其进行估计;接着,基于干扰估计信息和快速非奇异终端滑模控制算法,分别在位置回路和姿态回路构造复合快速非奇异终端滑模控制器;最后,基于位置回路和姿态回路虚拟控制量解得无人机真实控制量旋翼转速.仿真结果表明,所提出控制方案显著提升了四旋翼无人机轨迹跟踪的响应速度和抗干扰性能.     

基于模糊不确定观测器的四旋翼飞行器自适应动态面轨迹跟踪控制

针对具有未知外界扰动和系统不确定性的四旋翼飞行器,提出了一种基于模糊不确定观测器（Fuzzy uncertainty observer,FUO）的自适应动态面轨迹跟踪控制方法.通过将四旋翼飞行器系统分解为位置、姿态角和角速率三个动态子系统,使得各子系统虚拟控制器能够充分考虑欠驱动约束;采用一阶低通滤波器重构虚拟控制信号及其一阶导数,实现四旋翼跟踪控制设计的迭代解耦;设计了一种模糊不确定观测器,用以估计和补偿未知外界扰动与系统不确定性,从而确保闭环系统的稳定性和跟踪误差与其他系统信号的一致有界性.仿真研究验证了所提出的控制方法的有效性和优越性.     

Guidance and nonlinear control system for autonomous flight of minirotorcraft unmanned aerial vehicles

Small unmanned aerial vehicles (UAVs) are becoming popular among researchers and vital platforms for several autonomous mission systems. In this paper, we present the design and development of a miniature autonomous rotorcraft weighing less than 700 g and capable of waypoint navigation, trajectory tracking, visual navigation, precise hovering, and automatic takeoff and landing. In an effort to make advanced autonomous behaviors available to mini‐ and microrotorcraft, an embedded and inexpensive autopilot was developed. To compensate for the weaknesses of the low‐cost equipment, we put our efforts into designing a reliable model‐based nonlinear controller that uses an inner‐loop outer‐loop control scheme. The developed flight controller considers the system's nonlinearities, guarantees the stability of the closed‐loop system, and results in a practical controller that is easy to implement and to tune. In addition to controller design and stability analysis, the paper provides information about the overall control architecture and the UAV system integration, including guidance laws, navigation algorithms, control system implementation, and autopilot hardware. The guidance, navigation, and control (GN&C) algorithms were implemented on a miniature quadrotor UAV that has undergone an extensive program of flight tests, resulting in various flight behaviors under autonomous control from takeoff to landing. Experimental results that demonstrate the operation of the GN&C algorithms and the capabilities of our autonomous micro air vehicle are presented. © 2009 Wiley Periodicals, Inc.     

Nonlinear control with integral sliding properties for circular aerial robot trajectory tracking: Real‐time validation

A nonlinear control algorithm for tracking dynamic trajectories using an aerial vehicle is developed in this work. The control structure is designed using a sliding mode methodology, which contains integral sliding properties. The stability analysis of the closed‐loop system is proved using the Lyapunov formalism, ensuring convergence in a desired finite time and robustness toward unknown and external perturbations from the first time instant, even for high frequency disturbances. In addition, a dynamic trajectory is constructed with the translational dynamics of an aerial robot for autonomous take‐off, surveillance missions, and landing. This trajectory respects the constraints imposed by the vehicle characteristics, allowing free initial trajectory conditions. Simulation results demonstrate the good performance of the controller in closed‐loop system when a quadrotor follows the designed trajectory. In addition, flight tests are developed to validate the trajectory and the controller behavior in real time.     

四旋翼无人机抗干扰轨迹跟踪控制

针对四旋翼无人机轨迹跟踪过程中存在的参数不确定与外界干扰问题,设计一种双闭环自适应控制策略.为了降低控制器设计复杂度,根据四旋翼无人机系统的欠驱动特性将系统分成姿态内环和位置外环.在扰动观测器的基础上,利用积分型反步控制算法完成无人机位置信息在外界干扰下的稳定跟踪控制.在扰动观测器的基础上,利用自适应滑模控制算法完成无人机姿态信息在参数不确定和外界干扰作用下的稳定跟踪控制.与传统PID控制和滑模控制进行仿真对比,验证所提出控制策略的优越性.     

Finite-time Adaptive Integral Backstepping Fast Terminal Sliding Mode Control Application on Quadrotor UAV

International Journal of Control, Automation and Systems - This paper presents a reliable and novel quadrotor flight control system designed to enhance trajectory tracking performance, robustness...     

四旋翼飞行器自适应动态面轨迹跟踪控制

针对具有未知外界扰动和系统不确定性集总未知非线性的四旋翼飞行器,提出了一种采用自适应不确定性补偿器的自适应动态面轨迹跟踪方法.通过将四旋翼飞行器系统分解为位置、欧拉角和角速率3个动态子系统,使各子系统虚拟控制器设计能充分考虑欠驱动约束;结合动态面控制技术,通过采用一阶低通滤波器,避免对虚拟控制信号求导;进而设计自适应不确定性补偿器,处理未知外界扰动和系统不确定性,最终确保闭环控制系统的稳定性、跟踪误差一致最终有界和系统所有状态信号有界.仿真研究和实验结果验证了本文提出控制方法的有效性和优越性.     

V2X环境下基于MPC算法的弯道区域CACC车队轨迹跟踪控制策略

针对CACC(cooperative adaptive cruise control)车队在弯道行驶的安全性和稳定性问题,提出一种V2X(vehicle to everything)环境下基于MPC(model predictive control)算法的弯道区域CACC车队行驶轨迹跟踪策略.首先,分析CACC车队在弯道区域的行驶工况以及纵向平衡问题,并基于牛顿第二定律构建车辆在弯道行驶的车辆动力学模型;其次,CACC车队基于V2X技术实现车车之间状态信息的实时交互,并以基于车辆运动学的MPC算法为基础,引入可变间距的车队安全距离控制模型,提出一种适用于弯道区域的轨迹跟踪模型;最后,通过二次规划进行模型求解.实验分析结果表明:V2X环境下的CACC车队在弯道行驶过程中面对不同的行驶工况能够不同程度地保证车车之间的安全性、稳定性以及驾乘人员的舒适性,有效验证了所提V2X环境下基于MPC算法的弯道区域CACC车队轨迹跟踪策略的可行性.     

Experimental quadrotor flight performance using computationally efficient and recursively feasible linear model predictive control

A new linear model predictive control (MPC) algorithm in a state-space framework is presented based on the fusion of two past MPC control laws: steady-state optimal MPC (SSOMPC) and Laguerre optimal MPC (LOMPC). The new controller, SSLOMPC, is demonstrated to have improved feasibility, tracking performance and computation time than its predecessors. This is verified in both simulation and practical experimentation on a quadrotor unmanned air vehicle in an indoor motion-capture testbed. The performance of the control law is experimentally compared with proportional-integral-derivative (PID) and linear quadratic regulator (LQR) controllers in an unconstrained square manoeuvre. The use of soft control output and hard control input constraints is also examined in single and dual constrained manoeuvres.     

Dynamic Modeling and Tracking Control of a Nonholonomic Wheeled Mobile Manipulator with Dual Arms

This paper presents methodologies for dynamic modeling and trajectory tracking of a nonholonomic wheeled mobile manipulator (WMM) with dual arms. The complete dynamic model of such a manipulator is easily established using the Lagrange’s equation and MATHEMATICA. The structural properties of the overall system along with its subsystems are also well investigated and then exploited in further controller synthesis. The derived model is shown valid by reducing it to agree well with the mobile platform model. In order to solve the path tracking control problem of the wheeled mobile manipulator, a novel kinematic control scheme is proposed to deal with the nonholonomic constraints. With the backstepping technique and the filtered-error method, the nonlinear tracking control laws for the mobile manipulator system are constructed based on the Lyapunov stability theory. The proposed control scheme not only achieves simultaneous trajectory and velocity tracking, but also compensates for the dynamic interactions caused by the motions of the mobile platform and the two onboard manipulators. Simulation results are performed to illustrate the efficacy of the proposed control strategy.     

四旋翼飞行器增稳混合控制器

针对四旋翼飞行器在不同环境下的飞行稳定性问题,提出反步法和模糊自适应比例积分微分(PID)方法的混合控制方法。该方法根据无人机(UAV)飞行环境和大倾角、大倾角变化率选择当前合适的控制器。在系统未受扰动时,基于Backstepping的控制方法能够完成飞行器的轨迹跟踪;在受扰动时,基于模糊自适应PID能够极大地抑制扰动带来的影响,实现对四旋翼飞行器的精确控制。通过Matlab仿真分析及实际飞行器实验,验证了增稳混合控制器的稳定性。     

平面四旋翼无人飞行器运送系统的轨迹规划与跟踪控制器设计

对于四旋翼无人飞行器运送系统而言,需要保证飞行过程中负载的摆幅维持在适当的范围内,并且在飞行器到达目的地后负载无残余摆动.本文针对四旋翼无人飞行器运送系统,提出了一种新颖的轨迹规划与跟踪控制方法.论文首先得到了平面四旋翼无人飞行器的运动特性与负载摆角之间的非线性耦合关系.通过相平面内的几何分析,分别设计了两个轴方向上的分段式加速度轨迹.这种轨迹具有简洁的解析表达式并可获得较高的运送效率,同时满足飞行器的速度,加速度等物理约束.为了使四旋翼无人飞行器准确跟踪规划好的轨迹,本文基于反步法设计了一种非线性跟踪控制器,并通过李雅普诺夫方法对其闭环稳定性进行分析,证明其能使跟踪误差指数收敛于零.论文最后通过仿真结果验证了本文所提出方法的可行性与有效性,及其对外界干扰的鲁棒性.