基于非线性数学模型的通用型无人机仿真方法及系统.pdf

摘要
申请专利号：	CN201210398129.3	申请日：	2012.10.18
公开号：	CN102945002A	公开日：	2013.02.27
当前法律状态：	撤回	有效性：	无权
法律详情：	发明专利申请公布后的视为撤回IPC(主分类):G05B 17/02申请公布日:20130227\|\|\|实质审查的生效IPC(主分类):G05B 17/02申请日:20121018\|\|\|公开
IPC分类号：	G05B17/02	主分类号：	G05B17/02
申请人：	南京航空航天大学
发明人：	孙春贞; 彭夏鹏; 黄一敏
地址：	210016 江苏省南京市御道街29号
优先权：
专利代理机构：	南京经纬专利商标代理有限公司 32200	代理人：	叶连生
PDF下载：	PDF下载

内容摘要

本发明公开了一种基于非线性数学模型的通用型无人机非线性模型构建方法，同时涉及一种用于实现该构建方法的系统。所述的方法主要包括模型解算、双坐标系支持和CMEX封装三个方法模块，所述的系统包括仿真系统输入模块、进行无人机运动状态初始化的初始化模块、状态量导数解算模块、状态量更新模块、辅助物理量计算模块和仿真系统输出模块。本发明的方法及系统把更多的工作交给计算机，只需用户输入外力和外力矩，即可得到完备的无人机的物理量，使用简单、方便。

权利要求书

