本项目设计融合四轴飞行器、遗传算法和Matlab等技术，研发具有能自主规划航迹，实现从无人机遥控飞行技术向智能化地自主规划航迹飞行技术的转变，并且重点解决无人机在威胁代价(地形、环境等)下实现无人工控制、自主地规划航迹并完成任务的复杂智能技术问题从而提高任务的完成率以及大大缩短任务的完成时间 [ 4 ]。该系统的组成角色包括地面站、四轴飞行器和通讯平台等，各种角色所具备的功能如下：

1) 地面站：使用者通过地面站可以浏览和查询所连接的四轴飞行器的飞行高度，状态以及位置，接收飞行器的信号，并且还可以向四轴飞行器发送飞行的指令。

2) 四轴飞行器：注册并认证后的四轴飞行器可以在此系统中的地面站进行连接，接受地面站的信号信息，同时具有可以向地面站发送讯号以及相关信息的功能。

3) 通讯平台：连接地面站和四轴飞行器，为地面站与四轴飞行器之间讯号以及相关信息相互传输提供中间平台。

1) 在全局规划阶段，基于等效数字地形，建立数字高程地图，数字高程地图是用地形采样点的经纬度和标高组成的数值阵列表示，要用于地形仿真、任务规划和地形的三维显示等。

2) 采用MAVLink通讯协议，来构建电脑地面站与无人机飞控之间的通讯协议，提供无人机飞行的位置信息和周围的环境信息，解决威胁飞行的信息，实现一键起飞的算法控制，提高飞行器飞行安全；

3) 本项目在C#的环境下，搭建地面站，满足硬件之上的操作系统部分，包含驱动、操作系统、应用接口，以及系统之上的应用软件部分的主要功能，有摇杆遥控、飞行数据监测、飞行姿态、飞行定位、航拍视频、数据存储、航点编辑、软件设置等。

4) 利用数字地图将三维地形上的路径寻优问题转化成状态空间最优解的搜索问题，并采用遗传算法搜索最优解，进行航迹规划。

5) 对遗传算法进行改进，对最优航迹路线进行平滑处理，实现航迹规划更加平稳，提高飞行器的安全性。

6) 对四轴无人机优化后的航迹进行仿真实验，与未经优化的航迹进行对比，最终实现飞行器稳定安全飞行。

图1. 无人机航迹规划原理

飞行器进行路径规划之前首先要建立地图，本文采用栅格法建立移动飞行器的行走空间模型。栅格面积越小，空间中各种环境信息表示越精确，但同时占用的存储空间就会加大，算法所使用的搜索时间就会加大。若栅格面积越大，则空间中各种环境信息不能准确表示出来，容易出现碰撞问题。所以在建立环境模型时，需要先做以下规定：

1) 不考虑障碍物高度问题，飞行器行走空间为二维平面空间；

2) 障碍物的大小、位置已知，并且不存在动态障碍物；

3) 在规划时可以把飞行器看作质点处理。

为了方便设置栅格面积，我们通常用正方形表示飞行器的行走空间。如果障碍物面积小于正方形面积，可以将障碍物扩大为正方形；如果障碍物面积大于正方形面积，可以用两个正方形表示障碍物面积；如果障碍物面积更大 [ 5 ]，则可以用多个正方形表示。建模后飞行器行走空间如图1所示，图中白色部分为自由栅格，黑色部分为障碍物栅格。

在构建栅格地图时，首先以地图左下角第一个栅格为坐标原点建立直角坐标系。因此每一个栅格可以用(x,y)的坐标形式表示，比如左下角第一个栅格可以表示为(1,1)。并且从左下角开始每一个栅格进行编号N，编号从0开始。编号和坐标的转换公式为：

x = int ( N / G s i z e ) + 1 y = N % G s i z e + 1

Gsize为每一行栅格数，int为取整操作。已为每一个栅格编好号码，因此可以用此编号来表示一条路径，比如起点为0终点为24的路径可以表示为(0, 6, 7, 8, 13, 19, 24)，在遗传算法中即为十进制编码。

遗传算法是一种智能优化算法，主要用来解决优化问题，其主要步骤为种群初始化、适应度函数计算、选择、交叉和变异。应用于移动飞行器路径规划时其主要步骤相同，流程图如图2所示。具体每步的方法将在以下小节做详细介绍。

