无人机
1760
上海交通大学学报
第41卷
F磐sin日一Ft8cos口si“妒一以M
1
一F≯2sin≠cos8+F≯(cos手c08妒一{
sln≠sin口si“妒)一F,M
}(3)
FMRcos≠cos疗+FT8(sin声cosp—
cos手sin占sin舻)一GM一口,MJ
式中,M为直升机的总质量.
在d一。=o(适当调整机载控制设备的位置便
可实现直升机质心位于主旋翼旋转轴上)及“;为常数(通过设置针对航向角的独立高速控制器实现)2个设定条件下嘲,直升机在体轴系FF的姿态旋转运动可描述为
T少+K1rr础E2+(K15e甜。+K15)×
叫y+K1“叫;一0
(4)T严+口2+(K2.6∞;+K2{)%+K2砷0,=o(5)
矗∞辞FT2+?警2+(I三一焉)‰m,=
(旺一2J警)玉。
(6)
式中:砖、聪2(j=z,y,=)分别指机体和旋转主旋翼
围绕通过直升机质心平行于^的转动轴的转动惯,
量;K。,为只与直升机本体参数有关的常系数(计算方法以及针对小型无人直升机更简化的关系式参见文献[6]).
式(1)~(6)组成了定常飞行状态下小型无人直升机完整的动力学模型.图3所示为模型的各组成部分,左侧为模型控制输入,右侧为模型状态输出.图中,w模块表示式(4)、(5)所描述的直升机绕上、^轴转动的动力学方程;F6模块表示式(6)的控制关系;Q表示式(2)所描述的机体姿态角和转动角速度的关系;F3模块表示式(3)所描述的位移运动动力学方程.图中虚线表示在实际控制中可作为扰动被忽略的弱关联项.
坐
MR!譬辫弩团
必
v1口#.
i…~’心删
吐日中
●1R
兰。
野叫|
qm
机体旋转运动
机体位移运动,
图3小型无人直升机动力学模型组成结构
F19.3
Compo眦tsof
themechanicalmodel
2自主飞行控制器
直升机的飞行控制包括姿态控制、位置控制及飞行速度控制,后两者都是通过直升机的姿态控制实现的.文献[6]中基于小型无人直升机动力学模型设计了飞行控制器,控制方法结构清晰,尤其是内环
万
方数据姿态控制.不足之处是在位置控制中采用了PID算法,有时难免产生位置过冲,而在直升机实际飞行中需要避免过冲,以免碰到障碍物.另外.该方法缺少有效的飞行速度控制环节.本文采用基于系统二次积分关系的MTC(Model
andTrajecto珂based
controJler)算法,能有效地解决PID算法较难实现的飞行位置过冲及速度控制问题,并便于实现多点路径的不减速连续飞行控制.
2.1
MTC控制器
设控制量“(£)及被控量^(£)之间有如下关系;
五(£)="(£)/,
(7)
式中,,为标量响应系数.期望系统最终输出^一r.
为使系统以至多一个极值的形式收敛于r,可设计系统阶跃响应形式为
矗(£)=r+Ael‘+Be一屯。
(8)
式中:常系数^。、女:>o决定了系统收敛于r的响应速度l常系数A、B用于满足系统初始条件^(“)、^(岛).基于该指数函数形式表示的响应轨迹,不需要显式求解A、B,便可推导出相应的期望控制方程:
五d。(£)=蜡Af‘1‘+七lBe_b‘一
(一々t乜+^}+≈。^z)Ae-V+(一^lt2+^;+^,^:)Be吨。一
一^l^z(Aeol‘+Be。2‘)+(愚l+矗2)(南iAe_l‘+正2Bef~‘)=一^1^2(^(£)一r)一(女l+女2)^(£)(9)
则控制量为
“(t)一,^抵(£);一,(矗。奄:)(^(£)一r)一
,(女-+岛)^(幻
(10)
式(10)表明,该控制器可以用PD实现.通过设计适当的女。、女z值,很容易使^(f)一r在[“。oo)内不变号,从而保证^(£)轨迹不过冲地收敛于r,max(女。,岛)值越大,系统无过冲稳定收敛的鲁棒性越强.详细的物理意义参见文献[8].
为消除控制器工作点漂移以及控制模型本身误差所带来的实际^(f)与期望£。(})间的偏差,采用线性误差补偿方法以后,完整的基本MTc结构如图4所示.图中,^。为误差补偿系数.
图4基本的MTC结构
Fi舀4
Schemeoftheelementary
MTC
基于动力学模型的小型无人直升机自主飞行控制算法_工学_高等教育_教育专区。无人直升机动力学建模与自主飞行控制41 卷第 11 期第 2007 年 11 月 上海交通大学学报...
首先引入了 德国柏林工业大学基于牛顿力学建立的小型无人直升机动力学模型, 然后...“天行者”小型无人直升机自主飞行控制系统设计 S171 略搜索算法所产生的控制...
关键词 :无人直升机 ;动 力学模型 ;飞行控制 ; 自主飞行 ;无人机 中图分类...小型 无人 直升 机 自主 飞行控 制 系统 设计 天 略搜 索 算法 所产生 ...
为了实现小型无人直升机的自主飞行,本文研究了它的飞行控制系统。基于模糊控制技术,根据某小型无人直升机飞行动力学数学模型,设计了模糊控制规则,并研究了模糊规则的...
度飞行试验台架来模拟 小型无人直升机的航向和纵向俯仰运动 ,据此推导 出动力学模型 ,并设计控制器 ,通过仿真获得控制 参数 ,验证控制算法 ,为实际飞行提供前期...
空气动力学、动力系统动力学模型, 推导出微小型四旋翼无人直升机动力学模型,并...机 构设计方法和自主飞行控制算法,目标是要实现室内和室外环境中的完全自主飞行...
关键词:无A直升辊动力学模型控制律飞行控制系统舵机...要实现无人直升机的自主飞行控制具有较大的难度,主要...该控制规律在前向通道采用了有限积分的PI控制算法,...
小型无人直升机自主控制系统介绍近年来国际上各种无人机技术突飞猛进, 国外许多...同时根据控制算法和地面站的命令,保持飞机以一 定的姿态飞行。飞控计算机处理器...
空气动力学、动力系统动力学模型,,● 推导出微小型四旋翼无人直升机动力学模型...研究的重点是机 构设计方法和自主飞行控制算法,目标是要实现室内和室外环境中的...
热门文档