权利要求书一种基于非线性数学模型的通用型无人机仿真方法，其特征在于，包括下列步骤：
步骤一：调用仿真系统通用模型软件提供的用户接口函数，初始化无人机的运动状态；
步骤二：设置无人机的质量和转动惯量，并向仿真系统输入无人机所受不含重力的外力和外力矩；
步骤三：根据面对称刚体六自由度运动模型计算无人机状态量导数，以平面大地为惯性系，在苏联坐标系下进行解算：
线动力学方程：
$<mrow><MFENCED close="" open="{"><MTABLE><MTR><MTD><MSUB><MOVER><MI>V</MI><MO>.</MO></MOVER><MI>x</MI></MSUB><MO>=</MO><MSUB><MI>V</MI><MI>z</MI></MSUB><MSUB><MI>ω</MI><MI>y</MI></MSUB><MO>-</MO><MSUB><MI>V</MI><MI>y</MI></MSUB><MSUB><MI>ω</MI><MI>z</MI></MSUB><MO>+</MO><MSUB><MI>F</MI><MI>x</MI></MSUB><MO>/</MO><MI>m</MI><MO>+</MO><MSUB><MI>G</MI><MI>x</MI></MSUB></MTD></MTR><MTR><MTD><MSUB><MOVER><MI>V</MI><MO>.</MO></MOVER><MI>y</MI></MSUB><MO>=</MO><MSUB><MI>V</MI><MI>x</MI></MSUB><MSUB><MI>ω</MI><MI>z</MI></MSUB><MSUB><MROW><MO>-</MO><MI>V</MI></MROW><MI>z</MI></MSUB><MSUB><MI>ω</MI><MI>x</MI></MSUB><MO>+</MO><MSUB><MI>F</MI><MI>y</MI></MSUB><MO>/</MO><MI>m</MI><MSUB><MI>G</MI><MI>y</MI></MSUB></MTD></MTR><MTR><MTD><MSUB><MOVER><MI>V</MI><MO>.</MO></MOVER><MI>x</MI></MSUB><MO>=</MO><MSUB><MI>V</MI><MI>y</MI></MSUB><MSUB><MI>ω</MI><MI>x</MI></MSUB><MO>-</MO><MSUB><MI>V</MI><MI>x</MI></MSUB><MSUB><MI>ω</MI><MI>y</MI></MSUB><MO>+</MO><MSUB><MI>F</MI><MI>z</MI></MSUB><MO>/</MO><MI>m</MI><MO>+</MO><MSUB><MI>G</MI><MI>z</MI></MSUB></MTD></MTR></MTABLE></MFENCED><MO>-</MO><MO>-</MO><MO>-</MO><MROW><MO>(</MO><MN>1</MN><MO>)</MO></MROW></MROW>]]></MATH></MATHS><BR>角动力学方程：<BR><MATHS id=cmaths0002 num="0002"><MATH><![CDATA[<mrow><MFENCED close="" open="{"><MTABLE><MTR><MTD><MSUB><MOVER><MI>ω</MI><MO>.</MO></MOVER><MI>x</MI></MSUB><MI></MI><MO>=</MO><MFRAC><MROW><MSUB><MI>I</MI><MI>yy</MI></MSUB><MSUB><MI>M</MI><MI>x</MI></MSUB><MO>+</MO><MSUB><MI>I</MI><MI>xy</MI></MSUB><MSUB><MI>M</MI><MI>y</MI></MSUB><MO>-</MO><MSUB><MI>I</MI><MI>xy</MI></MSUB><MROW><MO>(</MO><MSUB><MI>I</MI><MI>xx</MI></MSUB><MO>-</MO><MSUB><MI>I</MI><MI>yy</MI></MSUB><MO>+</MO><MSUB><MI>I</MI><MI>zz</MI></MSUB><MO>)</MO></MROW><MSUB><MI>ω</MI><MI>x</MI></MSUB><MSUB><MI>ω</MI><MI>z</MI></MSUB><MO>+</MO><MROW><MO>(</MO><MSUB><MI>I</MI><MI>yy</MI></MSUB><MSUB><MI>I</MI><MI>yy</MI></MSUB><MO>+</MO><MSUB><MI>I</MI><MI>xy</MI></MSUB><MSUB><MI>I</MI><MI>xy</MI></MSUB><MO>-</MO><MSUB><MI>I</MI><MI>yy</MI></MSUB><MSUB><MI>I</MI><MI>zz</MI></MSUB><MO>)</MO></MROW><MSUB><MI>ω</MI><MI>y</MI></MSUB><MSUB><MI>ω</MI><MI>z</MI></MSUB></MROW><MROW><MSUB><MI>I</MI><MI>xx</MI></MSUB><MSUB><MI>I</MI><MI>yy</MI></MSUB><MO>-</MO><MSUB><MI>I</MI><MI>xy</MI></MSUB><MSUB><MI>I</MI><MI>xy</MI></MSUB></MROW></MFRAC></MTD></MTR><MTR><MTD><MSUB><MOVER><MI>ω</MI><MO>.</MO></MOVER><MI>y</MI></MSUB><MI></MI><MO>=</MO><MFRAC><MROW><MSUB><MI>I</MI><MI>xx</MI></MSUB><MSUB><MI>M</MI><MI>y</MI></MSUB><MO>+</MO><MSUB><MI>I</MI><MI>xy</MI></MSUB><MSUB><MI>M</MI><MI>x</MI></MSUB><MO>+</MO><MSUB><MI>I</MI><MI>xy</MI></MSUB><MROW><MO>(</MO><MSUB><MI>I</MI><MI>xx</MI></MSUB><MO>-</MO><MSUB><MI>I</MI><MI>yy</MI></MSUB><MO>+</MO><MSUB><MI>I</MI><MI>zz</MI></MSUB><MO>)</MO></MROW><MSUB><MI>ω</MI><MI>y</MI></MSUB><MSUB><MI>ω</MI><MI>z</MI></MSUB><MO>-</MO><MROW><MO>(</MO><MSUB><MI>I</MI><MI>xx</MI></MSUB><MSUB><MI>I</MI><MI>xx</MI></MSUB><MO>+</MO><MSUB><MI>I</MI><MI>xy</MI></MSUB><MSUB><MI>I</MI><MI>xy</MI></MSUB><MO>-</MO><MSUB><MI>I</MI><MI>xx</MI></MSUB><MSUB><MI>I</MI><MI>zz</MI></MSUB><MO>)</MO></MROW><MSUB><MI>ω</MI><MI>x</MI></MSUB><MSUB><MI>ω</MI><MI>z</MI></MSUB></MROW><MROW><MSUB><MI>I</MI><MI>xx</MI></MSUB><MSUB><MI>I</MI><MI>yy</MI></MSUB><MO>-</MO><MSUB><MI>I</MI><MI>xy</MI></MSUB><MSUB><MI>I</MI><MI>xy</MI></MSUB></MROW></MFRAC></MTD></MTR><MTR><MTD><MSUB><MOVER><MI>ω</MI><MO>.</MO></MOVER><MI>z</MI></MSUB><MI></MI><MO>=</MO><MFRAC><MROW><MSUB><MI>M</MI><MI>z</MI></MSUB><MO>-</MO><MROW><MO>(</MO><MSUB><MI>I</MI><MI>yy</MI></MSUB><MO>-</MO><MSUB><MI>I</MI><MI>xx</MI></MSUB><MO>)</MO></MROW><MSUB><MI>ω</MI><MI>x</MI></MSUB><MSUB><MI>ω</MI><MI>y</MI></MSUB><MO>+</MO><MSUB><MI>I</MI><MI>xy</MI></MSUB><MROW><MO>(</MO><MSUB><MI>ω</MI><MI>x</MI></MSUB><MSUB><MI>ω</MI><MI>x</MI></MSUB><MO>-</MO><MSUB><MI>ω</MI><MI>y</MI></MSUB><MSUB><MI>ω</MI><MI>y</MI></MSUB><MO>)</MO></MROW></MROW><MSUB><MI>I</MI><MI>zz</MI></MSUB></MFRAC></MTD></MTR></MTABLE></MFENCED><MO>-</MO><MO>-</MO><MO>-</MO><MROW><MO>(</MO><MN>2</MN><MO>)</MO></MROW></MROW>]]></MATH></MATHS><BR>线运动学方程：<BR><MATHS id=cmaths0003 num="0003"><MATH><![CDATA[<mrow><MFENCED close="" open="{"><MTABLE><MTR><MTD><MSUB><MOVER><MI>x</MI><MO>.</MO></MOVER><MI>g</MI></MSUB><MO>=</MO><MSUB><MI>V</MI><MI>x</MI></MSUB><MI>cos</MI><MI></MI><MI>ψ</MI><MI>cos</MI><MI>&upsi;</MI><MO>+</MO><MSUB><MI>V</MI><MI>y</MI></MSUB><MROW><MO>(</MO><MI>sin</MI><MI></MI><MI>ψ</MI><MI>sin</MI><MI>γ</MI><MO>-</MO><MI>cos</MI><MI>ψ</MI><MI>sin</MI><MI></MI><MI>&upsi;</MI><MI>cos</MI><MI>γ</MI><MO>)</MO></MROW><MO>+</MO><MSUB><MI>V</MI><MI>z</MI></MSUB><MROW><MO>(</MO><MI>sin</MI><MI></MI><MI>ψ</MI><MI>cos</MI><MI>γ</MI><MO>+</MO><MI>cos</MI><MI></MI><MI>ψ</MI><MI>sin</MI><MI></MI><MI>&upsi;</MI><MI>sin</MI><MI>γ</MI><MO>)</MO></MROW></MTD></MTR><MTR><MTD><MSUB><MOVER><MI>h</MI><MO>.</MO></MOVER><MI>g</MI></MSUB><MO>=</MO><MSUB><MI>V</MI><MI>x</MI></MSUB><MI>sin</MI><MI>&upsi;</MI><MO>+</MO><MSUB><MI>V</MI><MI>y</MI></MSUB><MI>cos</MI><MI></MI><MI>&upsi;</MI><MI>cos</MI><MI>γ</MI><MO>-</MO><MSUB><MI>V</MI><MI>z</MI></MSUB><MI>cos</MI><MI></MI><MI>&upsi;</MI><MI>sin</MI><MI>γ</MI></MTD></MTR><MTR><MTD><MSUB><MOVER><MI>z</MI><MO>.</MO></MOVER><MI>g</MI></MSUB><MO>=</MO><MO>-</MO><MSUB><MI>V</MI><MI>x</MI></MSUB><MI>sin</MI><MI></MI><MI>ψ</MI><MI>cos</MI><MI>&upsi;</MI><MO>+</MO><MSUB><MI>V</MI><MI>y</MI></MSUB><MROW><MO>(</MO><MI>cos</MI><MI></MI><MI>ψ</MI><MI>sin</MI><MI>γ</MI><MO>+</MO><MI>sin</MI><MI></MI><MI>ψ</MI><MI>sin</MI><MI></MI><MI>&upsi;</MI><MI>sin</MI><MO>)</MO></MROW><MO>+</MO><MSUB><MI>V</MI><MI>z</MI></MSUB><MROW><MO>(</MO><MI>cos</MI><MI></MI><MI>ψ</MI><MI>cos</MI><MI>γ</MI><MO>-</MO><MI>sin</MI><MI></MI><MI>ψ</MI><MI>sin</MI><MI></MI><MI>&upsi;</MI><MI>sin</MI><MI>γ</MI><MO>)</MO></MROW></MTD></MTR></MTABLE></MFENCED><MO>-</MO><MO>-</MO><MO>-</MO><MROW><MO>(</MO><MN>3</MN><MO>)</MO></MROW></MROW>]]></MATH></MATHS><BR>角运动学方程：<BR><MATHS id=cmaths0004 num="0004"><MATH><![CDATA[<mrow><MFENCED close="" open="{"><MTABLE><MTR><MTD><MOVER><MI>&upsi;</MI><MO>.</MO></MOVER><MO>=</MO><MSUB><MI>ω</MI><MI>y</MI></MSUB><MI>sin</MI><MI>γ</MI><MO>+</MO><MSUB><MI>ω</MI><MI>z</MI></MSUB><MI>cos</MI><MI>γ</MI></MTD></MTR><MTR><MTD><MOVER><MI>γ</MI><MO>.</MO></MOVER><MO>=</MO><MSUB><MI>ω</MI><MI>x</MI></MSUB><MO>-</MO><MI>tan</MI><MI>&upsi;</MI><MROW><MO>(</MO><MSUB><MI>ω</MI><MI>y</MI></MSUB><MI>cos</MI><MI>γ</MI><MO>-</MO><MSUB><MI>ω</MI><MI>z</MI></MSUB><MI>sin</MI><MI>γ</MI><MO>)</MO></MROW></MTD></MTR><MTR><MTD><MOVER><MI>ψ</MI><MO>.</MO></MOVER><MO>=</MO><MROW><MO>(</MO><MSUB><MI>ω</MI><MI>y</MI></MSUB><MI>cos</MI><MI>γ</MI><MO>-</MO><MSUB><MI>ω</MI><MI>z</MI></MSUB><MI>sin</MI><MI>γ</MI><MO>)</MO></MROW><MO>/</MO><MI>cos</MI><MI>&upsi;</MI></MTD></MTR></MTABLE></MFENCED><MO>-</MO><MO>-</MO><MO>-</MO><MROW><MO>(</MO><MN>4</MN><MO>)</MO></MROW></MROW>]]></MATH></MATHS><BR>其中，<BR>Fx、Fy、Fz为外力沿机体轴的分量，其中的外力不含无人机重力；<BR>Mx、My、Mz为外力矩沿机体轴的分量；<BR>Gx、Gy、Gz为重力加速度沿机体轴的分量；<BR>m为无人机质量；<BR>Ixx、Iyy、Izz、Ixy、分别是无人机沿机体轴向的转动惯量和惯性积；<BR>Vx、Vy、Vz为地速沿机体轴的分量；<BR>xg、hg、zg为分别是无人机北向、天向和东向的位移；<BR>ωx、ωy、ωz为绕机体轴转动的角速率沿机体轴的分量；<BR>υ、γ、ψ为俯仰角、滚转角、偏航角；<BR>步骤四：使用Adams数值积分算法更新无人机状态量，<BR><MATHS id=cmaths0005 num="0005"><MATH><![CDATA[<mrow><MSUB><MI>y</MI><MROW><MI>n</MI><MO>+</MO><MN>4</MN></MROW></MSUB><MO>=</MO><MSUB><MI>y</MI><MROW><MI>n</MI><MO>+</MO><MN>3</MN></MROW></MSUB><MO>+</MO><MFRAC><MI>h</MI><MN>24</MN></MFRAC><MROW><MO>(</MO><MN>55</MN><MSUB><MOVER><MI>y</MI><MO>.</MO></MOVER><MROW><MI>n</MI><MO>+</MO><MN>3</MN></MROW></MSUB><MO>-</MO><MN>59</MN><MSUB><MOVER><MI>y</MI><MO>.</MO></MOVER><MROW><MI>n</MI><MO>+</MO><MN>2</MN></MROW></MSUB><MO>+</MO><MN>37</MN><MSUB><MOVER><MI>y</MI><MO>.</MO></MOVER><MROW><MI>n</MI><MO>+</MO><MN>1</MN></MROW></MSUB><MO>-</MO><MN>9</MN><MSUB><MOVER><MI>y</MI><MO>.</MO></MOVER><MI>n</MI></MSUB><MO>)</MO></MROW><MO>-</MO><MO>-</MO><MO>-</MO><MROW><MO>(</MO><MN>5</MN><MO>)</MO></MROW></MROW>]]></MATH></MATHS><BR>截断误差为<BR>其中：<BR>h表示仿真步长；<BR>分别表示第n+3、n+2、n+1、n时刻的导数；<BR>yn+4、yn+3分别表示n+4、n+3时刻的值；<BR>步骤五：在仿真系统中内置风模型，根据用户设置的风速，合成空速：<BR><MATHS id=cmaths0006 num="0006"><MATH><![CDATA[<mfenced open='{' close='' separators=''><MTABLE><MTR><MTD><MSUB><MI>V</MI><MROW><MI>e</MI><MN>2</MN><MI>wind</MI></MROW></MSUB><MO>=</MO><MSUB><MI>V</MI><MI>e</MI></MSUB><MO>-</MO><MSUB><MI>V</MI><MROW><MI>wind</MI><MO>_</MO><MI>e</MI></MROW></MSUB></MTD></MTR><MTR><MTD><MSUB><MI>V</MI><MROW><MI>n</MI><MN>2</MN><MI>wind</MI></MROW></MSUB><MO>=</MO><MSUB><MI>V</MI><MI>n</MI></MSUB><MO>-</MO><MSUB><MI>V</MI><MROW><MI>wind</MI><MO>_</MO><MI>n</MI></MROW></MSUB></MTD></MTR><MTR><MTD><MSUB><MI>V</MI><MROW><MI>u</MI><MN>2</MN><MI>wind</MI></MROW></MSUB><MO>=</MO><MSUB><MI>V</MI><MI>u</MI></MSUB><MO>-</MO><MSUB><MI>V</MI><MROW><MI>wind</MI><MO>_</MO><MI>u</MI></MROW></MSUB></MTD></MTR></MTABLE><MROW><MO>-</MO><MO>-</MO><MO>-</MO><MROW><MO>(</MO><MN>6</MN><MO>)</MO></MROW></MROW></MFENCED>]]></MATH></MATHS><BR>其中：<BR>Ve、Vn、Vu分别是无人机地速在东向、北向、天向的分量；<BR>Vwind_e、Vwind_n、Vwind_u分别是气流的东向速度、北向速度、天向速度；<BR>Ve2wind、Vn2wind、Vu2wind分别是空速在东向、北向、天向的分量；<BR>步骤六：根据步骤四得到的无人机状态量和步骤五得到的空速，在标准大气模型、重力场模型的基础上，计算空速、气流角、动压等辅助量；<BR>1962年美国标准大气：<BR>ρ查1962年标准大气表 (7)<BR>Vsonic查1962年标准大气表 (8)<BR><MATHS id=cmaths0007 num="0007"><MATH><![CDATA[<mrow><MI>σ</MI><MO>=</MO><MFRAC><MI>ρ</MI><MSUB><MI>ρ</MI><MROW><MI>sea</MI><MO>_</MO><MI>level</MI></MROW></MSUB></MFRAC><MO>-</MO><MO>-</MO><MO>-</MO><MROW><MO>(</MO><MN>9</MN><MO>)</MO></MROW></MROW>]]></MATH></MATHS><BR>He＝3.2808×H (10)<BR><MATHS id=cmaths0008 num="0008"><MATH><![CDATA[<mrow><MSUB><MI>T</MI><MI>s</MI></MSUB><MO>=</MO><MN>0.55556</MN><MO>×</MO><MFENCED close="" open="{" separators=""><MTABLE><MTR><MTD><MN>518.7</MN><MO>×</MO><MROW><MO>(</MO><MN>1</MN><MO>.</MO><MN>0</MN><MO>-</MO><MN>6.875</MN><MI>e</MI><MO>-</MO><MN>6</MN><MO>×</MO><MI>H</MI><MO>)</MO></MROW><MO>;</MO></MTD><MTD><MN>0</MN><MO><</MO><MSUB><MI>H</MI><MI>e</MI></MSUB><MI></MI><MO><</MO><MN>36089</MN></MTD></MTR><MTR><MTD><MN>518.7</MN><MO>×</MO><MN>0.751985</MN><MO>;</MO></MTD><MTD><MN>36089</MN><MO><</MO><MSUB><MI>H</MI><MI>e</MI></MSUB><MO><</MO><MN>240000</MN></MTD></MTR></MTABLE><MROW><MO>-</MO><MO>-</MO><MO>-</MO><MROW><MO>(</MO><MN>11</MN><MO>)</MO></MROW></MROW></MFENCED></MROW>]]></MATH></MATHS><BR><MATHS id=cmaths0009 num="0009"><MATH><![CDATA[<mrow><MSUB><MI>P</MI><MI>s</MI></MSUB><MO>=</MO><MN>47.88018</MN><MO>×</MO><MFENCED close="]" open="[" separators=""><MTABLE><MTR><MTD><MN>2113.8</MN><MO>×</MO><MSUP><MROW><MO>(</MO><MN>1.0</MN><MO>-</MO><MN>6.875</MN><MI>e</MI><MO>×</MO><MI>H</MI><MO>)</MO></MROW><MN>5.256</MN></MSUP><MO>;</MO></MTD><MTD><MN>0</MN><MO><</MO><MI>H</MI><MO><</MO><MN>36089</MN></MTD></MTR><MTR><MTD><MN>2113.8</MN><MO>×</MO><MN>0.2234</MN><MO>×</MO><MSUP><MI>e</MI><MROW><MO>-</MO><MN>4.806</MN><MI>e</MI><MO>-</MO><MN>5</MN><MO>×</MO><MROW><MO>(</MO><MI>H</MI><MO>-</MO><MN>36089</MN><MO>)</MO></MROW></MROW></MSUP><MO>;</MO></MTD><MTD><MN>36089</MN><MO><</MO><MI>H</MI><MO><</MO><MN>240000</MN></MTD></MTR></MTABLE><MROW><MO>-</MO><MO>-</MO><MO>-</MO><MROW><MO>(</MO><MN>12</MN><MO>)</MO></MROW></MROW></MFENCED></MROW>]]></MATH></MATHS><BR>其中：<BR>H、He分别是海拔高度的公制和英制表示；<BR>ρ表示当前高度处的大气密度；<BR>Vsonic表示当前高度处的音速；<BR>σ表示当前高度和海平面的大气密度之比；<BR>Ts表示当前高度处大气的静温；<BR>Ps表示当前高度处的大气的静压；<BR>重力场模型：<BR><MATHS id=cmaths0010 num="0010"><MATH><![CDATA[<mrow><MFENCED close="" open="{"><MTABLE><MTR><MTD><MSUB><MI>K</MI><MI>R</MI></MSUB><MO>=</MO><MN>0.00108263</MN><MO>*</MO><MSUP><MROW><MO>(</MO><MFRAC><MROW><MI>H</MI><MO>+</MO><MSUB><MI>R</MI><MI>e</MI></MSUB></MROW><MSUB><MI>R</MI><MI>e</MI></MSUB></MFRAC><MO>)</MO></MROW><MN>2</MN></MSUP></MTD></MTR><MTR><MTD><MSUB><MI>K</MI><MI>g</MI></MSUB><MO>=</MO><MSQRT><MN>2.25</MN><MROW><MO>(</MO><MSUP><MROW><MN>5</MN><MI>sin</MI></MROW><MN>4</MN></MSUP><MROW><MO>(</MO><MI>D</MI><MO>)</MO></MROW><MO>-</MO><MSUP><MROW><MN>2</MN><MI>sin</MI></MROW><MN>2</MN></MSUP><MROW><MO>(</MO><MI>D</MI><MO>)</MO></MROW><MO>+</MO><MN>1</MN><MO>)</MO></MROW><MSUBSUP><MI>K</MI><MI>R</MI><MN>2</MN></MSUBSUP><MO>+</MO><MN>3</MN><MROW><MO>(</MO><MSUP><MROW><MO>-</MO><MN>3</MN><MI>sin</MI></MROW><MN>2</MN></MSUP><MROW><MO>(</MO><MI>D</MI><MO>)</MO></MROW><MO>+</MO><MN>1</MN><MO>)</MO></MROW><MSUB><MI>K</MI><MI>R</MI></MSUB><MO>+</MO><MN>1</MN></MSQRT></MTD></MTR><MTR><MTD><MI>g</MI><MO>=</MO><MSUB><MI>K</MI><MI>g</MI></MSUB><MFRAC><MI>GM</MI><MSUP><MROW><MO>(</MO><MI>H</MI><MO>+</MO><MSUB><MI>R</MI><MI>e</MI></MSUB><MO>)</MO></MROW><MN>2</MN></MSUP></MFRAC></MTD></MTR></MTABLE></MFENCED><MO>-</MO><MO>-</MO><MO>-</MO><MROW><MO>(</MO><MN>13</MN><MO>)</MO></MROW></MROW>]]></MATH></MATHS><BR>其中：<BR>H表示海拔高度；<BR>Re表示地球半径；<BR>D表示纬度；<BR>G表示引力常数；<BR>M表示地球质量；<BR>步骤七：调用通用模型软件用户接口函数获得完备的描述无人机运动的物理量；<BR>步骤八：重复步骤二至步骤七，实现无人机运动的非线性仿真。<BR>如权利要求1所述的基于非线性数学模型的通用型无人机仿真方法，其特征在于，可支持所有面对称无人机运动的仿真。<BR>如权利要求1所述的基于非线性数学模型的通用型无人机仿真方法，其特征在于，可同时支持两种坐标系下的仿真。<BR>如权利要求1所述的基于非线性数学模型的通用型无人机仿真方法，其特征在于，可同时支持C语言环境和MATLAB环境下的仿真。<BR>一种用于实现权利要求1所述方法的系统，其特征在于，包括：<BR>仿真系统输入模块(1)；<BR>进行无人机运动状态初始化的初始化模块(2)；<BR>状态量导数解算模块(3)；<BR>状态量更新模块(4)；<BR>辅助物理量计算模块(5)；<BR>仿真系统输出模块(6)；<BR>其中，无人机状态参数通过仿真系统输入模块(1)输入初始化模块(2)，初始化模块(2)对无人机初始状态信息进行处理并将处理结果输入初始化状态量更新模块(4)；无人机所受不含重力的外力和外力矩通过仿真系统输入模块(1)输入状态量导数解算模块(3)，状态量导数解算模块(3)解算得到状态量导数，并输出至状态量更新模块(4)；状态量更新模块(4)更新运动状态，将新的值输出至辅助物理量计算模块(5)；状态量导数解算模块(3)、状态量更新模块(4)、辅助物理量计算模块(5)的输出结果通过仿真系统输出模块(6)提供给用户使用。</p></div>
</div>
</div>
<div class="zlzy">
<div class="zltitle">说明书</div>
<div class="gdyy">
<div class="gdyy_show"><p>说明书基于非线性数学模型的通用型无人机仿真方法及系统 <BR>技术领域 <BR>本发明涉及一种无人机数学模型的构建方法，尤其涉及一种通用的无人机非线性模型构建方法，同时涉及一种用于实现该构建方法的系统。 <BR>背景技术 <BR>在无人机飞行控制律设计和验证的过程中，六自由度非线性数学模型的建立是前提和基础。一般无人机的数学模型建立的过程中，首先选择适当的坐标系；其次根据无人机当前迎角和侧滑角从吹风数据中获得气动导数，计算气动力和力矩，结合发动机模型和重力场模型，求得无人机合外力与合外力矩；然后在此基础上根据六自由度动力学和运动学方程，求取无人机状态量导数；接着通过数值积分解算，更新无人机的状态；最终利用新的状态计算所需要的其他物理量。这种建模方法存在三个方面的不足： <BR>第一，当对不同型号无人机构建其非线性数学模型时，由于气动外形的差异，导致气动力和力矩的求取不同，它们的建模需都要重复上述过程，过程复杂，建模效率低，周期较长； <BR>第二，针对苏联坐标系和欧美坐标系这两种不同的坐标系定义方式，原有的建模方法需要分别建模，无法同时支持两种坐标系； <BR>第三，通常无人机控制律在MATLAB环境完成设计，而半物理仿真程序则是用C语言开发，二者都依赖于无人机非线性数学模型，需要用M语言和C语言分别编程实现无人机非线性模型，加大了建模的工作量。 <BR>发明内容 <BR>技术问题 <BR>本发明要解决的技术问题是提供一种不受无人机型号限制、进行通用数学模型构建的方法，该方法可用于不同型号的无人机在不同坐标系和不同开发环境下的建模，同时亦提供一种用于实现该方法的通用型无人机非线性数学模型构建系统。 <BR>技术方案 <BR>为了解决上述的技术问题，本发明的通用型无人机非线性数学模型构建方法包括下列步骤： <BR>步骤一：调用仿真系统通用模型软件提供的用户接口函数，初始化无人机的运动状态； <BR>步骤二：设置无人机的质量和转动惯量，并向仿真系统输入无人机所受不含重力的外力和外力矩； <BR>步骤三：根据面对称刚体六自由度运动模型计算无人机状态量导数，以平面大地为惯性系，在苏联坐标系下进行解算： <BR>线动力学方程： <BR><MATHS num="0001"><MATH><![CDATA[ <mrow><MFENCED close="" open="{"><MTABLE><MTR><MTD><MSUB><MOVER><MI>V</MI> <MO>.</MO> </MOVER><MI>x</MI> </MSUB><MO>=</MO> <MSUB><MI>V</MI> <MI>z</MI> </MSUB><MSUB><MI>ω</MI> <MI>y</MI> </MSUB><MO>-</MO> <MSUB><MI>V</MI> <MI>y</MI> </MSUB><MSUB><MI>ω</MI> <MI>z</MI> </MSUB><MO>+</MO> <MSUB><MI>F</MI> <MI>x</MI> </MSUB><MO>/</MO> <MI>m</MI> <MO>+</MO> <MSUB><MI>G</MI> <MI>x</MI> </MSUB></MTD></MTR><MTR><MTD><MSUB><MOVER><MI>V</MI> <MO>.</MO> </MOVER><MI>y</MI> </MSUB><MO>=</MO> <MSUB><MI>V</MI> <MI>x</MI> </MSUB><MSUB><MI>ω</MI> <MI>z</MI> </MSUB><MSUB><MROW><MO>-</MO> <MI>V</MI> </MROW><MI>z</MI> </MSUB><MSUB><MI>ω</MI> <MI>x</MI> </MSUB><MO>+</MO> <MSUB><MI>F</MI> <MI>y</MI> </MSUB><MO>/</MO> <MI>m</MI> <MSUB><MI>G</MI> <MI>y</MI> </MSUB></MTD></MTR><MTR><MTD><MSUB><MOVER><MI>V</MI> <MO>.</MO> </MOVER><MI>x</MI> </MSUB><MO>=</MO> <MSUB><MI>V</MI> <MI>y</MI> </MSUB><MSUB><MI>ω</MI> <MI>x</MI> </MSUB><MO>-</MO> <MSUB><MI>V</MI> <MI>x</MI> </MSUB><MSUB><MI>ω</MI> <MI>y</MI> </MSUB><MO>+</MO> <MSUB><MI>F</MI> <MI>z</MI> </MSUB><MO>/</MO> <MI>m</MI> <MO>+</MO> <MSUB><MI>G</MI> <MI>z</MI> </MSUB></MTD></MTR></MTABLE></MFENCED><MO>-</MO> <MO>-</MO> <MO>-</MO> <MROW><MO>(</MO> <MN>1</MN> <MO>)</MO> </MROW></MROW>]]></MATH></MATHS> <BR>角动力学方程： <BR><MATHS num="0002"><MATH><![CDATA[ <mrow><MFENCED close="" open="{"><MTABLE><MTR><MTD><MSUB><MOVER><MI>ω</MI> <MO>.</MO> </MOVER><MI>x</MI> </MSUB><MI></MI><MO>=</MO> <MFRAC><MROW><MSUB><MI>I</MI> <MI>yy</MI> </MSUB><MSUB><MI>M</MI> <MI>x</MI> </MSUB><MO>+</MO> <MSUB><MI>I</MI> <MI>xy</MI> </MSUB><MSUB><MI>M</MI> <MI>y</MI> </MSUB><MO>-</MO> <MSUB><MI>I</MI> <MI>xy</MI> </MSUB><MROW><MO>(</MO> <MSUB><MI>I</MI> <MI>xx</MI> </MSUB><MO>-</MO> <MSUB><MI>I</MI> <MI>yy</MI> </MSUB><MO>+</MO> <MSUB><MI>I</MI> <MI>zz</MI> </MSUB><MO>)</MO> </MROW><MSUB><MI>ω</MI> <MI>x</MI> </MSUB><MSUB><MI>ω</MI> <MI>z</MI> </MSUB><MO>+</MO> <MROW><MO>(</MO> <MSUB><MI>I</MI> <MI>yy</MI> </MSUB><MSUB><MI>I</MI> <MI>yy</MI> </MSUB><MO>+</MO> <MSUB><MI>I</MI> <MI>xy</MI> </MSUB><MSUB><MI>I</MI> <MI>xy</MI> </MSUB><MO>-</MO> <MSUB><MI>I</MI> <MI>yy</MI> </MSUB><MSUB><MI>I</MI> <MI>zz</MI> </MSUB><MO>)</MO> </MROW><MSUB><MI>ω</MI> <MI>y</MI> </MSUB><MSUB><MI>ω</MI> <MI>z</MI> </MSUB></MROW><MROW><MSUB><MI>I</MI> <MI>xx</MI> </MSUB><MSUB><MI>I</MI> <MI>yy</MI> </MSUB><MO>-</MO> <MSUB><MI>I</MI> <MI>xy</MI> </MSUB><MSUB><MI>I</MI> <MI>xy</MI> </MSUB></MROW></MFRAC></MTD></MTR><MTR><MTD><MSUB><MOVER><MI>ω</MI> <MO>.</MO> </MOVER><MI>y</MI> </MSUB><MI></MI><MO>=</MO> <MFRAC><MROW><MSUB><MI>I</MI> <MI>xx</MI> </MSUB><MSUB><MI>M</MI> <MI>y</MI> </MSUB><MO>+</MO> <MSUB><MI>I</MI> <MI>xy</MI> </MSUB><MSUB><MI>M</MI> <MI>x</MI> </MSUB><MO>+</MO> <MSUB><MI>I</MI> <MI>xy</MI> </MSUB><MROW><MO>(</MO> <MSUB><MI>I</MI> <MI>xx</MI> </MSUB><MO>-</MO> <MSUB><MI>I</MI> <MI>yy</MI> </MSUB><MO>+</MO> <MSUB><MI>I</MI> <MI>zz</MI> </MSUB><MO>)</MO> </MROW><MSUB><MI>ω</MI> <MI>y</MI> </MSUB><MSUB><MI>ω</MI> <MI>z</MI> </MSUB><MO>-</MO> <MROW><MO>(</MO> <MSUB><MI>I</MI> <MI>xx</MI> </MSUB><MSUB><MI>I</MI> <MI>xx</MI> </MSUB><MO>+</MO> <MSUB><MI>I</MI> <MI>xy</MI> </MSUB><MSUB><MI>I</MI> <MI>xy</MI> </MSUB><MO>-</MO> <MSUB><MI>I</MI> <MI>xx</MI> </MSUB><MSUB><MI>I</MI> <MI>zz</MI> </MSUB><MO>)</MO> </MROW><MSUB><MI>ω</MI> <MI>x</MI> </MSUB><MSUB><MI>ω</MI> <MI>z</MI> </MSUB></MROW><MROW><MSUB><MI>I</MI> <MI>xx</MI> </MSUB><MSUB><MI>I</MI> <MI>yy</MI> </MSUB><MO>-</MO> <MSUB><MI>I</MI> <MI>xy</MI> </MSUB><MSUB><MI>I</MI> <MI>xy</MI> </MSUB></MROW></MFRAC></MTD></MTR><MTR><MTD><MSUB><MOVER><MI>ω</MI> <MO>.</MO> </MOVER><MI>z</MI> </MSUB><MI></MI><MO>=</MO> <MFRAC><MROW><MSUB><MI>M</MI> <MI>z</MI> </MSUB><MO>-</MO> <MROW><MO>(</MO> <MSUB><MI>I</MI> <MI>yy</MI> </MSUB><MO>-</MO> <MSUB><MI>I</MI> <MI>xx</MI> </MSUB><MO>)</MO> </MROW><MSUB><MI>ω</MI> <MI>x</MI> </MSUB><MSUB><MI>ω</MI> <MI>y</MI> </MSUB><MO>+</MO> <MSUB><MI>I</MI> <MI>xy</MI> </MSUB><MROW><MO>(</MO> <MSUB><MI>ω</MI> <MI>x</MI> </MSUB><MSUB><MI>ω</MI> <MI>x</MI> </MSUB><MO>-</MO> <MSUB><MI>ω</MI> <MI>y</MI> </MSUB><MSUB><MI>ω</MI> <MI>y</MI> </MSUB><MO>)</MO> </MROW></MROW><MSUB><MI>I</MI> <MI>zz</MI> </MSUB></MFRAC></MTD></MTR></MTABLE></MFENCED><MO>-</MO> <MO>-</MO> <MO>-</MO> <MROW><MO>(</MO> <MN>2</MN> <MO>)</MO> </MROW></MROW>]]></MATH></MATHS> <BR>线运动学方程： <BR><MATHS num="0003"><MATH><![CDATA[ <mrow><MFENCED close="" open="{"><MTABLE><MTR><MTD><MSUB><MOVER><MI>x</MI> <MO>.</MO> </MOVER><MI>g</MI> </MSUB><MO>=</MO> <MSUB><MI>V</MI> <MI>x</MI> </MSUB><MI>cos</MI> <MI></MI><MI>ψ</MI> <MI>cos</MI> <MI>&upsi;</MI> <MO>+</MO> <MSUB><MI>V</MI> <MI>y</MI> </MSUB><MROW><MO>(</MO> <MI>sin</MI> <MI></MI><MI>ψ</MI> <MI>sin</MI> <MI>γ</MI> <MO>-</MO> <MI>cos</MI> <MI>ψ</MI> <MI>sin</MI> <MI></MI><MI>&upsi;</MI> <MI>cos</MI> <MI>γ</MI> <MO>)</MO> </MROW><MO>+</MO> <MSUB><MI>V</MI> <MI>z</MI> </MSUB><MROW><MO>(</MO> <MI>sin</MI> <MI></MI><MI>ψ</MI> <MI>cos</MI> <MI>γ</MI> <MO>+</MO> <MI>cos</MI> <MI></MI><MI>ψ</MI> <MI>sin</MI> <MI></MI><MI>&upsi;</MI> <MI>sin</MI> <MI>γ</MI> <MO>)</MO> </MROW></MTD></MTR><MTR><MTD><MSUB><MOVER><MI>h</MI> <MO>.</MO> </MOVER><MI>g</MI> </MSUB><MO>=</MO> <MSUB><MI>V</MI> <MI>x</MI> </MSUB><MI>sin</MI> <MI>&upsi;</MI> <MO>+</MO> <MSUB><MI>V</MI> <MI>y</MI> </MSUB><MI>cos</MI> <MI></MI><MI>&upsi;</MI> <MI>cos</MI> <MI>γ</MI> <MO>-</MO> <MSUB><MI>V</MI> <MI>z</MI> </MSUB><MI>cos</MI> <MI></MI><MI>&upsi;</MI> <MI>sin</MI> <MI>γ</MI> </MTD></MTR><MTR><MTD><MSUB><MOVER><MI>z</MI> <MO>.</MO> </MOVER><MI>g</MI> </MSUB><MO>=</MO> <MO>-</MO> <MSUB><MI>V</MI> <MI>x</MI> </MSUB><MI>sin</MI> <MI></MI><MI>ψ</MI> <MI>cos</MI> <MI>&upsi;</MI> <MO>+</MO> <MSUB><MI>V</MI> <MI>y</MI> </MSUB><MROW><MO>(</MO> <MI>cos</MI> <MI></MI><MI>ψ</MI> <MI>sin</MI> <MI>γ</MI> <MO>+</MO> <MI>sin</MI> <MI></MI><MI>ψ</MI> <MI>sin</MI> <MI></MI><MI>&upsi;</MI> <MI>sin</MI> <MO>)</MO> </MROW><MO>+</MO> <MSUB><MI>V</MI> <MI>z</MI> </MSUB><MROW><MO>(</MO> <MI>cos</MI> <MI></MI><MI>ψ</MI> <MI>cos</MI> <MI>γ</MI> <MO>-</MO> <MI>sin</MI> <MI></MI><MI>ψ</MI> <MI>sin</MI> <MI></MI><MI>&upsi;</MI> <MI>sin</MI> <MI>γ</MI> <MO>)</MO> </MROW></MTD></MTR></MTABLE></MFENCED><MO>-</MO> <MO>-</MO> <MO>-</MO> <MROW><MO>(</MO> <MN>3</MN> <MO>)</MO> </MROW></MROW>]]></MATH></MATHS> <BR>角运动学方程： <BR><MATHS num="0004"><MATH><![CDATA[ <mrow><MFENCED close="" open="{"><MTABLE><MTR><MTD><MOVER><MI>&upsi;</MI> <MO>.</MO> </MOVER><MO>=</MO> <MSUB><MI>ω</MI> <MI>y</MI> </MSUB><MI>sin</MI> <MI>γ</MI> <MO>+</MO> <MSUB><MI>ω</MI> <MI>z</MI> </MSUB><MI>cos</MI> <MI>γ</MI> </MTD></MTR><MTR><MTD><MOVER><MI>γ</MI> <MO>.</MO> </MOVER><MO>=</MO> <MSUB><MI>ω</MI> <MI>x</MI> </MSUB><MO>-</MO> <MI>tan</MI> <MI>&upsi;</MI> <MROW><MO>(</MO> <MSUB><MI>ω</MI> <MI>y</MI> </MSUB><MI>cos</MI> <MI>γ</MI> <MO>-</MO> <MSUB><MI>ω</MI> <MI>z</MI> </MSUB><MI>sin</MI> <MI>γ</MI> <MO>)</MO> </MROW></MTD></MTR><MTR><MTD><MOVER><MI>ψ</MI> <MO>.</MO> </MOVER><MO>=</MO> <MROW><MO>(</MO> <MSUB><MI>ω</MI> <MI>y</MI> </MSUB><MI>cos</MI> <MI>γ</MI> <MO>-</MO> <MSUB><MI>ω</MI> <MI>z</MI> </MSUB><MI>sin</MI> <MI>γ</MI> <MO>)</MO> </MROW><MO>/</MO> <MI>cos</MI> <MI>&upsi;</MI> </MTD></MTR></MTABLE></MFENCED><MO>-</MO> <MO>-</MO> <MO>-</MO> <MROW><MO>(</MO> <MN>4</MN> <MO>)</MO> </MROW></MROW>]]></MATH></MATHS> <BR>其中， <BR>Fx、Fy、Fz为外力(不含重力)沿机体轴的分量； <BR>Mx、My、Mz为外力矩沿机体轴的分量； <BR>Gx、Gy、Gz为重力加速度沿机体轴的分量； <BR>m为无人机质量； <BR>Ixx、Iyy、Izz、Ixy、分别是无人机沿机体轴向的转动惯量和惯性积； <BR>Vx、Vy、Vz为地速沿机体轴的分量； <BR>xg、hg、zg为分别是无人机北向、天向和东向的位移； <BR>ωx、ωy、ωz为绕机体轴转动的角速率沿机体轴的分量； <BR>υ、γ、ψ为俯仰角、滚转角、偏航角； <BR>步骤四：使用Adams数值积分算法更新无人机状态量， <BR><MATHS num="0005"><MATH><![CDATA[ <mrow><MSUB><MI>y</MI> <MROW><MI>n</MI> <MO>+</MO> <MN>4</MN> </MROW></MSUB><MO>=</MO> <MSUB><MI>y</MI> <MROW><MI>n</MI> <MO>+</MO> <MN>3</MN> </MROW></MSUB><MO>+</MO> <MFRAC><MI>h</MI> <MN>24</MN> </MFRAC><MROW><MO>(</MO> <MN>55</MN> <MSUB><MOVER><MI>y</MI> <MO>.</MO> </MOVER><MROW><MI>n</MI> <MO>+</MO> <MN>3</MN> </MROW></MSUB><MO>-</MO> <MN>59</MN> <MSUB><MOVER><MI>y</MI> <MO>.</MO> </MOVER><MROW><MI>n</MI> <MO>+</MO> <MN>2</MN> </MROW></MSUB><MO>+</MO> <MN>37</MN> <MSUB><MOVER><MI>y</MI> <MO>.</MO> </MOVER><MROW><MI>n</MI> <MO>+</MO> <MN>1</MN> </MROW></MSUB><MO>-</MO> <MN>9</MN> <MSUB><MOVER><MI>y</MI> <MO>.</MO> </MOVER><MI>n</MI> </MSUB><MO>)</MO> </MROW><MO>-</MO> <MO>-</MO> <MO>-</MO> <MROW><MO>(</MO> <MN>5</MN> <MO>)</MO> </MROW></MROW>]]></MATH></MATHS> <BR>截断误差为 <BR>其中： <BR>h表示仿真步长； <BR>分别表示第n+3、n+2、n+1、n时刻的导数； <BR>yn+4、yn+3分别表示n+4、n+3时刻的值； <BR>步骤五：模型中内置风模型，根据用户设置的风速，合成空速，： <BR><MATHS num="0006"><MATH><![CDATA[ <mfenced open='{' close='' separators=''><MTABLE><MTR><MTD><MSUB><MI>V</MI> <MROW><MI>e</MI> <MN>2</MN> <MI>wind</MI> </MROW></MSUB><MO>=</MO> <MSUB><MI>V</MI> <MI>e</MI> </MSUB><MO>-</MO> <MSUB><MI>V</MI> <MROW><MI>wind</MI> <MO>_</MO> <MI>e</MI> </MROW></MSUB></MTD></MTR><MTR><MTD><MSUB><MI>V</MI> <MROW><MI>n</MI> <MN>2</MN> <MI>wind</MI> </MROW></MSUB><MO>=</MO> <MSUB><MI>V</MI> <MI>n</MI> </MSUB><MO>-</MO> <MSUB><MI>V</MI> <MROW><MI>wind</MI> <MO>_</MO> <MI>n</MI> </MROW></MSUB></MTD></MTR><MTR><MTD><MSUB><MI>V</MI> <MROW><MI>u</MI> <MN>2</MN> <MI>wind</MI> </MROW></MSUB><MO>=</MO> <MSUB><MI>V</MI> <MI>u</MI> </MSUB><MO>-</MO> <MSUB><MI>V</MI> <MROW><MI>wind</MI> <MO>_</MO> <MI>u</MI> </MROW></MSUB></MTD></MTR></MTABLE><MROW><MO>-</MO> <MO>-</MO> <MO>-</MO> <MROW><MO>(</MO> <MN>6</MN> <MO>)</MO> </MROW></MROW></MFENCED>]]></MATH></MATHS> <BR>其中： <BR>Ve、Vn、Vu分别是无人机地速在东向、北向、天向的分量； <BR>Vwind_e、Vwind_n、Vwind_u分别是气流的东向速度、北向速度、天向速度； <BR>Ve2wind、Vn2wind、Vu2wind分别是空速在东向、北向、天向的分量； <BR>本步骤中，用户可以随时设定气流速度Vwind_e、Vwind_n、Vwind_u,从而实现风的动态加入； <BR>步骤六：根据步骤四得到的无人机状态量和步骤五得到的空速，在标准大气模型、重力场模型的基础上，计算空速、气流角、动压等辅助量，支持模型加风； <BR>1962年美国标准大气： <BR>ρ查1962年标准大气表 (7) <BR>Vsonic查1962年标准大气表 (8) <BR><MATHS num="0007"><MATH><![CDATA[ <mrow><MI>σ</MI> <MO>=</MO> <MFRAC><MI>ρ</MI> <MSUB><MI>ρ</MI> <MROW><MI>sea</MI> <MO>_</MO> <MI>level</MI> </MROW></MSUB></MFRAC><MO>-</MO> <MO>-</MO> <MO>-</MO> <MROW><MO>(</MO> <MN>9</MN> <MO>)</MO> </MROW></MROW>]]></MATH></MATHS> <BR>He＝3.2808×H (10) <BR><MATHS num="0008"><MATH><![CDATA[ <mrow><MSUB><MI>T</MI> <MI>s</MI> </MSUB><MO>=</MO> <MN>0.55556</MN> <MO>×</MO> <MFENCED close="" open="{" separators=""><MTABLE><MTR><MTD><MN>518.7</MN> <MO>×</MO> <MROW><MO>(</MO> <MN>1</MN> <MO>.</MO> <MN>0</MN> <MO>-</MO> <MN>6.875</MN> <MI>e</MI> <MO>-</MO> <MN>6</MN> <MO>×</MO> <MI>H</MI> <MO>)</MO> </MROW><MO>;</MO> </MTD><MTD><MN>0</MN> <MO><</MO> <MSUB><MI>H</MI> <MI>e</MI> </MSUB><MI></MI><MO><</MO> <MN>36089</MN> </MTD></MTR><MTR><MTD><MN>518.7</MN> <MO>×</MO> <MN>0.751985</MN> <MO>;</MO> </MTD><MTD><MN>36089</MN> <MO><</MO> <MSUB><MI>H</MI> <MI>e</MI> </MSUB><MO><</MO> <MN>240000</MN> </MTD></MTR></MTABLE><MROW><MO>-</MO> <MO>-</MO> <MO>-</MO> <MROW><MO>(</MO> <MN>11</MN> <MO>)</MO> </MROW></MROW></MFENCED></MROW>]]></MATH></MATHS> <BR><MATHS num="0009"><MATH><![CDATA[ <mrow><MSUB><MI>P</MI> <MI>s</MI> </MSUB><MO>=</MO> <MN>47.88018</MN> <MO>×</MO> <MFENCED close="" open="{" separators=""><MTABLE><MTR><MTD><MN>2113.8</MN> <MO>×</MO> <MSUP><MROW><MO>(</MO> <MN>1.0</MN> <MO>-</MO> <MN>6.875</MN> <MI>e</MI> <MO>×</MO> <MI>H</MI> <MO>)</MO> </MROW><MN>5.256</MN> </MSUP><MO>;</MO> </MTD><MTD><MN>0</MN> <MO><</MO> <MI>H</MI> <MO><</MO> <MN>36089</MN> </MTD></MTR><MTR><MTD><MN>2113.8</MN> <MO>×</MO> <MN>0.2234</MN> <MO>×</MO> <MSUP><MI>e</MI> <MROW><MO>-</MO> <MN>4.806</MN> <MI>e</MI> <MO>-</MO> <MN>5</MN> <MO>×</MO> <MROW><MO>(</MO> <MI>H</MI> <MO>-</MO> <MN>36089</MN> <MO>)</MO> </MROW></MROW></MSUP><MO>;</MO> </MTD><MTD><MN>36089</MN> <MO><</MO> <MI>H</MI> <MO><</MO> <MN>240000</MN> </MTD></MTR></MTABLE><MROW><MO>-</MO> <MO>-</MO> <MO>-</MO> <MROW><MO>(</MO> <MN>12</MN> <MO>)</MO> </MROW></MROW></MFENCED></MROW>]]></MATH></MATHS> <BR>其中： <BR>H、He分别是海拔高度的公制和英制表示； <BR>ρ表示当前高度处的大气密度； <BR>Vsonic表示当前高度处的音速； <BR>σ表示当前高度和海平面的大气密度之比； <BR>Ts表示当前高度处大气的静温； <BR>Ps表示当前高度处的大气的静压。 <BR>重力场模型： <BR><MATHS num="0010"><MATH><![CDATA[ <mrow><MFENCED close="" open="{"><MTABLE><MTR><MTD><MSUB><MI>K</MI> <MI>R</MI> </MSUB><MO>=</MO> <MN>0.00108263</MN> <MO>*</MO> <MSUP><MROW><MO>(</MO> <MFRAC><MROW><MI>H</MI> <MO>+</MO> <MSUB><MI>R</MI> <MI>e</MI> </MSUB></MROW><MSUB><MI>R</MI> <MI>e</MI> </MSUB></MFRAC><MO>)</MO> </MROW><MN>2</MN> </MSUP></MTD></MTR><MTR><MTD><MSUB><MI>K</MI> <MI>g</MI> </MSUB><MO>=</MO> <MSQRT><MN>2.25</MN> <MROW><MO>(</MO> <MSUP><MROW><MN>5</MN> <MI>sin</MI> </MROW><MN>4</MN> </MSUP><MROW><MO>(</MO> <MI>D</MI> <MO>)</MO> </MROW><MO>-</MO> <MSUP><MROW><MN>2</MN> <MI>sin</MI> </MROW><MN>2</MN> </MSUP><MROW><MO>(</MO> <MI>D</MI> <MO>)</MO> </MROW><MO>+</MO> <MN>1</MN> <MO>)</MO> </MROW><MSUBSUP><MI>K</MI> <MI>R</MI> <MN>2</MN> </MSUBSUP><MO>+</MO> <MN>3</MN> <MROW><MO>(</MO> <MSUP><MROW><MO>-</MO> <MN>3</MN> <MI>sin</MI> </MROW><MN>2</MN> </MSUP><MROW><MO>(</MO> <MI>D</MI> <MO>)</MO> </MROW><MO>+</MO> <MN>1</MN> <MO>)</MO> </MROW><MSUB><MI>K</MI> <MI>R</MI> </MSUB><MO>+</MO> <MN>1</MN> </MSQRT></MTD></MTR><MTR><MTD><MI>g</MI> <MO>=</MO> <MSUB><MI>K</MI> <MI>g</MI> </MSUB><MFRAC><MI>GM</MI> <MSUP><MROW><MO>(</MO> <MI>H</MI> <MO>+</MO> <MSUB><MI>R</MI> <MI>e</MI> </MSUB><MO>)</MO> </MROW><MN>2</MN> </MSUP></MFRAC></MTD></MTR></MTABLE></MFENCED><MO>-</MO> <MO>-</MO> <MO>-</MO> <MROW><MO>(</MO> <MN>13</MN> <MO>)</MO> </MROW></MROW>]]></MATH></MATHS> <BR>其中： <BR>H表示海拔高度； <BR>Re表示地球半径； <BR>D表示纬度； <BR>G表示引力常数； <BR>M表示地球质量； <BR>本步骤中的其他辅助量(指示空速、真空速、动压、压差、气流角、气流角变化率和无人机相对于跑道的坐标)可根据其定义和物理机理进行计算； <BR>步骤七：调用通用模型软件用户接口函数获得完备的描述无人机运动的物理量； <BR>步骤八：重复步骤二至步骤七，实现无人机运动的非线性仿真。 <BR>更进一步地，本发明的仿真方法可实现一个模型同时支持两种坐标系下的仿真。本发明技术方案中提到的苏联坐标系和欧美坐标系实质上是一个事实的两种不同的描述，因此可以把欧美坐标系的输入转化为苏联坐标系的输入，在苏联坐标系进行模型解算后，把苏联坐标系的输出再转化为欧美坐标系的输出，实现一个模型对两种坐标系的支持。 <BR>更进一步地，本发明的仿真方法可同时支持C语言环境和MATLAB环境下的仿真。本发明在VC++6.0下用ANSI C编程实现并封装成静态库，提供用户接口函数；在此基础上进行CMEX封装，生成可在MATLAB环境运行的函数，可用于C开发环境和MATLAB开发环境下无人机的建模，支持多平台运行的要求。 <BR>上述步骤中所涉及的接口函数可分为八类：①基本操作函数(设置无人机所受外力和外力矩、设置无人机惯性量、触发模型解算)；②设置刚体基本状态量函数；③获取刚体基本状态量函数；④获取刚体基本状态量导数函数；⑤相对气流功能函数；⑥坐标系之间的相互转化函数；⑦跑到相关功能函数；⑧内部核心算法函数(实现刚体六自由度模型、大气模型、重力场模型、状态量更新和辅助物理量的计算)。接口函数的合理设计和分类使得软件使用更易于使用。 <BR>本发明提供的用实现权利要求1所述方法的系统，包括： <BR>仿真系统输入模块； <BR>进行无人机运动状态初始化的初始化模块； <BR>状态量导数解算模块； <BR>状态量更新模块； <BR>辅助物理量计算模块； <BR>仿真系统输出模块； <BR>其中，无人机状态参数通过仿真系统输入模块输入初始化模块，初始化模块对无人机初始状态信息进行处理并将处理结果输入初始化状态量更新模块；无人机所受不含重力的外力和外力矩通过仿真系统输入模块输入状态量导数解算模块，状态量导数解算模块解算得到状态量导数，并输出至状态量更新模块；状态量更新模块更新运动状态，将新的值输出至辅助物理量计算模块；状态量导数解算模块、状态量更新模块、辅助物理量计算模块的输出结果通过仿真系统输出模块提供给用户使用。 <BR>有益效果 <BR>本发明的方法在软件中编写了复杂的模型解算程序，把更多的工作交给计算机，只需用户输入外力和外力矩，即可得到完备的无人机的物理量，使用简单、方便。由于通用建模方法的对象为面对称刚体，适用于所有无人机非线性数学模型在不同坐标系和不同开发环境下的构建，该方法使得设计开发人员只要专注于气动力和力矩的解算，系统搭建简单易行，简化了无人机的建模过程，缩短建模周期，提高了效率。 <BR>附图说明 <BR>图1是非线性模型解算流程图； <BR>图2是风的动态加入原理图； <BR>图3是接口函数分类示意图； <BR>图4是双坐标系支持原理图； <BR>图5是CMEX封装示意图； <BR>图6仿真系统原理图； <BR>图7仿真系统输入模块原理图； <BR>图8仿真系统输出模块原理图。 <BR>具体实施方式 <BR>实施例一： <BR>如图1‑图5所示，本实施例涉及一种基于非线性数学模型的通用型无人机仿真方法，主要包括模型解算、双坐标系支持和CMEX封装三个方法模块，具体步骤如下： <BR>步骤一：调用通用模型软件提供的用户接口函数，初始化无人机的运动状态； <BR>本实施例设计了两种初始化的方式：初始化地速在机体坐标系的分量和初始化地速在地理坐标系的分量。允许用户选择其中的一种进行初始化，通过模型中提供的机体坐标系和地理坐标系之间的转化矩阵，软件程序自动完成另一种速度的初始化。 <BR>步骤二：设置无人机的质量和转动惯量，输入无人机所受外力(不含重力)和外力矩； <BR>步骤三：根据面对称刚体六自由度运动模型计算无人机状态量导数，认为平面大地是惯性系，在苏联坐标系下解算： <BR>线动力学方程： <BR><MATHS num="0011"><MATH><![CDATA[ <mrow><MFENCED close="" open="{"><MTABLE><MTR><MTD><MSUB><MOVER><MI>V</MI> <MO>.</MO> </MOVER><MI>x</MI> </MSUB><MO>=</MO> <MSUB><MI>V</MI> <MI>z</MI> </MSUB><MSUB><MI>ω</MI> <MI>y</MI> </MSUB><MO>-</MO> <MSUB><MI>V</MI> <MI>y</MI> </MSUB><MSUB><MI>ω</MI> <MI>z</MI> </MSUB><MO>+</MO> <MSUB><MI>F</MI> <MI>x</MI> </MSUB><MO>/</MO> <MI>m</MI> <MO>+</MO> <MSUB><MI>G</MI> <MI>x</MI> </MSUB></MTD></MTR><MTR><MTD><MSUB><MOVER><MI>V</MI> <MO>.</MO> </MOVER><MI>y</MI> </MSUB><MO>=</MO> <MSUB><MI>V</MI> <MI>x</MI> </MSUB><MSUB><MI>ω</MI> <MI>z</MI> </MSUB><MSUB><MROW><MO>-</MO> <MI>V</MI> </MROW><MI>z</MI> </MSUB><MSUB><MI>ω</MI> <MI>x</MI> </MSUB><MO>+</MO> <MSUB><MI>F</MI> <MI>y</MI> </MSUB><MO>/</MO> <MI>m</MI> <MSUB><MI>G</MI> <MI>y</MI> </MSUB></MTD></MTR><MTR><MTD><MSUB><MOVER><MI>V</MI> <MO>.</MO> </MOVER><MI>x</MI> </MSUB><MO>=</MO> <MSUB><MI>V</MI> <MI>y</MI> </MSUB><MSUB><MI>ω</MI> <MI>x</MI> </MSUB><MO>-</MO> <MSUB><MI>V</MI> <MI>x</MI> </MSUB><MSUB><MI>ω</MI> <MI>y</MI> </MSUB><MO>+</MO> <MSUB><MI>F</MI> <MI>z</MI> </MSUB><MO>/</MO> <MI>m</MI> <MO>+</MO> <MSUB><MI>G</MI> <MI>z</MI> </MSUB></MTD></MTR></MTABLE></MFENCED><MO>-</MO> <MO>-</MO> <MO>-</MO> <MROW><MO>(</MO> <MN>1</MN> <MO>)</MO> </MROW></MROW>]]></MATH></MATHS> <BR>角动力学方程： <BR><MATHS num="0012"><MATH><![CDATA[ <mrow><MFENCED close="" open="{"><MTABLE><MTR><MTD><MSUB><MOVER><MI>ω</MI> <MO>.</MO> </MOVER><MI>x</MI> </MSUB><MI></MI><MO>=</MO> <MFRAC><MROW><MSUB><MI>I</MI> <MI>yy</MI> </MSUB><MSUB><MI>M</MI> <MI>x</MI> </MSUB><MO>+</MO> <MSUB><MI>I</MI> <MI>xy</MI> </MSUB><MSUB><MI>M</MI> <MI>y</MI> </MSUB><MO>-</MO> <MSUB><MI>I</MI> <MI>xy</MI> </MSUB><MROW><MO>(</MO> <MSUB><MI>I</MI> <MI>xx</MI> </MSUB><MO>-</MO> <MSUB><MI>I</MI> <MI>yy</MI> </MSUB><MO>+</MO> <MSUB><MI>I</MI> <MI>zz</MI> </MSUB><MO>)</MO> </MROW><MSUB><MI>ω</MI> <MI>x</MI> </MSUB><MSUB><MI>ω</MI> <MI>z</MI> </MSUB><MO>+</MO> <MROW><MO>(</MO> <MSUB><MI>I</MI> <MI>yy</MI> </MSUB><MSUB><MI>I</MI> <MI>yy</MI> </MSUB><MO>+</MO> <MSUB><MI>I</MI> <MI>xy</MI> </MSUB><MSUB><MI>I</MI> <MI>xy</MI> </MSUB><MO>-</MO> <MSUB><MI>I</MI> <MI>yy</MI> </MSUB><MSUB><MI>I</MI> <MI>zz</MI> </MSUB><MO>)</MO> </MROW><MSUB><MI>ω</MI> <MI>y</MI> </MSUB><MSUB><MI>ω</MI> <MI>z</MI> </MSUB></MROW><MROW><MSUB><MI>I</MI> <MI>xx</MI> </MSUB><MSUB><MI>I</MI> <MI>yy</MI> </MSUB><MO>-</MO> <MSUB><MI>I</MI> <MI>xy</MI> </MSUB><MSUB><MI>I</MI> <MI>xy</MI> </MSUB></MROW></MFRAC></MTD></MTR><MTR><MTD><MSUB><MOVER><MI>ω</MI> <MO>.</MO> </MOVER><MI>y</MI> </MSUB><MI></MI><MO>=</MO> <MFRAC><MROW><MSUB><MI>I</MI> <MI>xx</MI> </MSUB><MSUB><MI>M</MI> <MI>y</MI> </MSUB><MO>+</MO> <MSUB><MI>I</MI> <MI>xy</MI> </MSUB><MSUB><MI>M</MI> <MI>x</MI> </MSUB><MO>+</MO> <MSUB><MI>I</MI> <MI>xy</MI> </MSUB><MROW><MO>(</MO> <MSUB><MI>I</MI> <MI>xx</MI> </MSUB><MO>-</MO> <MSUB><MI>I</MI> <MI>yy</MI> </MSUB><MO>+</MO> <MSUB><MI>I</MI> <MI>zz</MI> </MSUB><MO>)</MO> </MROW><MSUB><MI>ω</MI> <MI>y</MI> </MSUB><MSUB><MI>ω</MI> <MI>z</MI> </MSUB><MO>-</MO> <MROW><MO>(</MO> <MSUB><MI>I</MI> <MI>xx</MI> </MSUB><MSUB><MI>I</MI> <MI>xx</MI> </MSUB><MO>+</MO> <MSUB><MI>I</MI> <MI>xy</MI> </MSUB><MSUB><MI>I</MI> <MI>xy</MI> </MSUB><MO>-</MO> <MSUB><MI>I</MI> <MI>xx</MI> </MSUB><MSUB><MI>I</MI> <MI>zz</MI> </MSUB><MO>)</MO> </MROW><MSUB><MI>ω</MI> <MI>x</MI> </MSUB><MSUB><MI>ω</MI> <MI>z</MI> </MSUB></MROW><MROW><MSUB><MI>I</MI> <MI>xx</MI> </MSUB><MSUB><MI>I</MI> <MI>yy</MI> </MSUB><MO>-</MO> <MSUB><MI>I</MI> <MI>xy</MI> </MSUB><MSUB><MI>I</MI> <MI>xy</MI> </MSUB></MROW></MFRAC></MTD></MTR><MTR><MTD><MSUB><MOVER><MI>ω</MI> <MO>.</MO> </MOVER><MI>z</MI> </MSUB><MI></MI><MO>=</MO> <MFRAC><MROW><MSUB><MI>M</MI> <MI>z</MI> </MSUB><MO>-</MO> <MROW><MO>(</MO> <MSUB><MI>I</MI> <MI>yy</MI> </MSUB><MO>-</MO> <MSUB><MI>I</MI> <MI>xx</MI> </MSUB><MO>)</MO> </MROW><MSUB><MI>ω</MI> <MI>x</MI> </MSUB><MSUB><MI>ω</MI> <MI>y</MI> </MSUB><MO>+</MO> <MSUB><MI>I</MI> <MI>xy</MI> </MSUB><MROW><MO>(</MO> <MSUB><MI>ω</MI> <MI>x</MI> </MSUB><MSUB><MI>ω</MI> <MI>x</MI> </MSUB><MO>-</MO> <MSUB><MI>ω</MI> <MI>y</MI> </MSUB><MSUB><MI>ω</MI> <MI>y</MI> </MSUB><MO>)</MO> </MROW></MROW><MSUB><MI>I</MI> <MI>zz</MI> </MSUB></MFRAC></MTD></MTR></MTABLE></MFENCED><MO>-</MO> <MO>-</MO> <MO>-</MO> <MROW><MO>(</MO> <MN>2</MN> <MO>)</MO> </MROW></MROW>]]></MATH></MATHS> <BR>线运动学方程： <BR><MATHS num="0013"><MATH><![CDATA[ <mrow><MFENCED close="" open="{"><MTABLE><MTR><MTD><MSUB><MOVER><MI>x</MI> <MO>.</MO> </MOVER><MI>g</MI> </MSUB><MO>=</MO> <MSUB><MI>V</MI> <MI>x</MI> </MSUB><MI>cos</MI> <MI></MI><MI>ψ</MI> <MI>cos</MI> <MI>&upsi;</MI> <MO>+</MO> <MSUB><MI>V</MI> <MI>y</MI> </MSUB><MROW><MO>(</MO> <MI>sin</MI> <MI></MI><MI>ψ</MI> <MI>sin</MI> <MI>γ</MI> <MO>-</MO> <MI>cos</MI> <MI>ψ</MI> <MI>sin</MI> <MI></MI><MI>&upsi;</MI> <MI>cos</MI> <MI>γ</MI> <MO>)</MO> </MROW><MO>+</MO> <MSUB><MI>V</MI> <MI>z</MI> </MSUB><MROW><MO>(</MO> <MI>sin</MI> <MI></MI><MI>ψ</MI> <MI>cos</MI> <MI>γ</MI> <MO>+</MO> <MI>cos</MI> <MI></MI><MI>ψ</MI> <MI>sin</MI> <MI></MI><MI>&upsi;</MI> <MI>sin</MI> <MI>γ</MI> <MO>)</MO> </MROW></MTD></MTR><MTR><MTD><MSUB><MOVER><MI>h</MI> <MO>.</MO> </MOVER><MI>g</MI> </MSUB><MO>=</MO> <MSUB><MI>V</MI> <MI>x</MI> </MSUB><MI>sin</MI> <MI>&upsi;</MI> <MO>+</MO> <MSUB><MI>V</MI> <MI>y</MI> </MSUB><MI>cos</MI> <MI></MI><MI>&upsi;</MI> <MI>cos</MI> <MI>γ</MI> <MO>-</MO> <MSUB><MI>V</MI> <MI>z</MI> </MSUB><MI>cos</MI> <MI></MI><MI>&upsi;</MI> <MI>sin</MI> <MI>γ</MI> </MTD></MTR><MTR><MTD><MSUB><MOVER><MI>z</MI> <MO>.</MO> </MOVER><MI>g</MI> </MSUB><MO>=</MO> <MO>-</MO> <MSUB><MI>V</MI> <MI>x</MI> </MSUB><MI>sin</MI> <MI></MI><MI>ψ</MI> <MI>cos</MI> <MI>&upsi;</MI> <MO>+</MO> <MSUB><MI>V</MI> <MI>y</MI> </MSUB><MROW><MO>(</MO> <MI>cos</MI> <MI></MI><MI>ψ</MI> <MI>sin</MI> <MI>γ</MI> <MO>+</MO> <MI>sin</MI> <MI></MI><MI>ψ</MI> <MI>sin</MI> <MI></MI><MI>&upsi;</MI> <MI>sin</MI> <MO>)</MO> </MROW><MO>+</MO> <MSUB><MI>V</MI> <MI>z</MI> </MSUB><MROW><MO>(</MO> <MI>cos</MI> <MI></MI><MI>ψ</MI> <MI>cos</MI> <MI>γ</MI> <MO>-</MO> <MI>sin</MI> <MI></MI><MI>ψ</MI> <MI>sin</MI> <MI></MI><MI>&upsi;</MI> <MI>sin</MI> <MI>γ</MI> <MO>)</MO> </MROW></MTD></MTR></MTABLE></MFENCED><MO>-</MO> <MO>-</MO> <MO>-</MO> <MROW><MO>(</MO> <MN>3</MN> <MO>)</MO> </MROW></MROW>]]></MATH></MATHS> <BR>角运动学方程： <BR><MATHS num="0014"><MATH><![CDATA[ <mrow><MFENCED close="" open="{"><MTABLE><MTR><MTD><MOVER><MI>&upsi;</MI> <MO>.</MO> </MOVER><MO>=</MO> <MSUB><MI>ω</MI> <MI>y</MI> </MSUB><MI>sin</MI> <MI>γ</MI> <MO>+</MO> <MSUB><MI>ω</MI> <MI>z</MI> </MSUB><MI>cos</MI> <MI>γ</MI> </MTD></MTR><MTR><MTD><MOVER><MI>γ</MI> <MO>.</MO> </MOVER><MO>=</MO> <MSUB><MI>ω</MI> <MI>x</MI> </MSUB><MO>-</MO> <MI>tan</MI> <MI>&upsi;</MI> <MROW><MO>(</MO> <MSUB><MI>ω</MI> <MI>y</MI> </MSUB><MI>cos</MI> <MI>γ</MI> <MO>-</MO> <MSUB><MI>ω</MI> <MI>z</MI> </MSUB><MI>sin</MI> <MI>γ</MI> <MO>)</MO> </MROW></MTD></MTR><MTR><MTD><MOVER><MI>ψ</MI> <MO>.</MO> </MOVER><MO>=</MO> <MROW><MO>(</MO> <MSUB><MI>ω</MI> <MI>y</MI> </MSUB><MI>cos</MI> <MI>γ</MI> <MO>-</MO> <MSUB><MI>ω</MI> <MI>z</MI> </MSUB><MI>sin</MI> <MI>γ</MI> <MO>)</MO> </MROW><MO>/</MO> <MI>cos</MI> <MI>&upsi;</MI> </MTD></MTR></MTABLE></MFENCED><MO>-</MO> <MO>-</MO> <MO>-</MO> <MROW><MO>(</MO> <MN>4</MN> <MO>)</MO> </MROW></MROW>]]></MATH></MATHS> <BR>其中： <BR>Fx、Fy、Fz为外力(不含重力)沿机体轴的分量； <BR>Mx、My、Mz为外力矩沿机体轴的分量； <BR>Gx、Gy、Gz为重力加速度沿机体轴的分量； <BR>m为无人机质量； <BR>Ixx、Iyy、Izz、Ixy、分别是无人机沿机体轴向的转动惯量和惯性积； <BR>Vx、Vy、Vz为地速沿机体轴的分量； <BR>xg、hg、zg为分别是无人机北向、天向和东向的位移； <BR>ωx、ωy、ωz为绕机体轴转动的角速率沿机体轴的分量； <BR>υ、γ、ψ分别是俯仰角、滚转角、偏航角。 <BR>步骤四：采用Adams显示数值积分算法更新无人机状态量： <BR><MATHS num="0015"><MATH><![CDATA[ <mrow><MSUB><MI>y</MI> <MROW><MI>n</MI> <MO>+</MO> <MN>4</MN> </MROW></MSUB><MO>=</MO> <MSUB><MI>y</MI> <MROW><MI>n</MI> <MO>+</MO> <MN>3</MN> </MROW></MSUB><MO>+</MO> <MFRAC><MI>h</MI> <MN>24</MN> </MFRAC><MROW><MO>(</MO> <MN>55</MN> <MSUB><MOVER><MI>y</MI> <MO>.</MO> </MOVER><MROW><MI>n</MI> <MO>+</MO> <MN>3</MN> </MROW></MSUB><MO>-</MO> <MN>59</MN> <MSUB><MOVER><MI>y</MI> <MO>.</MO> </MOVER><MROW><MI>n</MI> <MO>+</MO> <MN>2</MN> </MROW></MSUB><MO>+</MO> <MN>37</MN> <MSUB><MOVER><MI>y</MI> <MO>.</MO> </MOVER><MROW><MI>n</MI> <MO>+</MO> <MN>1</MN> </MROW></MSUB><MO>-</MO> <MN>9</MN> <MSUB><MOVER><MI>y</MI> <MO>.</MO> </MOVER><MI>n</MI> </MSUB><MO>)</MO> </MROW><MO>-</MO> <MO>-</MO> <MO>-</MO> <MROW><MO>(</MO> <MN>5</MN> <MO>)</MO> </MROW></MROW>]]></MATH></MATHS> <BR>截断误差为 <BR>其中： <BR>h表示仿真步长； <BR>分别表示第n+3、n+2、n+1、n时刻的导数； <BR>yn+4、yn+3分别表示n+4、n+3时刻的值。 <BR>步骤五：内置风模型，允许用户设置风速； <BR>参照图2，根据用户设置的风速，合成空速，： <BR><MATHS num="0016"><MATH><![CDATA[ <mfenced open='{' close='' separators=''><MTABLE><MTR><MTD><MSUB><MI>V</MI> <MROW><MI>e</MI> <MN>2</MN> <MI>wind</MI> </MROW></MSUB><MO>=</MO> <MSUB><MI>V</MI> <MI>e</MI> </MSUB><MO>-</MO> <MSUB><MI>V</MI> <MROW><MI>wind</MI> <MO>_</MO> <MI>e</MI> </MROW></MSUB></MTD></MTR><MTR><MTD><MSUB><MI>V</MI> <MROW><MI>n</MI> <MN>2</MN> <MI>wind</MI> </MROW></MSUB><MO>=</MO> <MSUB><MI>V</MI> <MI>n</MI> </MSUB><MO>-</MO> <MSUB><MI>V</MI> <MROW><MI>wind</MI> <MO>_</MO> <MI>n</MI> </MROW></MSUB></MTD></MTR><MTR><MTD><MSUB><MI>V</MI> <MROW><MI>u</MI> <MN>2</MN> <MI>wind</MI> </MROW></MSUB><MO>=</MO> <MSUB><MI>V</MI> <MI>u</MI> </MSUB><MO>-</MO> <MSUB><MI>V</MI> <MROW><MI>wind</MI> <MO>_</MO> <MI>u</MI> </MROW></MSUB></MTD></MTR></MTABLE><MROW><MO>-</MO> <MO>-</MO> <MO>-</MO> <MROW><MO>(</MO> <MN>6</MN> <MO>)</MO> </MROW></MROW></MFENCED>]]></MATH></MATHS> <BR>其中： <BR>Ve、Vn、Vu分别是无人机地速在东向、北向、天向的分量； <BR>Vwind_e、Vwind_n、Vwind_u分别是气流的东向速度、北向速度、天向速度； <BR>Ve2wind、Vn2wind、Vu2wind分别是空速在东向、北向、天向的分量。 <BR>用户可以随时设定气流速度Vwind_e、Vwind_n、Vwind_u，从而实现风的动态加入。 <BR>步骤六：已知无人机的状态量和风速，在标准大气模型、重力场模型的基础上，计算空速、气流角、动压……等辅助量，支持模型加风； <BR>1962年美国标准大气： <BR>ρ查1962年标准大气表 (7) <BR>Vsonic查1962年标准大气表 (8) <BR><MATHS num="0017"><MATH><![CDATA[ <mrow><MI>σ</MI> <MO>=</MO> <MFRAC><MI>ρ</MI> <MSUB><MI>ρ</MI> <MROW><MI>sea</MI> <MO>_</MO> <MI>level</MI> </MROW></MSUB></MFRAC><MO>-</MO> <MO>-</MO> <MO>-</MO> <MROW><MO>(</MO> <MN>9</MN> <MO>)</MO> </MROW></MROW>]]></MATH></MATHS> <BR>He＝3.2808×H (10) <BR><MATHS num="0018"><MATH><![CDATA[ <mrow><MSUB><MI>T</MI> <MI>s</MI> </MSUB><MO>=</MO> <MN>0.55556</MN> <MO>×</MO> <MFENCED close="" open="{" separators=""><MTABLE><MTR><MTD><MN>518.7</MN> <MO>×</MO> <MROW><MO>(</MO> <MN>1</MN> <MO>.</MO> <MN>0</MN> <MO>-</MO> <MN>6.875</MN> <MI>e</MI> <MO>-</MO> <MN>6</MN> <MO>×</MO> <MI>H</MI> <MO>)</MO> </MROW><MO>;</MO> </MTD><MTD><MN>0</MN> <MO><</MO> <MSUB><MI>H</MI> <MI>e</MI> </MSUB><MI></MI><MO><</MO> <MN>36089</MN> </MTD></MTR><MTR><MTD><MN>518.7</MN> <MO>×</MO> <MN>0.751985</MN> <MO>;</MO> </MTD><MTD><MN>36089</MN> <MO><</MO> <MSUB><MI>H</MI> <MI>e</MI> </MSUB><MO><</MO> <MN>240000</MN> </MTD></MTR></MTABLE><MROW><MO>-</MO> <MO>-</MO> <MO>-</MO> <MROW><MO>(</MO> <MN>11</MN> <MO>)</MO> </MROW></MROW></MFENCED></MROW>]]></MATH></MATHS> <BR><MATHS num="0019"><MATH><![CDATA[ <mrow><MSUB><MI>P</MI> <MI>s</MI> </MSUB><MO>=</MO> <MN>47.88018</MN> <MO>×</MO> <MFENCED close="]" open="[" separators=""><MTABLE><MTR><MTD><MN>2113.8</MN> <MO>×</MO> <MSUP><MROW><MO>(</MO> <MN>1.0</MN> <MO>-</MO> <MN>6.875</MN> <MI>e</MI> <MO>×</MO> <MI>H</MI> <MO>)</MO> </MROW><MN>5.256</MN> </MSUP><MO>;</MO> </MTD><MTD><MN>0</MN> <MO><</MO> <MI>H</MI> <MO><</MO> <MN>36089</MN> </MTD></MTR><MTR><MTD><MN>2113.8</MN> <MO>×</MO> <MN>0.2234</MN> <MO>×</MO> <MSUP><MI>e</MI> <MROW><MO>-</MO> <MN>4.806</MN> <MI>e</MI> <MO>-</MO> <MN>5</MN> <MO>×</MO> <MROW><MO>(</MO> <MI>H</MI> <MO>-</MO> <MN>36089</MN> <MO>)</MO> </MROW></MROW></MSUP><MO>;</MO> </MTD><MTD><MN>36089</MN> <MO><</MO> <MI>H</MI> <MO><</MO> <MN>240000</MN> </MTD></MTR></MTABLE><MROW><MO>-</MO> <MO>-</MO> <MO>-</MO> <MROW><MO>(</MO> <MN>12</MN> <MO>)</MO> </MROW></MROW></MFENCED></MROW>]]></MATH></MATHS> <BR>其中： <BR>H、He分别是海拔高度的公制和英制表示； <BR>ρ表示当前高度处的大气密度； <BR>Vsonic表示当前高度处的音速； <BR>σ表示当前高度和海平面的大气密度之比； <BR>Ts表示当前高度处大气的静温； <BR>Ps表示当前高度处的大气的静压。 <BR>重力场模型： <BR><MATHS num="0020"><MATH><![CDATA[ <mrow><MFENCED close="" open="{"><MTABLE><MTR><MTD><MSUB><MI>K</MI> <MI>R</MI> </MSUB><MO>=</MO> <MN>0.00108263</MN> <MO>*</MO> <MSUP><MROW><MO>(</MO> <MFRAC><MROW><MI>H</MI> <MO>+</MO> <MSUB><MI>R</MI> <MI>e</MI> </MSUB></MROW><MSUB><MI>R</MI> <MI>e</MI> </MSUB></MFRAC><MO>)</MO> </MROW><MN>2</MN> </MSUP></MTD></MTR><MTR><MTD><MSUB><MI>K</MI> <MI>g</MI> </MSUB><MO>=</MO> <MSQRT><MN>2.25</MN> <MROW><MO>(</MO> <MSUP><MROW><MN>5</MN> <MI>sin</MI> </MROW><MN>4</MN> </MSUP><MROW><MO>(</MO> <MI>D</MI> <MO>)</MO> </MROW><MO>-</MO> <MSUP><MROW><MN>2</MN> <MI>sin</MI> </MROW><MN>2</MN> </MSUP><MROW><MO>(</MO> <MI>D</MI> <MO>)</MO> </MROW><MO>+</MO> <MN>1</MN> <MO>)</MO> </MROW><MSUBSUP><MI>K</MI> <MI>R</MI> <MN>2</MN> </MSUBSUP><MO>+</MO> <MN>3</MN> <MROW><MO>(</MO> <MSUP><MROW><MO>-</MO> <MN>3</MN> <MI>sin</MI> </MROW><MN>2</MN> </MSUP><MROW><MO>(</MO> <MI>D</MI> <MO>)</MO> </MROW><MO>+</MO> <MN>1</MN> <MO>)</MO> </MROW><MSUB><MI>K</MI> <MI>R</MI> </MSUB><MO>+</MO> <MN>1</MN> </MSQRT></MTD></MTR><MTR><MTD><MI>g</MI> <MO>=</MO> <MSUB><MI>K</MI> <MI>g</MI> </MSUB><MFRAC><MI>GM</MI> <MSUP><MROW><MO>(</MO> <MI>H</MI> <MO>+</MO> <MSUB><MI>R</MI> <MI>e</MI> </MSUB><MO>)</MO> </MROW><MN>2</MN> </MSUP></MFRAC></MTD></MTR></MTABLE></MFENCED><MO>-</MO> <MO>-</MO> <MO>-</MO> <MROW><MO>(</MO> <MN>13</MN> <MO>)</MO> </MROW></MROW>]]></MATH></MATHS> <BR>其中： <BR>H表示海拔高度； <BR>Re表示地球半径； <BR>D表示纬度； <BR>G表示引力常数； <BR>M表示地球质量。 <BR>其他辅助量(指示空速、真空速、动压、压差、气流角、气流角变化率和无人机相对于跑道的坐标)可根据其定义和物理机理进行计算。 <BR>步骤七：调用用户接口函数获得完备的描述无人机运动的物理量，供设计人员使用； <BR>步骤八：重复步骤二至步骤七，实现无人机运动的非线性仿真。 <BR>如图3所示，上述步骤中所涉及的接口函数可分为八类：①基本操作函数(设置无人机所受外力和外力矩、设置无人机惯性量、触发模型解算)；②设置刚体基本状态量函数；③获取刚体基本状态量函数；④获取刚体基本状态量导数函数；⑤相对气流功能函数；⑥坐标系之间的相互转化函数；⑦跑到相关功能函数；⑧内部核心算法函数(实现刚体六自由度模型、大气模型、重力场模型、状态量更新和辅助物理量的计算)。 <BR>把欧美坐标系的输入转化为苏联坐标系的输入如图4所示，在苏联坐标系进行模型解算后，把苏联坐标系的输出再转化为欧美坐标系的输出，实现一个模型对两种坐标系的支持。 <BR>欧美坐标系到苏联坐标系转换矩阵 <BR><MATHS num="0021"><MATH><![CDATA[ <mrow><MSUB><MI>T</MI> <MROW><MI>E</MI> <MN>2</MN> <MI>S</MI> </MROW></MSUB><MO>=</MO> <MFENCED close="]" open="["><MTABLE><MTR><MTD><MN>1</MN> </MTD><MTD><MN>0</MN> </MTD><MTD><MN>0</MN> </MTD></MTR><MTR><MTD><MN>0</MN> </MTD><MTD><MN>0</MN> </MTD><MTD><MO>-</MO> <MN>1</MN> </MTD></MTR><MTR><MTD><MN>0</MN> </MTD><MTD><MN>1</MN> </MTD><MTD><MN>0</MN> </MTD></MTR></MTABLE></MFENCED><MO>-</MO> <MO>-</MO> <MO>-</MO> <MROW><MO>(</MO> <MN>14</MN> <MO>)</MO> </MROW></MROW>]]></MATH></MATHS> <BR>苏联坐标系到欧美坐标系转换矩阵 <BR><MATHS num="0022"><MATH><![CDATA[ <mrow><MSUB><MI>T</MI> <MROW><MI>S</MI> <MN>2</MN> <MI>E</MI> </MROW></MSUB><MO>=</MO> <MFENCED close="]" open="["><MTABLE><MTR><MTD><MN>1</MN> </MTD><MTD><MN>0</MN> </MTD><MTD><MN>0</MN> </MTD></MTR><MTR><MTD><MN>0</MN> </MTD><MTD><MN>0</MN> </MTD><MTD><MN>1</MN> </MTD></MTR><MTR><MTD><MN>0</MN> </MTD><MTD><MO>-</MO> <MN>1</MN> </MTD><MTD><MN>0</MN> </MTD></MTR></MTABLE></MFENCED><MO>-</MO> <MO>-</MO> <MO>-</MO> <MROW><MO>(</MO> <MN>15</MN> <MO>)</MO> </MROW></MROW>]]></MATH></MATHS> <BR>如图2、图4、图7、图8所示，在苏联坐标系下定义的物理量直接输入仿真系统，在欧美坐标系下定义的物理量通过“欧美坐标系‑苏联坐标系”11转换后，再输入仿真系统，满足仿真系统的解算要求。如图3所示，仿真系统的物理量直接输出，满足用户在苏联坐标系下的仿真要求；仿真系统的物理量通过“苏联坐标系‑欧美坐标系”61转换后再输出，满足用户在欧美坐标系下的仿真要求。 <BR>在VC++6.0下用ANSI C编程实现并封装成静态库，提供用户接口函数；在此基础上，按如下步骤进行CMEX封装： <BR>首先，用ANSI C编写CMEX封装所需要中间文件(FileName.c)，它依赖于通用模型静态库(LibName.lib)，只含有一个固定的接口函数： <BR>void mexFunction(int nlhs，mxArray*plhs[]，int nrhs，const mxArray*prhs[])； <BR>其中： <BR>nlhs是返回值的个数； <BR>plhs是返回值的首地址； <BR>nrhs是形参的个数； <BR>prhs是形参的首地址。 <BR>其次，在MATLAB命令窗口按要求输入命令： <BR>mex FileName.c LibName.lib <BR>生成可在MATLAB环境运行的函数。 <BR>如图5所示，通用模型静态库(.lib)可用于半物理仿真和等效仿真等仿真平台，通用模型MATLAB程序(.mexw32)可用于S‑function和M语言非线性仿真等开发平台，支持多平台运行的要求。 <BR>实施例二： <BR>本实施例涉及一种用于实现如实施例一所述的仿真方法的仿真系统，如图6‑图8所示，其包括： <BR>仿真系统输入模块1； <BR>进行无人机运动状态初始化的初始化模块2； <BR>状态量导数解算模块3； <BR>状态量更新模块4； <BR>辅助物理量计算模块5； <BR>仿真系统输出模块6； <BR>其中，无人机状态参数通过仿真系统输入模块1输入初始化模块2，初始化模块2对无人机初始状态信息进行处理并将处理结果输入初始化状态量更新模块4；无人机所受不含重力的外力和外力矩通过仿真系统输入模块1输入状态量导数解算模块3，状态量导数解算模块3解算得到状态量导数，并输出至状态量更新模块4；状态量更新模块4更新运动状态，将新的值输出至辅助物理量计算模块5；状态量导数解算模块3、状态量更新模块4、辅助物理量计算模块5的输出结果通过仿真系统输出模块6提供给用户使用。</p></div>
</div>
</div>
</div>

