文档下载 文档下载导航
设为首页 | 加入收藏
搜索 请输入内容:  
 导航当前位置: 文档下载 > 所有分类 > 工程科技 > 机械/仪表 > 基于动力学模型的小型无人直升机自主飞行控制算法
侵权投诉

基于动力学模型的小型无人直升机自主飞行控制算法

无人机

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

上一页第3页

你可能喜欢

  • 直升机模型
  • 无线遥控
  • 轻型飞机图纸
  • 遥控直升机
  • 直升机原理
  • 选题意义

热门文档

相关文档

站点地图 | 文档上传 | 侵权投诉 | 手机版
本站所有资源均来自互联网,本站只负责收集和整理,均不承担任何法律责任,如有侵权等其它行为请联系我们.
文档下载 Copyright 2013 doc.guandang.net All Rights Reserved.  -  email