基于无人机飞行模态的控制系统设计及飞行测试方法
基于无人机飞行模态的控制系统设计及飞行测试方法
【技术领域】
[0001] 本发明设及基于无人机飞行模态的控制系统设计及飞行试验方法，属于无人机自 主飞行控制领域。
【背景技术】
[0002] 低成本高适应性小型民用无人机，是一种完全自主型的民用无人机，可W通过无 线遥控或程序来操纵执行不同的飞行任务。搭载不同的任务载荷，W自动飞行控制系统、机 载传感器和无线通信设备等为基础，民用无人机能够完成有人飞机难W完成的危险任务。 在灾害监测、交通管制、广播通信、海上捜救、气象预报、地图测绘等民用方面有着广泛的应 用和广阔的发展前景。
[0003] 近年来，我国无人机呈现蓬勃发展趋势，越来越多的中小型企业开展了民用无人 机研制工作，国家的政策也采取积极鼓励的态度。面对市场的激烈竞争和用户的不同需求， 民用无人机往低成本、高适应性、小型化、多用途等方向发展。
[0004] 虽然一些现代非线性控制方法设计的控制系统在鲁椿性有着明显的优势，但对传 感器和机载计算机等机载设备提出更高的要求，该势必增加了整套无人机的研制成本。专 利申请号201410608597. 8名称为"一种基于PID神经网络的无人机控制方法"申请公开了 一种无人机的控制方法，其主要优点是控制精度高，抗干扰能力强，鲁椿性好的。该控制方 法依赖于无人机精确性建模，而其用到的无人机动力学模型依然是近似的模型，且其仅仅 处于MATLAB仿真阶段，并未完全的实现到具体工程应用中。实际上非线性控制结构大多较 为复杂，并且设计出来的控制器参数的准确性完全依赖于建立的无人机数学模型，然而无 人机模型难W获得十分精确的模型，设计出来的控制器参数也不方便飞行调参，该些都增 加了整个控制系统设计难度和周期。因此，为降低研制成本，基于空中飞行模态，设计了一 套结构简单且易于实现的控制系统来满足无人机飞行控制性能，W适应不同环境下的复杂 飞行任务。
[0005] 为了检验所设计的无人机飞行模态的控制系统有效性，需要拟定飞行模态具体的 测试办法和控制策略。专利申请号200810100893. 1名称为"一种无人机多模态控制与切换 方法"针对无人机本身及其飞行任务的特点，确定和划分飞行控制系统的控制模态，实现多 模态控制管理问题。但其并未设及飞行模态具体的测试办法和各个飞行模态进行测试时的 控制策略问题。
【发明内容】
[0006] 本发明为了简化现有控制系统的结构，降低成本和缩短研制周期，提出了一套简 单易工程实现的飞行控制系统，并通过控制策略来实现飞行模态的测试，W适应一种低成 本高适应性小型化的民用无人机。
[0007] 基于无人机飞行模态的控制系统设计方法，包括W下步骤：
[000引步骤一，无人机六自由度数学建模，建立纵向和侧向数学模型；
[0009] 无人机纵向模型为：
[0010]
【主权项】
1.基于无人机飞行模态的控制系统设计方法，其特征是，包括以下步骤： 步骤一，无人机六自由度数学建模，建立纵向和侧向数学模型； 无人机纵向模型为：
步骤二，选取无人机定直平飞为平衡状态，分别对纵向和侧向数学模型进行小扰动线 性化处理； 无人机纵向小扰动线性化模型为：
无人机侧向小扰动线性化模型为：
步骤三，在纵向小扰动线性化模型的基础上进行拉普拉斯变换，得到以升降舵δe为输 入，分别以俯仰角Θ、迎角α和速度V为输出的传递函f
步骤四，在侧向小扰动线性化模型的基础上进行拉普拉斯变换，得到以副翼δ a和方 向舵δ ^为输入，分别以滚转角φ、偏航角φ为输出的传递函数
步骤五，以无人机的气动和结构参数为依据，采用经典的控制理论的根轨迹法、频域分 析法和阶跃响应法，分别对控制系统，按照控制结构从内到外的层次，依次进行控制器参数 的设计； 步骤六，设计俯仰角保持与控制模态控制器参数；输入为期望的俯仰角0g，控制律 为：
(5) 其中，彡为俯仰角速度，Θ为俯仰角，\为升降舵；为俯仰角速度控制器，采用P控 制；为俯仰角控制器，为了提高控制精度，消除静差，采用PI控制； 步骤七，设计高度保持与控制模态控制器参数；其是基于俯仰角保持与控制结构上的 设计，输入为期望的高度Hg，控制律为：
其中，彳为高度变化率，H为高度；夂f为高度变化率控制器，采用P控制；夂f为高度 控制器，为了提高控制精度，消除静差，采用PI控制； 步骤八，设计速度保持与控制模态控制器参数；其是基于俯仰角保持与控制结构上的 设计，输入为期望的速度vg，控制律为：
其中，V为速度；<'为速度控制器，为了提高控制精度，消除静差，采用PI控制。 步骤9,设计滚转角保持与控制模态控制器参数；输入为期望的滚转角Φ8，控制律为：
(8) 其中，#为滚转角速度，Φ为滚转角，#"?扁航角速度，δ 3为副翼，δ ^为方向舵；为 滚转角速度控制器，采用P控制；尤f为滚转角控制器，为了提高控制精度，消除静差，采用 PI控制。 4 为协调控制，下同。#为协调转弯偏航角速度控制器，采用ρ控制； 为协调转弯滚转角控制器，采用P控制； 步骤十，设计航向角保持与控制模态控制器参数；其是在滚转角保持与控制结构上的 设计，输入为期望的航向角(6(;，控制律为：
(9) 其中，Φ为航向角；^为航向角控制器，为了提高控制精度，消除静差，采用PI控制； 步骤十一，设计偏航距控制模态控制器参数；其是在航向角保持与控制结构上的设计， 输入为期望的航向角Φ 8和期望的偏航距y g，控制律为：
其中，y为侧偏距；^为侧偏距控制器，为了提高控制精度，消除静差，采用PI控制。
2.基于无人机飞行模态的飞行测试方法，其特征是，包括以下步骤： 步骤一，测试俯仰角保持与控制模态：纵向采用俯仰角保持与控制模态，侧向采用零度 滚转角保持与控制模态。测试时，期望的俯仰角9g包含正负的多组数值，并保证自主模态 飞行时间至少达到Imin ; 步骤二，测试高度保持与控制模态：纵向采用高度保持与控制模态，侧向采用零度滚转 角保持与控制模态；测试时，期望的高度％分为当前高度和给定的高度两种情形，并保证自 主模态飞行时间至少达到Imin ; 步骤三，测试速度保持与控制模态：纵向采用速度保持与控制模态，侧向采用零度滚转 角保持与控制模态；测试时，期望的速度\分为当前高度和给定的速度两种情形，并保证自 主模态飞行时间达到Imin ; 步骤三，测试滚转角保持与控制模态：纵向采用高度保持与控制模态，侧向采用滚转角 保持与控制模态；测试时，期望的滚转角Φ8包含正负的多组数值，保证无人机左/右盘旋。 并保证自主模态飞行时间达到Imin ; 步骤四，测试航向角保持与控制模态：纵向采用高度保持与控制模态，侧向采用航向角 保持与控制模态；测试时，期望的航向角Φ g为当前航向角和给定航向角两种情形，并保证 自主模态飞行时间至少达到Imin ; 步骤五，测试侧偏距控制模态：纵向采用高度保持与控制模态，侧向采用侧向偏离控制 模态；测试时，期望的侧偏距yg为零，并保证自主模态飞行时间至少达到lmin。
【专利摘要】基于无人机飞行模态的控制系统设计及飞行试验方法，属于无人机自主飞行控制领域，将无人机飞行控制系统分为纵向和侧向两大部分来设计，纵向控制又分为俯仰角保持与控制模态、高度保持与控制模态和速度保持与控制模态，侧向控制又分为滚转角保持与控制模态、航向角保持与控制模态和侧偏距控制模态；并提出对每个模态进行飞行测试的不同控制策略：包括以下步骤，测试俯仰角保持与控制模态；测试高度保持与控制模态；测试速度保持与控制模态；测试滚转角保持与控制模态；测试航向角保持与控制模态；测试侧偏距控制模态；本发明设计周期短，易于工程实现，对快速开发研制一种低成本高适应性小型民用无人机控制系统具有极为重要的实现意义。
【IPC分类】G05D1-10
【公开号】CN104865969
【申请号】CN201510213554
【发明人】王元超, 段镇, 厉明, 高九州, 张恩阳, 孙辉, 何利文
【申请人】中国科学院长春光学精密机械与物理研究所
【公开日】2015年8月26日
【申请日】2015年4月30日
【技术领域】
[0001] 本发明设及基于无人机飞行模态的控制系统设计及飞行试验方法，属于无人机自 主飞行控制领域。
【背景技术】
[0002] 低成本高适应性小型民用无人机，是一种完全自主型的民用无人机，可W通过无 线遥控或程序来操纵执行不同的飞行任务。搭载不同的任务载荷，W自动飞行控制系统、机 载传感器和无线通信设备等为基础，民用无人机能够完成有人飞机难W完成的危险任务。 在灾害监测、交通管制、广播通信、海上捜救、气象预报、地图测绘等民用方面有着广泛的应 用和广阔的发展前景。
[0003] 近年来，我国无人机呈现蓬勃发展趋势，越来越多的中小型企业开展了民用无人 机研制工作，国家的政策也采取积极鼓励的态度。面对市场的激烈竞争和用户的不同需求， 民用无人机往低成本、高适应性、小型化、多用途等方向发展。
[0004] 虽然一些现代非线性控制方法设计的控制系统在鲁椿性有着明显的优势，但对传 感器和机载计算机等机载设备提出更高的要求，该势必增加了整套无人机的研制成本。专 利申请号201410608597. 8名称为"一种基于PID神经网络的无人机控制方法"申请公开了 一种无人机的控制方法，其主要优点是控制精度高，抗干扰能力强，鲁椿性好的。该控制方 法依赖于无人机精确性建模，而其用到的无人机动力学模型依然是近似的模型，且其仅仅 处于MATLAB仿真阶段，并未完全的实现到具体工程应用中。实际上非线性控制结构大多较 为复杂，并且设计出来的控制器参数的准确性完全依赖于建立的无人机数学模型，然而无 人机模型难W获得十分精确的模型，设计出来的控制器参数也不方便飞行调参，该些都增 加了整个控制系统设计难度和周期。因此，为降低研制成本，基于空中飞行模态，设计了一 套结构简单且易于实现的控制系统来满足无人机飞行控制性能，W适应不同环境下的复杂 飞行任务。
[0005] 为了检验所设计的无人机飞行模态的控制系统有效性，需要拟定飞行模态具体的 测试办法和控制策略。专利申请号200810100893. 1名称为"一种无人机多模态控制与切换 方法"针对无人机本身及其飞行任务的特点，确定和划分飞行控制系统的控制模态，实现多 模态控制管理问题。但其并未设及飞行模态具体的测试办法和各个飞行模态进行测试时的 控制策略问题。
【发明内容】
[0006] 本发明为了简化现有控制系统的结构，降低成本和缩短研制周期，提出了一套简 单易工程实现的飞行控制系统，并通过控制策略来实现飞行模态的测试，W适应一种低成 本高适应性小型化的民用无人机。
[0007] 基于无人机飞行模态的控制系统设计方法，包括W下步骤：
[000引步骤一，无人机六自由度数学建模，建立纵向和侧向数学模型；
[0009] 无人机纵向模型为：
[0010]
【主权项】
1.基于无人机飞行模态的控制系统设计方法，其特征是，包括以下步骤： 步骤一，无人机六自由度数学建模，建立纵向和侧向数学模型； 无人机纵向模型为：
步骤二，选取无人机定直平飞为平衡状态，分别对纵向和侧向数学模型进行小扰动线 性化处理； 无人机纵向小扰动线性化模型为：
无人机侧向小扰动线性化模型为：
步骤三，在纵向小扰动线性化模型的基础上进行拉普拉斯变换，得到以升降舵δe为输 入，分别以俯仰角Θ、迎角α和速度V为输出的传递函f
步骤四，在侧向小扰动线性化模型的基础上进行拉普拉斯变换，得到以副翼δ a和方 向舵δ ^为输入，分别以滚转角φ、偏航角φ为输出的传递函数
步骤五，以无人机的气动和结构参数为依据，采用经典的控制理论的根轨迹法、频域分 析法和阶跃响应法，分别对控制系统，按照控制结构从内到外的层次，依次进行控制器参数 的设计； 步骤六，设计俯仰角保持与控制模态控制器参数；输入为期望的俯仰角0g，控制律 为：
(5) 其中，彡为俯仰角速度，Θ为俯仰角，\为升降舵；为俯仰角速度控制器，采用P控 制；为俯仰角控制器，为了提高控制精度，消除静差，采用PI控制； 步骤七，设计高度保持与控制模态控制器参数；其是基于俯仰角保持与控制结构上的 设计，输入为期望的高度Hg，控制律为：
其中，彳为高度变化率，H为高度；夂f为高度变化率控制器，采用P控制；夂f为高度 控制器，为了提高控制精度，消除静差，采用PI控制； 步骤八，设计速度保持与控制模态控制器参数；其是基于俯仰角保持与控制结构上的 设计，输入为期望的速度vg，控制律为：
其中，V为速度；<'为速度控制器，为了提高控制精度，消除静差，采用PI控制。 步骤9,设计滚转角保持与控制模态控制器参数；输入为期望的滚转角Φ8，控制律为：
(8) 其中，#为滚转角速度，Φ为滚转角，#"?扁航角速度，δ 3为副翼，δ ^为方向舵；为 滚转角速度控制器，采用P控制；尤f为滚转角控制器，为了提高控制精度，消除静差，采用 PI控制。 4 为协调控制，下同。#为协调转弯偏航角速度控制器，采用ρ控制； 为协调转弯滚转角控制器，采用P控制； 步骤十，设计航向角保持与控制模态控制器参数；其是在滚转角保持与控制结构上的 设计，输入为期望的航向角(6(;，控制律为：
(9) 其中，Φ为航向角；^为航向角控制器，为了提高控制精度，消除静差，采用PI控制； 步骤十一，设计偏航距控制模态控制器参数；其是在航向角保持与控制结构上的设计， 输入为期望的航向角Φ 8和期望的偏航距y g，控制律为：
其中，y为侧偏距；^为侧偏距控制器，为了提高控制精度，消除静差，采用PI控制。
2.基于无人机飞行模态的飞行测试方法，其特征是，包括以下步骤： 步骤一，测试俯仰角保持与控制模态：纵向采用俯仰角保持与控制模态，侧向采用零度 滚转角保持与控制模态。测试时，期望的俯仰角9g包含正负的多组数值，并保证自主模态 飞行时间至少达到Imin ; 步骤二，测试高度保持与控制模态：纵向采用高度保持与控制模态，侧向采用零度滚转 角保持与控制模态；测试时，期望的高度％分为当前高度和给定的高度两种情形，并保证自 主模态飞行时间至少达到Imin ; 步骤三，测试速度保持与控制模态：纵向采用速度保持与控制模态，侧向采用零度滚转 角保持与控制模态；测试时，期望的速度\分为当前高度和给定的速度两种情形，并保证自 主模态飞行时间达到Imin ; 步骤三，测试滚转角保持与控制模态：纵向采用高度保持与控制模态，侧向采用滚转角 保持与控制模态；测试时，期望的滚转角Φ8包含正负的多组数值，保证无人机左/右盘旋。 并保证自主模态飞行时间达到Imin ; 步骤四，测试航向角保持与控制模态：纵向采用高度保持与控制模态，侧向采用航向角 保持与控制模态；测试时，期望的航向角Φ g为当前航向角和给定航向角两种情形，并保证 自主模态飞行时间至少达到Imin ; 步骤五，测试侧偏距控制模态：纵向采用高度保持与控制模态，侧向采用侧向偏离控制 模态；测试时，期望的侧偏距yg为零，并保证自主模态飞行时间至少达到lmin。
【专利摘要】基于无人机飞行模态的控制系统设计及飞行试验方法，属于无人机自主飞行控制领域，将无人机飞行控制系统分为纵向和侧向两大部分来设计，纵向控制又分为俯仰角保持与控制模态、高度保持与控制模态和速度保持与控制模态，侧向控制又分为滚转角保持与控制模态、航向角保持与控制模态和侧偏距控制模态；并提出对每个模态进行飞行测试的不同控制策略：包括以下步骤，测试俯仰角保持与控制模态；测试高度保持与控制模态；测试速度保持与控制模态；测试滚转角保持与控制模态；测试航向角保持与控制模态；测试侧偏距控制模态；本发明设计周期短，易于工程实现，对快速开发研制一种低成本高适应性小型民用无人机控制系统具有极为重要的实现意义。
【IPC分类】G05D1-10
【公开号】CN104865969
【申请号】CN201510213554
【发明人】王元超, 段镇, 厉明, 高九州, 张恩阳, 孙辉, 何利文
【申请人】中国科学院长春光学精密机械与物理研究所
【公开日】2015年8月26日
【申请日】2015年4月30日
最新回复(0)