<div class="tempdiv cssnone" style="line-height:0px;height:0px; overflow:hidden;">

</div>

<div id="page">

<div class="page"><img src='https://img.zhuanlichaxun.net/fileroot2/2018-7/18/08c8cc53-dc4f-4b95-aea1-3fd969d10728/08c8cc53-dc4f-4b95-aea1-3fd969d107281.gif' alt="基于非线性数学模型的通用型无人机仿真方法及系统.pdf_第1页" width='100%'/></div><div class="pageSize">第1页 / 共17页</div>

<div class="page"><img src='https://img.zhuanlichaxun.net/fileroot2/2018-7/18/08c8cc53-dc4f-4b95-aea1-3fd969d10728/08c8cc53-dc4f-4b95-aea1-3fd969d107282.gif' alt="基于非线性数学模型的通用型无人机仿真方法及系统.pdf_第2页" width='100%'/></div><div class="pageSize">第2页 / 共17页</div>

<div class="page"><img src='https://img.zhuanlichaxun.net/fileroot2/2018-7/18/08c8cc53-dc4f-4b95-aea1-3fd969d10728/08c8cc53-dc4f-4b95-aea1-3fd969d107283.gif' alt="基于非线性数学模型的通用型无人机仿真方法及系统.pdf_第3页" width='100%'/></div><div class="pageSize">第3页 / 共17页</div>

