[发明专利]一种基于矢量域的小型无人机风场抗扰自适应控制方法

权利要求书

1.一种基于矢量域的小型无人机风场抗扰自适应控制方法，其特征在于实现步骤如下：

(1)小型无人机接收到上传的期望航迹后，将三维空间运动分解基于地速和航迹角的二维平面运动和基于高度的横侧向运动；在满足小型无人机最小转弯半径、最大飞行速度和最大滚转角限制条件后，基于过段落连接点原则，将任意两个航点间的任意飞行轨迹转换为由一系列由不同圆心和半径的圆弧段和直线段构成的圆弧段期望航迹和直线段期望航迹；

(2)针对期望航迹段，针对直线段期望航迹，基于小型无人机与期望直线轨迹间的水平误差d，构建期望直线段的航迹控制矢量域，为小型无人机水平面上的航迹控制提供控制指令；针对每一个独立的圆弧段期望航迹，基于小型无人机当前位置与目标圆弧段的圆心的距离d₁，和小型无人机当前位置到圆心的直线与正北方向的夹角γ构建期望圆弧段的航迹控制矢量域，为小型无人机水平面上的航迹控制提供控制指令；在期望航迹交界处，以小型无人机位置和当前直线段或圆弧段的终点间的距离作为过段落连接点评估标准，仅当系统过段落连接点，小型无人机才转入下一个连接段；

(3)基于步骤(2)期望直线段的航迹控制矢量域和期望圆弧段的航迹控制矢量域，针对直线段期望航迹和圆弧段期望航迹，分别构建直线段滑模面和圆弧段滑模面，利用饱和函数构建直线段滑模变结构控制器和圆弧段滑模变结构控制器来提高小型无人机对环境系统的适应性。

2.根据权利要求1所述的基于矢量域的小型无人机风场抗扰自适应控制方法，其特征在于：所述步骤(1)基于地速和航迹角的二维平面运动如下：

x·=Vacosψ+Wx=Vgcosη]]>y·=Vasinψ+Wy=Vgsinη]]>

其中，x，y分别为小型无人机在北东地坐标系下的x和y方向的坐标值，V_a和ψ分别为小型无人机的空速和偏航角，W_x和W_y分别为风速在水平坐标上的投影，η为小型无人飞行器的位置航向与期望航迹的夹角；V_g为地速信息，由机载GPS传感器获得。