飞行器的起始位置为栅格0，目标位置为栅格99。初始化种群要求随机产生多条可行路径，可行路径表示不与障碍物栅格相碰撞的路径。可行路径的产生分为两个主要步骤。第一步首先产生一条间断路径。飞行器每次行走一个栅格，因此每一行至少有一个栅格在可行路径中。所以初始化时先按顺序在每一行随机取出一个无障碍栅格，形成一条间断的路径，其中为了减短路径长度路径的第一个和最后一个栅格分别为飞行器的起始位置和目标位置 [ 6 ]。

第二步是将间断的路径连接为连续路径。在这一步中首先从第一个栅格开始判断相邻的两个栅格是否为连续栅格，栅格是否连续的判断方法为：

D = max { a b s ( x i + 1 − x i ) , a b s ( y i + 1 − y i ) }

若D等于1则说明两个相邻栅格连续，反之不连续。对于不连续的栅格取两个栅格的中点栅格，中点栅格的坐标计算为：

x n e w = int ( x i + 1 + x i 2 ) y n e w = int ( y i + 1 + y i 2 )

若新栅格为障碍物栅格则以上下左右顺序取新栅格的相邻栅格，并判断此栅格是否已经在路径中(防止陷入死循环)，如果此栅格为无障碍栅格且不在路径中则插入路径中，如果遍历上下左右四个栅格后没有满足条件的栅格则删除这条路径；若新栅格为无障碍物栅格，则插入两个不连续栅格中间。继续判断新插入的栅格和新插入的栅格的前一个栅格是否连续，若不连续则循环以上步骤，直到两个栅格连续。当两个栅格连续后取下一个栅格，循环以上步骤，直到整条路径连续。初始化一条路径的流程图如图3所示。

图2. 遗传算发流程图

图3. 初始化种群流程图

适应度函数分成两部分，分别用来判断路径的长短和平滑程度。路径长度的计算相对简单，公式如下：

d 总 = ∑ i = 1 e n d − 1 ( x i + 1 − x i ) 2 + ( y i + 1 − y i ) 2

要求的是飞行器的路径最短，而选择方式采用的是轮盘赌的方式，所以适应度函数的第一部分为：

f i t = 1 / d 总

飞行器由于运动学和动力学的约束，行进时拐弯不宜过大，并且相对平滑的路径有利于飞行器的行驶，因此产生的路径有平滑度的要求。路径越平滑，相邻三点形成的角度越大，角度越大相邻三点之间的距离越大，因此计算路径中所有相邻三点的距离作为适应度函数的第二部分，计算公式如下：

d 3 = ∑ i = 1 e n d − 2 ( x i + 2 − x ) 2 + ( y i + 2 − y i ) 2

d₃的值可对应路径中连续三点的夹角的四种情况分别为180度、钝角、直角和锐角，其中180度的三点成一直线，平滑度最好，钝角、直角次之。由于飞行器动力学的约束，锐角是不允许的。所以分别对除直线外的3种情况给予惩罚，分别为5、30和无穷大，可以根据实际情况改动惩罚的大小。惩罚之和的倒数即为适应度函数的第二部分。

适应度函数的两部分需要取一个权重，权重公式如下：

f i t = a f i t 1 + b f i t 2

根据路径长度和平滑度之间的权重选择参数a和b。

选择方法采用简单的基于概率的轮盘赌方法 [ 7 ]。首先计算出所有个体的适应度函数的和，再计算每一个个体所占的比率，计算公式如下

p i = f i t / ∑ i = 1 e n d f i t i

然后根据每个个体的概率，以轮盘赌的方式选择出下一代个体。轮盘赌的方式保证了部分非最优的个体，可以有效的防止算法陷入局部最优解。

首先需要确定一个交叉概率pc，产生0~1之间的一个随机数，并和交叉概率pc比较，若小于pc则进行交叉操作。交叉方式采用的是单点交叉的方式，具体的交叉操作是找出两条路径中所有相同的点，然后随机选择其中的一个点，将之后的路径进行交叉操作。具体的流程图如图4所示，其中n为路径数(即种群数量)。

图4. 交叉方法流程图

首先需要确定一个变异概率pm，产生0~1之间的一个随机数，并和变异概率pm比较，若小于pm则进行变异操作。变异方法是随机选取路径中除起点和终点以外的两个栅格，去除这两个栅格之间的路径，然后以这两个栅格为相邻点，使用初始化路径中的第二步将这两个点进行连续操作。此时有可能无法产生连续的路径，则需要重新选择两个栅格执行以上操作，直到完成变异操作 [ 8 ]。具体的流程图如图5所示，其中n为路径数(即种群数量)。

图5. 交叉方法流程图