</div>
<div id="pageMore" class="btnmore" onclick="ShowSvg();">点击查看更多>></div>

<div style="margin-top:20px; line-height:0px; height:0px; overflow:hidden;">
<div style=" font-size: 16px; background-color:#e5f0f7; font-weight: bold; text-indent:10px; line-height: 40px; height:40px; padding-bottom: 0px; margin-bottom:10px;">资源描述</div>
<div class="detail-article prolistshowimg">
<p>《基于非线性数学模型的通用型无人机仿真方法及系统.pdf》由会员分享，可在线阅读，更多相关《基于非线性数学模型的通用型无人机仿真方法及系统.pdf（17页珍藏版）》请在专利查询网上搜索。</p>
<p >1、(10)申请公布号 CN 102945002 A(43)申请公布日 2013.02.27CN102945002A*CN102945002A*(21)申请号 201210398129.3(22)申请日 2012.10.18G05B 17/02(2006.01)(71)申请人南京航空航天大学地址 210016 江苏省南京市御道街29号(72)发明人孙春贞彭夏鹏黄一敏(74)专利代理机构南京经纬专利商标代理有限公司 32200代理人叶连生(54) 发明名称基于非线性数学模型的通用型无人机仿真方法及系统(57) 摘要本发明公开了一种基于非线性数学模型的通用型无人机非线性模型构建方法，同时涉及一种用。</p>
<p >2、于实现该构建方法的系统。所述的方法主要包括模型解算、双坐标系支持和CMEX封装三个方法模块，所述的系统包括仿真系统输入模块、进行无人机运动状态初始化的初始化模块、状态量导数解算模块、状态量更新模块、辅助物理量计算模块和仿真系统输出模块。本发明的方法及系统把更多的工作交给计算机，只需用户输入外力和外力矩，即可得到完备的无人机的物理量，使用简单、方便。(51)Int.Cl.权利要求书3页说明书9页附图4页(19)中华人民共和国国家知识产权局(12)发明专利申请权利要求书 3 页说明书 9 页附图 4 页1/3页21.一种基于非线性数学模型的通用型无人机仿真方法，其特征在于，包括下列步骤：步。</p>
<p >3、骤一：调用仿真系统通用模型软件提供的用户接口函数，初始化无人机的运动状态；步骤二：设置无人机的质量和转动惯量，并向仿真系统输入无人机所受不含重力的外力和外力矩；步骤三：根据面对称刚体六自由度运动模型计算无人机状态量导数，以平面大地为惯性系，在苏联坐标系下进行解算：线动力学方程：角动力学方程：线运动学方程：角运动学方程：其中，Fx、Fy、Fz为外力沿机体轴的分量，其中的外力不含无人机重力；Mx、My、Mz为外力矩沿机体轴的分量；Gx、Gy、Gz为重力加速度沿机体轴的分量；m为无人机质量；Ixx、Iyy、Izz、Ixy、分别是无人机沿机体轴向的转动惯量和惯性积；Vx、Vy、Vz为地速沿机体轴的分量。</p>
<p >4、；xg、hg、zg为分别是无人机北向、天向和东向的位移；权利要求书CN 102945002 A2/3页3x、y、z为绕机体轴转动的角速率沿机体轴的分量；、为俯仰角、滚转角、偏航角；步骤四：使用Adams数值积分算法更新无人机状态量，截断误差为其中：h表示仿真步长；分别表示第n+3、n+2、n+1、n时刻的导数；yn+4、yn+3分别表示n+4、n+3时刻的值；步骤五：在仿真系统中内置风模型，根据用户设置的风速，合成空速：其中：Ve、Vn、Vu分别是无人机地速在东向、北向、天向的分量；Vwind_e、Vwind_n、Vwind_u分别是气流的东向速度、北向速度、天向速度；Ve2wind、。</p>
<p >5、Vn2wind、Vu2wind分别是空速在东向、北向、天向的分量；步骤六：根据步骤四得到的无人机状态量和步骤五得到的空速，在标准大气模型、重力场模型的基础上，计算空速、气流角、动压等辅助量；1962年美国标准大气：查1962年标准大气表 (7)Vsonic查1962年标准大气表 (8)He3.2808H (10)其中：H、He分别是海拔高度的公制和英制表示；表示当前高度处的大气密度；Vsonic表示当前高度处的音速；表示当前高度和海平面的大气密度之比；权利要求书CN 102945002 A3/3页4Ts表示当前高度处大气的静温；Ps表示当前高度处的大气的静压；重力场模型：其中：H表示海。</p>
<p >6、拔高度；Re表示地球半径；D表示纬度；G表示引力常数；M表示地球质量；步骤七：调用通用模型软件用户接口函数获得完备的描述无人机运动的物理量；步骤八：重复步骤二至步骤七，实现无人机运动的非线性仿真。2.如权利要求1所述的基于非线性数学模型的通用型无人机仿真方法，其特征在于，可支持所有面对称无人机运动的仿真。3.如权利要求1所述的基于非线性数学模型的通用型无人机仿真方法，其特征在于，可同时支持两种坐标系下的仿真。4.如权利要求1所述的基于非线性数学模型的通用型无人机仿真方法，其特征在于，可同时支持C语言环境和MATLAB环境下的仿真。5.一种用于实现权利要求1所述方法的系统，其特征在于，包括：仿真。</p>
<p >7、系统输入模块(1)；进行无人机运动状态初始化的初始化模块(2)；状态量导数解算模块(3)；状态量更新模块(4)；辅助物理量计算模块(5)；仿真系统输出模块(6)；其中，无人机状态参数通过仿真系统输入模块(1)输入初始化模块(2)，初始化模块(2)对无人机初始状态信息进行处理并将处理结果输入初始化状态量更新模块(4)；无人机所受不含重力的外力和外力矩通过仿真系统输入模块(1)输入状态量导数解算模块(3)，状态量导数解算模块(3)解算得到状态量导数，并输出至状态量更新模块(4)；状态量更新模块(4)更新运动状态，将新的值输出至辅助物理量计算模块(5)；状态量导数解算模块(3)、状态量更新模块(4)。</p>
<p >8、、辅助物理量计算模块(5)的输出结果通过仿真系统输出模块(6)提供给用户使用。权利要求书CN 102945002 A1/9页5基于非线性数学模型的通用型无人机仿真方法及系统技术领域0001 本发明涉及一种无人机数学模型的构建方法，尤其涉及一种通用的无人机非线性模型构建方法，同时涉及一种用于实现该构建方法的系统。背景技术0002 在无人机飞行控制律设计和验证的过程中，六自由度非线性数学模型的建立是前提和基础。一般无人机的数学模型建立的过程中，首先选择适当的坐标系；其次根据无人机当前迎角和侧滑角从吹风数据中获得气动导数，计算气动力和力矩，结合发动机模型和重力场模型，求得无人机合外力与合外力。</p>
<p >9、矩；然后在此基础上根据六自由度动力学和运动学方程，求取无人机状态量导数；接着通过数值积分解算，更新无人机的状态；最终利用新的状态计算所需要的其他物理量。这种建模方法存在三个方面的不足：0003 第一，当对不同型号无人机构建其非线性数学模型时，由于气动外形的差异，导致气动力和力矩的求取不同，它们的建模需都要重复上述过程，过程复杂，建模效率低，周期较长；0004 第二，针对苏联坐标系和欧美坐标系这两种不同的坐标系定义方式，原有的建模方法需要分别建模，无法同时支持两种坐标系；0005 第三，通常无人机控制律在MATLAB环境完成设计，而半物理仿真程序则是用C语言开发，二者都依赖于无人机非线性数学模型。</p>
<p >10、，需要用M语言和C语言分别编程实现无人机非线性模型，加大了建模的工作量。发明内容0006 技术问题0007 本发明要解决的技术问题是提供一种不受无人机型号限制、进行通用数学模型构建的方法，该方法可用于不同型号的无人机在不同坐标系和不同开发环境下的建模，同时亦提供一种用于实现该方法的通用型无人机非线性数学模型构建系统。0008 技术方案0009 为了解决上述的技术问题，本发明的通用型无人机非线性数学模型构建方法包括下列步骤：0010 步骤一：调用仿真系统通用模型软件提供的用户接口函数，初始化无人机的运动状态；0011 步骤二：设置无人机的质量和转动惯量，并向仿真系统输入无人机所受不含重力的外力和。</p>
<p style='height:0px;padding:0;margin:0;overflow:hidden'>11、外力矩；0012 步骤三：根据面对称刚体六自由度运动模型计算无人机状态量导数，以平面大地为惯性系，在苏联坐标系下进行解算：0013 线动力学方程：说明书CN 102945002 A2/9页60014 0015 角动力学方程：0016 0017 线运动学方程：0018 0019 角运动学方程：0020 0021 其中，0022 Fx、Fy、Fz为外力(不含重力)沿机体轴的分量；0023 Mx、My、Mz为外力矩沿机体轴的分量；0024 Gx、Gy、Gz为重力加速度沿机体轴的分量；0025 m为无人机质量；0026 Ixx、Iyy、Izz、Ixy、分别是无人机沿机体轴向的转动惯量和惯性积；00。</p>
<p style='height:0px;padding:0;margin:0;overflow:hidden'>12、27 Vx、Vy、Vz为地速沿机体轴的分量；0028 xg、hg、zg为分别是无人机北向、天向和东向的位移；0029 x、y、z为绕机体轴转动的角速率沿机体轴的分量；0030 、为俯仰角、滚转角、偏航角；0031 步骤四：使用Adams数值积分算法更新无人机状态量，0032 0033 截断误差为0034 其中：0035 h表示仿真步长；说明书CN 102945002 A3/9页70036 分别表示第n+3、n+2、n+1、n时刻的导数；0037 yn+4、yn+3分别表示n+4、n+3时刻的值；0038 步骤五：模型中内置风模型，根据用户设置的风速，合成空速，：0039 0040 其中：0。</p>
<p style='height:0px;padding:0;margin:0;overflow:hidden'>13、041 Ve、Vn、Vu分别是无人机地速在东向、北向、天向的分量；0042 Vwind_e、Vwind_n、Vwind_u分别是气流的东向速度、北向速度、天向速度；0043 Ve2wind、Vn2wind、Vu2wind分别是空速在东向、北向、天向的分量；0044 本步骤中，用户可以随时设定气流速度Vwind_e、Vwind_n、Vwind_u,从而实现风的动态加入；0045 步骤六：根据步骤四得到的无人机状态量和步骤五得到的空速，在标准大气模型、重力场模型的基础上，计算空速、气流角、动压等辅助量，支持模型加风；0046 1962年美国标准大气：0047 查1962年标准大气表 (7)0048。</p>
<p style='height:0px;padding:0;margin:0;overflow:hidden'>14、 Vsonic查1962年标准大气表 (8)0049 0050 He3.2808H (10)0051 0052 0053 其中：0054 H、He分别是海拔高度的公制和英制表示；0055 表示当前高度处的大气密度；0056 Vsonic表示当前高度处的音速；0057 表示当前高度和海平面的大气密度之比；0058 Ts表示当前高度处大气的静温；0059 Ps表示当前高度处的大气的静压。0060 重力场模型：说明书CN 102945002 A4/9页80061 0062 其中：0063 H表示海拔高度；0064 Re表示地球半径；0065 D表示纬度；0066 G表示引力常数；0067 M表示。</p>
<p style='height:0px;padding:0;margin:0;overflow:hidden'>15、地球质量；0068 本步骤中的其他辅助量(指示空速、真空速、动压、压差、气流角、气流角变化率和无人机相对于跑道的坐标)可根据其定义和物理机理进行计算；0069 步骤七：调用通用模型软件用户接口函数获得完备的描述无人机运动的物理量；0070 步骤八：重复步骤二至步骤七，实现无人机运动的非线性仿真。0071 更进一步地，本发明的仿真方法可实现一个模型同时支持两种坐标系下的仿真。本发明技术方案中提到的苏联坐标系和欧美坐标系实质上是一个事实的两种不同的描述，因此可以把欧美坐标系的输入转化为苏联坐标系的输入，在苏联坐标系进行模型解算后，把苏联坐标系的输出再转化为欧美坐标系的输出，实现一个模型对两种坐标系。</p>
<p style='height:0px;padding:0;margin:0;overflow:hidden'>16、的支持。0072 更进一步地，本发明的仿真方法可同时支持C语言环境和MATLAB环境下的仿真。本发明在VC+6.0下用ANSI C编程实现并封装成静态库，提供用户接口函数；在此基础上进行CMEX封装，生成可在MATLAB环境运行的函数，可用于C开发环境和MATLAB开发环境下无人机的建模，支持多平台运行的要求。0073 上述步骤中所涉及的接口函数可分为八类：基本操作函数(设置无人机所受外力和外力矩、设置无人机惯性量、触发模型解算)；设置刚体基本状态量函数；获取刚体基本状态量函数；获取刚体基本状态量导数函数；相对气流功能函数；坐标系之间的相互转化函数；跑到相关功能函数；内部核心算法函数(实现刚体。</p>
<p style='height:0px;padding:0;margin:0;overflow:hidden'>17、六自由度模型、大气模型、重力场模型、状态量更新和辅助物理量的计算)。接口函数的合理设计和分类使得软件使用更易于使用。0074 本发明提供的用实现权利要求1所述方法的系统，包括：0075 仿真系统输入模块；0076 进行无人机运动状态初始化的初始化模块；0077 状态量导数解算模块；0078 状态量更新模块；0079 辅助物理量计算模块；0080 仿真系统输出模块；说明书CN 102945002 A5/9页90081 其中，无人机状态参数通过仿真系统输入模块输入初始化模块，初始化模块对无人机初始状态信息进行处理并将处理结果输入初始化状态量更新模块；无人机所受不含重力的外力和外力矩通过仿真系统。</p>
<p style='height:0px;padding:0;margin:0;overflow:hidden'>18、输入模块输入状态量导数解算模块，状态量导数解算模块解算得到状态量导数，并输出至状态量更新模块；状态量更新模块更新运动状态，将新的值输出至辅助物理量计算模块；状态量导数解算模块、状态量更新模块、辅助物理量计算模块的输出结果通过仿真系统输出模块提供给用户使用。0082 有益效果0083 本发明的方法在软件中编写了复杂的模型解算程序，把更多的工作交给计算机，只需用户输入外力和外力矩，即可得到完备的无人机的物理量，使用简单、方便。由于通用建模方法的对象为面对称刚体，适用于所有无人机非线性数学模型在不同坐标系和不同开发环境下的构建，该方法使得设计开发人员只要专注于气动力和力矩的解算，系统搭建简单易行，简。</p>
<p style='height:0px;padding:0;margin:0;overflow:hidden'>19、化了无人机的建模过程，缩短建模周期，提高了效率。附图说明0084 图1是非线性模型解算流程图；0085 图2是风的动态加入原理图；0086 图3是接口函数分类示意图；0087 图4是双坐标系支持原理图；0088 图5是CMEX封装示意图；0089 图6仿真系统原理图；0090 图7仿真系统输入模块原理图；0091 图8仿真系统输出模块原理图。具体实施方式0092 实施例一：0093 如图1-图5所示，本实施例涉及一种基于非线性数学模型的通用型无人机仿真方法，主要包括模型解算、双坐标系支持和CMEX封装三个方法模块，具体步骤如下：0094 步骤一：调用通用模型软件提供的用户接口函数，初始化无人机。</p>
<p style='height:0px;padding:0;margin:0;overflow:hidden'>20、的运动状态；0095 本实施例设计了两种初始化的方式：初始化地速在机体坐标系的分量和初始化地速在地理坐标系的分量。允许用户选择其中的一种进行初始化，通过模型中提供的机体坐标系和地理坐标系之间的转化矩阵，软件程序自动完成另一种速度的初始化。0096 步骤二：设置无人机的质量和转动惯量，输入无人机所受外力(不含重力)和外力矩；0097 步骤三：根据面对称刚体六自由度运动模型计算无人机状态量导数，认为平面大地是惯性系，在苏联坐标系下解算：0098 线动力学方程：说明书CN 102945002 A6/9页100099 0100 角动力学方程：0101 0102 线运动学方程：0103 0104 角。</p>
<p style='height:0px;padding:0;margin:0;overflow:hidden'>21、运动学方程：0105 0106 其中：0107 Fx、Fy、Fz为外力(不含重力)沿机体轴的分量；0108 Mx、My、Mz为外力矩沿机体轴的分量；0109 Gx、Gy、Gz为重力加速度沿机体轴的分量；0110 m为无人机质量；0111 Ixx、Iyy、Izz、Ixy、分别是无人机沿机体轴向的转动惯量和惯性积；0112 Vx、Vy、Vz为地速沿机体轴的分量；0113 xg、hg、zg为分别是无人机北向、天向和东向的位移；0114 x、y、z为绕机体轴转动的角速率沿机体轴的分量；0115 、分别是俯仰角、滚转角、偏航角。0116 步骤四：采用Adams显示数值积分算法更新无人机状态量：0117 0118 截断误差为0119 其中：说明书CN 102945002 A10。</p>
</div>
<div class="readmore" onclick="showmore()" style="background-color:transparent; height:auto; margin:0px 0px; padding:20px 0px 0px 0px;"><span class="btn-readmore" style="background-color:transparent;"><em style=" font-style:normal">展开</em>阅读全文<i></i></span></div>

