导航飞控系统是无人机的“大脑”和“中枢神经”,负责控制飞行姿态、执行导航任务并保障飞行安全。它在部分情况下,按具体功能又可划分为导航子系统和飞控子系统两部分。导航子系统如同无人机的“眼睛”,负责向无人机提供相对于所选定的参考坐标系的位置、速度、飞行姿态等矢量信息,引导无人机沿指定航线安全、准时、准确地飞行;飞控子系统则如同无人机的“驾驶员”,负责起飞、飞行、任务执行和回收等全过程的操作与控制。
一、硬件组成部分
导航飞控系统的硬件基础主要由 飞行控制器(飞控计算机) 、传感器系统、执行机构接口以及电源与接口电路等构成。

1. 飞行控制器(飞控计算机)
飞行控制器是导航飞控系统的核心部件,负责处理传感器数据、执行飞行指令并控制电机。从硬件构造来看,飞控计算机由以下关键模块组成:
主处理控制器:包含MPU(微处理器)、MCU(微控制器)、DSP(数字信号处理器)等,部分系统采用FPGA技术实现高度定制化的并行处理能力。
二次电源:提供5V、±15V等直流电压,需对一次电源进行变换,确保各模块稳定供电。
模拟量输入/输出接口:用于传感器信号的采集处理以及伺服控制信号的转换输出。
离散量接口:处理开关信号,如起落架收放状态、任务载荷开关等。
通信接口:支持RS232/RS485等总线通信方式,用于与地面站、任务设备等进行数据交互。
余度管理:采用双余度配置,包括信息交换、同步指示、故障逻辑综合及故障切换电路,以提高系统可靠性。
加温电路:用于恶劣低温环境下保证电子元器件的正常工作。
检测接口:便于连接外部检测设备,进行系统调试和故障诊断。
机箱:飞控计算机的物理外壳,其结构设计直接影响系统的可靠性与使用寿命。
2. 传感器系统
传感器系统是导航飞控系统的“感知层”,负责采集飞行器状态参数,为控制算法提供数据基础。主要传感器类型及作用包括:
陀螺仪:检测三轴角速度(俯仰、偏航、滚转),提供姿态变化的动态数据。类型包括机械陀螺仪、MEMS陀螺仪、光纤陀螺仪等。
加速度计:测量线性加速度,辅助确定位置、方向及震动状态。MEMS加速度计为主流,部分采用热感应技术(无移动部件)。
磁力计(电子罗盘) :作为电子指南针,提供航向信息,与GPS协同增强方向感知能力。
GPS/北斗模块:提供经纬度定位、高度和速度信息,支持定位悬停、航点飞行和自动返航等功能。
气压计:通过测量大气压估算高度,辅助实现定高飞行。
其他辅助传感器:包括空速传感器(测量飞行速度)、超声波测距传感器(近地高度测量)、发动机转速传感器等。
此外,从系统设计的角度看,角速度传感器用于反馈转动角速率,姿态传感器用于测量俯仰、滚转和航向,高度空速传感器用于获取飞行高度和空速,位置传感器用于确定飞行器位置。各传感器的安装需充分考虑精度要求、环境影响及安装位置等因素,以确保系统稳定与可靠。
3. IMU(惯性测量单元)
IMU是导航飞控系统中的关键惯性传感组件,集成了加速度计和陀螺仪,用于测量加速度、角速度和姿态信息。IMU的测量数据经融合处理后,可为飞行控制器提供连续、高频率的姿态与位置估计,是姿态稳定控制和导航解算的基础。
4. 执行机构接口与伺服系统
执行机构接口电路用于将飞控计算机生成的控制指令转换为驱动电机、舵机等执行机构的电信号,实现对无人机动力系统和气动舵面的精确控制。典型的伺服控制信号输出通过模拟量输出接口或PWM(脉冲宽度调制)接口实现。
二、软件组成部分
导航飞控系统的软件部分,即机载飞控软件(飞控程序),是一种运行于飞控计算机上的嵌入式实时任务软件,不仅要求功能正确、性能好、效率高,而且要求具有较好的质量保证、可靠性和可维护性。
机载飞控软件按功能可以划分成以下核心功能模块:
硬件接口驱动模块:负责底层硬件设备的初始化、数据读写和中断管理,屏蔽硬件差异,为上层应用提供统一的接口。
传感器数据处理模块:完成传感器原始数据的采集、滤波、校准和融合处理,输出准确的姿态、位置、速度等状态估计。
飞行控制律模块:实现姿态稳定控制和轨迹跟踪控制的核心算法,根据期望状态和实际状态的误差计算控制指令。
导航与制导模块:负责导航解算、航迹规划、制导指令生成等,引导无人机沿预定航线飞行。
飞行任务管理模块:管理飞行模式(如手动、增稳、自动悬停、航点飞行、自动返航等)的切换与状态机的调度。
任务设备管理模块:管理与控制任务载荷(如云台相机、投放装置等)的工作状态和数据交互。
余度管理模块:协调双余度或多余度配置下的信息交换、同步指示、故障逻辑综合和故障切换。
数据传输与记录模块:负责与地面站之间的上下行数据通信,以及飞行数据的存储与记录。
自检测模块:实现系统上电自检和飞行中在线监测,及时发现并报告故障。
一个完整的飞控软件在设计上还需包含通信模块、控制输入模块(来自地面站或自动控制模块)、参数管理模块、起飞/着陆检测模块、应急处置/健康管理模块以及固件升级模块等扩展功能。
三、核心处理器架构特点
导航飞控系统中常用的核心处理器包括 MCU(微控制器) 、 MPU(微处理器) 、 DSP(数字信号处理器) 和 FPGA(现场可编程门阵列)。它们在架构上各有特点,适用于不同的功能需求。
1. MCU(微控制器)
MCU将CPU、存储器(RAM/ROM)、定时器、I/O接口等集成于单一芯片上,具有体积小、功耗低、成本低、易于开发等特点,适用于对计算性能要求不高的飞控场景,如小型无人机或飞控系统的辅助管理功能。
2. MPU(微处理器)
MPU通常指功能更强大的通用处理器,具有更高的主频和更强的计算能力,适合运行复杂的操作系统和飞控算法。在高端无人机飞控系统中,MPU可作为主计算单元,承载导航解算、任务管理等高负载应用。
3. DSP(数字信号处理器)
DSP针对数字信号处理算法进行了架构优化,具有乘加运算指令、流水线操作和并行处理能力,适合执行复杂的滤波、FFT变换、惯性导航解算等算法。DSP满足导航计算机对解算算法的高精度要求。在飞控系统中,DSP通常用于传感器数据融合、姿态解算和控制律计算。
4. FPGA(现场可编程门阵列)
FPGA是一种可以通过编程改变内部硬件结构、实现所需功能的芯片,由可编程互连连接的可配置逻辑块(CLB)矩阵构成。与MCU、DSP等硬件资源固定、只能通过修改软件实现功能的处理器不同,FPGA通过硬件描述语言或其它方式修改硬件,将FPGA变为CPU或专用芯片,来实现控制或算法。
FPGA的基本结构包括可编程输入输出单元、可配置逻辑块、数字时钟管理模块、嵌入式块RAM、布线资源、内嵌专用硬核及底层内嵌功能单元。由于具有布线资源丰富、可重复编程和集成度高的特点,FPGA在数字电路设计领域得到广泛应用。目前的FPGA还提供了大量的DSP核、ARM CPU核、外网控制器等功能,可以通过FPGA动态构建一个CPU+DSP+RAM+外设控制器的单芯片计算机系统。
5. DSP+FPGA组合架构
在当前的导航飞控系统设计中,DSP+FPGA组合架构已成为最主流的选择。DSP满足导航计算机对解算算法的高精度要求,而FPGA众多的接口便于实现功能自定义,即使有外接扩展其他设备的需求也能十分灵活地应对。这一组合在保证高性能、高可靠性的核心要求前提下,也符合了小体积、低功耗的新发展要求。最重要的是,整个系统后期的升级维护方便,确定的硬件不需要升级和改变,只需要对相应的软件算法进行升级迭代就可以设计定制化极强的导航计算机。
从通用性的角度看,MCU、DSP能够实现的功能,FPGA理论上都可以实现,反之则不一定,这体现了FPGA在系统设计中的高度灵活性。
四、关键传感器类型及作用
导航飞控系统中传感器种类繁多,从功能上可分为姿态测量、定位导航、高度速度测量和环境感知等类别。以下为核心传感器的详细分析:
1. 陀螺仪(角速度传感器)
类型:机械陀螺仪、MEMS陀螺仪、光纤陀螺仪等。
功能:检测三轴角速度(俯仰、偏航、滚转),提供姿态变化的动态数据,是姿态稳定控制的基础。
作用机制:通过感知无人机绕各轴的转动角速率,为飞控系统提供角速度反馈,用于阻尼控制和姿态变化率的测量。
2. 加速度计
类型:以MEMS加速度计为主流,部分采用热感应技术(无移动部件)。
功能:测量线性加速度,辅助确定位置、方向及震动状态。
作用机制:通过测量无人机在机体坐标系三个轴向上的加速度分量,可解算出姿态角(与陀螺仪数据融合)以及平移运动的加速度信息。
3. 磁力计(电子罗盘)
功能:作为电子指南针,提供航向信息,与GPS协同增强方向感知。
作用机制:通过测量地球磁场在机体坐标系中的分量,计算无人机的航向角,辅助飞行控制器进行方向控制。在GPS信号较弱或失效时,磁力计提供的航向信息对于保持飞行方向至关重要。
4. GPS/北斗模块
功能:提供精确的经纬度定位、高度和速度信息,支持定位悬停、航点飞行和自动返航等功能。
作用机制:通过接收卫星信号,计算无人机在地理坐标系中的绝对位置和速度,为导航子系统提供定位信息。
5. 气压计
功能:测量大气压以估算高度,辅助实现定高飞行。
作用机制:根据大气压随高度变化的规律,通过测量当前气压推算绝对海拔高度或相对高度,在GPS高度信息不可靠时(如室内、城市峡谷等环境)尤为重要。
6. 其他辅助传感器
空速传感器:测量无人机相对空气的飞行速度,对于固定翼无人机的飞行控制至关重要。
超声波测距传感器:用于近地高度测量,在起降阶段辅助精确测高。
发动机转速传感器:监测动力系统的运行状态,保障飞行安全。
五、典型控制算法分类及应用场景
导航飞控系统中的控制算法是系统的“决策层”,负责处理传感器数据并生成控制指令。现有飞行控制算法可大致分为线性控制算法和非线性控制算法两大类。
1. 线性控制算法
线性控制算法适用于飞行条件不复杂、轨迹和姿态变化平缓的场景,是早期自主飞行的主要控制方案。
PID控制(比例-积分-微分控制)
特点:属于经典控制,基于误差调节系统输出,简单、鲁棒且通用。
原理:PID控制器根据期望状态与实际状态之间的误差,分别通过比例(P)、积分(I)和微分(D)三项计算控制输出。其中比例项响应当前误差,积分项消除稳态误差,微分项预测误差变化趋势以增加系统阻尼。
应用场景:广泛应用于无人机的姿态稳定控制、速度控制和高度控制等。作为闭环控制系统,PID控制器能够根据误差调整飞行器的控制输入,实现对期望状态的跟踪。在自动驾驶中适用于速度、转向等控制。
优势与局限:结构简单、参数物理意义明确、易于工程实现;但对强非线性、强耦合和多约束系统的控制效果有限。
LQR控制(线性二次型调节器)
特点:属于优化控制,基于状态反馈优化控制律,适用于线性系统,易于设计且稳定。
原理:LQR通过最小化一个包含状态偏差和控制能量的二次型代价函数,求得最优状态反馈增益矩阵,从而使系统在满足控制能量约束的前提下获得最优的动态响应。
应用场景:适用于轨迹跟踪和姿态控制,在飞行条件相对简单、可线性化的场景中表现良好。对于轨迹跟踪,线性控制仅能在轨迹和飞行条件不复杂时应用。
优势与局限:提供系统化的最优设计框架,具有较好的稳定裕度;但要求系统模型精确,对模型不确定性和外部扰动的鲁棒性有限。
LQG/H∞控制
特点:LQG(线性二次高斯控制)结合了LQR和卡尔曼滤波器,适用于含有高斯噪声的系统;H∞控制则通过最小化干扰到输出的传递函数的无穷范数来增强鲁棒性。
应用场景:适用于存在测量噪声和模型不确定性的飞行控制系统,可提高系统的抗干扰能力。
2. 非线性控制算法
非线性控制是为克服四旋翼等无人机强耦合非线性特性而发展起来的控制方法。
MPC控制(模型预测控制)
特点:属于预测控制,基于系统模型预测未来状态,适用于非线性系统和受限系统,具有灵活性和自适应性。
原理:MPC利用系统模型预测其未来行为,并在每个控制周期内求解一个有限时域优化问题,得到最优控制序列。
应用场景:适用于需要考虑执行机构饱和、状态约束和安全包线限制的复杂飞行任务,如密集环境下的避障飞行、编队飞行等。
优势与局限:能够显式处理约束条件,具有良好的跟踪性能;但计算量大,对实时性要求高。
滑模控制
特点:属于非线性控制,通过滑动曲面实现系统状态趋近期望值,具有抗干扰和快速响应特点。
原理:设计一个滑模面,使系统状态在有限时间内到达并沿滑模面滑动,从而对系统参数变化和外部扰动表现出强鲁棒性。
应用场景:适用于复杂环境下的路径规划和避障,以及存在较大参数不确定性和外部扰动时的飞行控制。
优势与局限:鲁棒性强,响应速度快;但可能产生抖振现象,需采取相应抑制措施。
自适应控制
特点:属于学习控制,通过在线学习调整控制律,适应不确定环境,具有自学习和自调节能力。
原理:控制系统根据实时辨识的系统参数或性能指标,在线调整控制器参数或结构,以适应飞行条件的变化。
应用场景:适用于飞行包线变化大、气动参数不确定的飞行器,以及任务环境复杂多变的场景。
优势与局限:能够有效应对参数时变和模型不确定性;但算法复杂度高,需要充分的激励信号以保证参数收敛。
神经网络控制
特点:利用神经网络的学习能力逼近非线性映射关系,在飞行控制中已被广泛尝试。
应用场景:适用于存在强非线性和不确定性的控制问题,以及需要从数据中学习控制策略的智能飞行场景。
六、完整系统架构与工作流程
一个完整的导航飞控系统在工作时遵循“感知—决策—执行”的基本流程:
感知层:传感器系统(IMU、GPS/北斗、磁力计、气压计等)实时采集无人机的姿态、位置、速度、高度等状态信息。
处理层:飞控计算机中的主处理控制器(MCU/MPU/DSP/FPGA)通过硬件接口驱动模块读取传感器数据,并经传感器数据处理模块完成滤波、校准和融合,得到精确的状态估计。
决策层:飞行控制律模块根据期望状态与实际状态的误差,调用PID、LQR、MPC、滑模控制等算法计算出控制指令;导航与制导模块负责航迹规划和制导指令生成。
执行层:控制指令通过模拟量输出接口或通信接口传递给电机、舵机等执行机构,调整无人机的动力输出和气动面偏转,实现对飞行姿态和轨迹的控制。
管理闭环:飞行任务管理模块负责飞行模式的调度与切换,余度管理模块保障系统可靠性,数据传输与记录模块实现与地面站的通信和飞行数据存储。
七、总结
导航飞控系统的组成可以从硬件和软件两个维度加以理解。在硬件层面,它以飞行控制器为核心,辅以IMU、GPS/北斗模块、电子罗盘等关键传感器以及执行机构接口和电源管理模块。在软件层面,它由硬件接口驱动、传感器数据处理、飞行控制律、导航与制导、飞行任务管理、余度管理、数据记录和自检测等功能模块构成的嵌入式实时任务软件驱动。
在核心处理器架构上,MCU、MPU、DSP和FPGA各有其适用场景,DSP+FPGA组合因兼具高精度解算能力与灵活接口扩展能力,成为当前导航计算机的主流选择。控制算法层面,从经典的PID到优化的LQR,再到先进的MPC、滑模控制和自适应控制,形成了适用于不同飞行场景和任务需求的完整算法谱系。传感器系统则为整个系统提供了精确、可靠的状态感知基础。
导航飞控系统作为无人机最核心的子系统,其设计水平直接决定了无人机的飞行性能、自主性和安全性。随着处理器性能的提升、传感器精度的提高以及控制算法的发展,导航飞控系统正朝着更高度的集成化、智能化和自适应方向发展。