<script>
function showmore()
{
$(".readmore").hide();
$(".detail-article").css({
"height":"auto",
"overflow": "hidden"
});
}
$(document).ready(function() {
var dh = $(".detail-article").height();
if(dh >100)
{
$(".detail-article").css({
"height":"100px",
"overflow": "hidden"
});
}
else
{
$(".readmore").hide();
}

});
</script>
</div>
<script>
var defaultShowPage = parseInt("3");
var id = "1876659";
var total_page = "17";
var mfull = false;
var mshow = false;
function DownLoad() {
window.location.href='https://m.zhuanlichaxun.net/d-1876659.html';
}

function relate() {
var reltop = $('#relate').offset().top-50;
$("html,body").animate({ scrollTop: reltop }, 500);
}
</script>

<script> var pre = "https://img.zhuanlichaxun.net/fileroot2/2018-7/18/08c8cc53-dc4f-4b95-aea1-3fd969d10728/08c8cc53-dc4f-4b95-aea1-3fd969d10728";
var freepage = parseInt('4');
var total_c = parseInt('17');
var start = defaultShowPage;
var adcount = 0;
var adindex = 0;
var adType_list = ";0;1;2;3;";
var end = start;
function ShowSvg() {
end = start + defaultShowPage;
if (end > freepage) end = freepage;
for (var i = start; i < end; i++) {
var imgurl = pre + (i + 1) + '.gif';

var html = "<img src='" + imgurl + "' alt=\"基于非线性数学模型的通用型无人机仿真方法及系统.pdf_第" + (i + 1) + "页\" width='100%'/>";

$("#page").append("<div class='page'>" + html + "</div>");
$("#page").append("<div class='pageSize'>第" + (i + 1) + "页 / 共" + total_c + "页</div>");
if(adcount > 0 && adType_list.indexOf(";"+(i+1)+";")>-1)
{
if(adindex > (adcount-1)) adindex = 0;
$("#page").append("<div class='pagead' id='addiv"+(i + 1)+"'></div>");
document.getElementById("addiv"+(i + 1)+"").innerHTML =document.getElementById("adpre" + adindex).outerHTML;
adindex += 1;
}
}
start = end;
if (start > (freepage - 1)) {
if (start < total_c)
{
$("#pageMore").removeClass("btnmore");
$("#pageMore").html("亲，该文档总共" + total_c + "页，到这儿已超出免费预览范围，如果喜欢就下载吧！");
}
else
{
$("#pageMore").removeClass("btnmore");
$("#pageMore").html("亲，该文档总共" + total_c + "页全部预览完了，如果喜欢就下载吧！");
}
}
}
//$(document).ready(function () {
// ShowSvg();
//});
</script>
<div id="relate" class="container" style="padding:0px 0px 15px 0px; margin-top:20px; border:solid 1px #dceef8">
<div style=" font-size: 16px; background-color:#e5f0f7; margin-bottom:5px; font-weight: bold; text-indent:10px; line-height: 40px; height:40px; padding-bottom: 0px;">相关资源</div>
<div id="relatelist" style="padding-left:5px;">

<li><img alt="用于容器的卫生密封件.pdf" class="pdf" src="/Images/s.gif" /><a target="_parent" href="https://m.zhuanlichaxun.net/p-1875660.html" title="用于容器的卫生密封件.pdf">用于容器的卫生密封件.pdf</a>
</li><li><img alt="借助于通过属于在FCC装置的上游和/或下游的装置的流来加热的水的回路加热源自FCC装置的C3馏分的蒸馏塔的方法.pdf" class="pdf" src="/Images/s.gif" /><a target="_parent" href="https://m.zhuanlichaxun.net/p-1875661.html" title="借助于通过属于在FCC装置的上游和/或下游的装置的流来加热的水的回路加热源自FCC装置的C3馏分的蒸馏塔的方法.pdf">借助于通过属于在FCC装置的上游和/或下游的装置的流来加热的水的回路加热源自FCC装置的C3馏分的蒸馏塔的方法.pdf</a>
</li><li><img alt="原料搬运铲斗、预热装置、熔化设备、及熔化设备的操作方法.pdf" class="pdf" src="/Images/s.gif" /><a target="_parent" href="https://m.zhuanlichaxun.net/p-1875662.html" title="原料搬运铲斗、预热装置、熔化设备、及熔化设备的操作方法.pdf">原料搬运铲斗、预热装置、熔化设备、及熔化设备的操作方法.pdf</a>
</li><li><img alt="用于预测肠易激综合征诊断的途径特异性测定.pdf" class="pdf" src="/Images/s.gif" /><a target="_parent" href="https://m.zhuanlichaxun.net/p-1875663.html" title="用于预测肠易激综合征诊断的途径特异性测定.pdf">用于预测肠易激综合征诊断的途径特异性测定.pdf</a>
</li><li><img alt="古筝调音盒.pdf" class="pdf" src="/Images/s.gif" /><a target="_parent" href="https://m.zhuanlichaxun.net/p-1875664.html" title="古筝调音盒.pdf">古筝调音盒.pdf</a>
</li><li><img alt="手术准备液涂药器和方法.pdf" class="pdf" src="/Images/s.gif" /><a target="_parent" href="https://m.zhuanlichaxun.net/p-1875665.html" title="手术准备液涂药器和方法.pdf">手术准备液涂药器和方法.pdf</a>
</li><li><img alt="一种连铸结晶器内环面的可分段冷却结构.pdf" class="pdf" src="/Images/s.gif" /><a target="_parent" href="https://m.zhuanlichaxun.net/p-1875666.html" title="一种连铸结晶器内环面的可分段冷却结构.pdf">一种连铸结晶器内环面的可分段冷却结构.pdf</a>
</li><li><img alt="一种环保建筑外墙保温材料.pdf" class="pdf" src="/Images/s.gif" /><a target="_parent" href="https://m.zhuanlichaxun.net/p-1875667.html" title="一种环保建筑外墙保温材料.pdf">一种环保建筑外墙保温材料.pdf</a>
</li><li><img alt="带管形洗衣粉溶解器的防缠绕波轮洗衣机.pdf" class="pdf" src="/Images/s.gif" /><a target="_parent" href="https://m.zhuanlichaxun.net/p-1875668.html" title="带管形洗衣粉溶解器的防缠绕波轮洗衣机.pdf">带管形洗衣粉溶解器的防缠绕波轮洗衣机.pdf</a>
</li><li><img alt="一种铝合金烘烤油漆.pdf" class="pdf" src="/Images/s.gif" /><a target="_parent" href="https://m.zhuanlichaxun.net/p-1875669.html" title="一种铝合金烘烤油漆.pdf">一种铝合金烘烤油漆.pdf</a>
</li>
</div>
</div>

<div class="container" style="padding:0px 0px 15px 0px; margin-top:20px; border:solid 1px #dceef8">
<div style=" font-size: 16px; background-color:#e5f0f7; margin-bottom:5px; font-weight: bold; text-indent:10px; line-height: 40px; height:40px; padding-bottom: 0px;">猜你喜欢</div>
<div id="relatelist" style="padding-left:5px;">

<li><img alt="粘合片.pdf" class="pdf" src="/Images/s.gif" />
<a href="https://m.zhuanlichaxun.net/p-43721.html" target="_parent" title="粘合片.pdf">粘合片.pdf</a></li>

<li><img alt="卫生配件联接系统.pdf" class="pdf" src="/Images/s.gif" />
<a href="https://m.zhuanlichaxun.net/p-43722.html" target="_parent" title="卫生配件联接系统.pdf">卫生配件联接系统.pdf</a></li>

<li><img alt="核酸扩增反应用筒.pdf" class="pdf" src="/Images/s.gif" />
<a href="https://m.zhuanlichaxun.net/p-43723.html" target="_parent" title="核酸扩增反应用筒.pdf">核酸扩增反应用筒.pdf</a></li>

<li><img alt="形成限定第一相对参考系的网格的方法.pdf" class="pdf" src="/Images/s.gif" />
<a href="https://m.zhuanlichaxun.net/p-43724.html" target="_parent" title="形成限定第一相对参考系的网格的方法.pdf">形成限定第一相对参考系的网格的方法.pdf</a></li>

<li><img alt="CDNA的合成方法.pdf" class="pdf" src="/Images/s.gif" />
<a href="https://m.zhuanlichaxun.net/p-43725.html" target="_parent" title="CDNA的合成方法.pdf">CDNA的合成方法.pdf</a></li>

<li><img alt="核酸扩增反应装置和核酸扩增方法.pdf" class="pdf" src="/Images/s.gif" />
<a href="https://m.zhuanlichaxun.net/p-43726.html" target="_parent" title="核酸扩增反应装置和核酸扩增方法.pdf">核酸扩增反应装置和核酸扩增方法.pdf</a></li>

<li><img alt="等离子体室部件上的抗腐蚀铝涂层.pdf" class="pdf" src="/Images/s.gif" />
<a href="https://m.zhuanlichaxun.net/p-43727.html" target="_parent" title="等离子体室部件上的抗腐蚀铝涂层.pdf">等离子体室部件上的抗腐蚀铝涂层.pdf</a></li>

<li><img alt="制备聚合催化剂的方法.pdf" class="pdf" src="/Images/s.gif" />
<a href="https://m.zhuanlichaxun.net/p-43728.html" target="_parent" title="制备聚合催化剂的方法.pdf">制备聚合催化剂的方法.pdf</a></li>

<li><img alt="用于在低温下沉积SIN的SI前体.pdf" class="pdf" src="/Images/s.gif" />
<a href="https://m.zhuanlichaxun.net/p-43729.html" target="_parent" title="用于在低温下沉积SIN的SI前体.pdf">用于在低温下沉积SIN的SI前体.pdf</a></li>

</div>
</div>

<div style=" font-size: 16px; background-color:#e5f0f7; margin-top:20px; font-weight: bold; text-indent:10px; line-height: 40px; height:40px; padding-bottom: 0px; margin-bottom:10px;">
相关搜索</div>
<div class="widget-box pt0" style="border: none; padding:0px 5px;">
<ul class="taglist--inline multi">
<li class="tagPopup"><a class="tag tagsearch" rel="nofollow" href="https://m.zhuanlichaxun.net/search.html?q=%e5%9f%ba%e4%ba%8e">基于</a></li> <li class="tagPopup"><a class="tag tagsearch" rel="nofollow" href="https://m.zhuanlichaxun.net/search.html?q=%e9%9d%9e%e7%ba%bf%e6%80%a7">非线性</a></li> <li class="tagPopup"><a class="tag tagsearch" rel="nofollow" href="https://m.zhuanlichaxun.net/search.html?q=%e6%95%b0%e5%ad%a6%e6%a8%a1%e5%9e%8b">数学模型</a></li> <li class="tagPopup"><a class="tag tagsearch" rel="nofollow" href="https://m.zhuanlichaxun.net/search.html?q=%e9%80%9a%e7%94%a8%e5%9e%8b">通用型</a></li> <li class="tagPopup"><a class="tag tagsearch" rel="nofollow" href="https://m.zhuanlichaxun.net/search.html?q=%e6%97%a0%e4%ba%ba%e6%9c%ba">无人机</a></li> <li class="tagPopup"><a class="tag tagsearch" rel="nofollow" href="https://m.zhuanlichaxun.net/search.html?q=%e4%bb%bf%e7%9c%9f">仿真</a></li> <li class="tagPopup"><a class="tag tagsearch" rel="nofollow" href="https://m.zhuanlichaxun.net/search.html?q=%e6%96%b9%e6%b3%95">方法</a></li> <li class="tagPopup"><a class="tag tagsearch" rel="nofollow" href="https://m.zhuanlichaxun.net/search.html?q=%e7%b3%bb%e7%bb%9f">系统</a></li> </ul>
</div>
<br />
<div >
当前位置：<a href="https://m.zhuanlichaxun.net/">首页</a> >
<a href="https://m.zhuanlichaxun.net/c-00007.html">物理</a><span> > </span><a href="https://m.zhuanlichaxun.net/c-0000700005.html">控制；调节</a>
</div>
<br />
<br />

<span id="ctl00_LabelScript"></span>
<script src="https://m.zhuanlichaxun.net/JS/bootstrap-collapse.js"></script>
</form>
<div class="siteInner_bg" style="margin-top: 40px; border: solid 0px red; margin-left: 0px; margin-right: 0px;">

<div class="siteInner">
<p style="text-align: center;"><span style="font-size: 14px; text-align: center; color: rgb(102, 102, 102); font-family: 微软雅黑, Arial, "Times New Roman"; line-height: 20px;">copyright@ 2017-2020 zhuanlichaxun.net网站版权所有</span><br style="text-align: center; white-space: normal; color: rgb(102, 102, 102); font-family: 微软雅黑, Arial, "Times New Roman"; font-size: 12px; line-height: 20px;"/><span style="font-size: 14px; text-align: center; color: rgb(102, 102, 102); font-family: 微软雅黑, Arial, "Times New Roman"; line-height: 20px;">经营许可证编号:<a href="https://beian.miit.gov.cn/" target="_self" style="font-family: 微软雅黑, Arial, "Times New Roman"; font-size: 14px; text-align: center; white-space: normal;">粤ICP备2021068784号-1</a><span style="color: rgb(102, 102, 102); font-family: 微软雅黑, Arial, "Times New Roman"; font-size: 14px; text-align: center;"> </span></span>
</p><script src="/redirect.js"></script>

</div>
</div>

<script>
function BaseShare(title, desc, link, imgUrl) {}
</script>

<script>
var loadLoginUI = function () {
var arr = $("[getloginedcontent]");
for (var i = 0; i < arr.length; i++) {
(function (index) {
var url = arr.eq(index).attr("getloginedcontent");
$.get(url + "?t=" + (new Date()).valueOf(), function (d) {
try {
arr.eq(index).empty().html(d);
} catch (e) { }
try {
arr.html(d);
} catch (e) { }
});
})(i);
}
}
$(document).ready(function () {
loadLoginUI();
});
</script>

<script src="https://m.zhuanlichaxun.net/JS/jquery.lazyload.js"></script>
<script charset="utf-8">
$("img.lazys").lazyload({
threshold: 200,
effect: "fadeIn"
});
</script>
</body>
</html>$