CN103837151A - 一种四旋翼飞行器的气动模型辅助导航方法 - Google Patents
一种四旋翼飞行器的气动模型辅助导航方法 Download PDFInfo
- Publication number
- CN103837151A CN103837151A CN201410079513.6A CN201410079513A CN103837151A CN 103837151 A CN103837151 A CN 103837151A CN 201410079513 A CN201410079513 A CN 201410079513A CN 103837151 A CN103837151 A CN 103837151A
- Authority
- CN
- China
- Prior art keywords
- moment
- quadrotor
- calculate
- speed
- axis
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Granted
Links
Images
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/20—Instruments for performing navigational calculations
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Automation & Control Theory (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Navigation (AREA)
Abstract
本发明公开了一种四旋翼飞行器的气动模型辅助导航方法,属于组合导航与自主导航领域。本发明利用四旋翼飞行器的气动模型,与其机载传感器相结合,对其速度、位置信息进行估计。在本发明中,采用的气动模型参数包括旋翼半径、空气密度、旋翼实度、升力斜率、阻力系数、旋翼安装角,采用的机载传感器信息包括旋翼转速、加速度、角速度、姿态、高度。该方法无需增加任何外部设备,可以提高四旋翼飞行器在无GNSS(卫星导航系统)飞行时的速度、位置估计精度,具有成本低、零载重、自主性强等特点。
Description
技术领域
本发明属于组合导航与自主导航领域,具体涉及一种四旋翼飞行器的气动模型辅助导航方法。
背景技术
四旋翼飞行器具有体积小、结构简单、可悬停和垂直起降等优点,特别适合在近地面环境(如室内、城区和丛林等)中执行监视、侦察等任务,具有广阔的军事和民用前景。导航系统为四旋翼飞行器提供其飞行控制系统所必须的导航信息,是其完成各种复杂飞行任务的必要保障。
受四旋翼飞行器体积、载重、成本所限,其通常选用低成本、小型化的低精度机载导航传感器。目前四旋翼飞行器常用的导航方案包含惯性传感器、卫星导航系统、磁传感器以及气压高度计:其中惯性传感器与磁传感器组成航姿系统,可提供姿态信息;惯性传感器与卫星导航系统进行信息融合,可提供速度与位置信息;气压高度计用以修正高度信息。
由于卫星导航需要接收外界无线电信号,在一些特殊情况下会受到人为或自然干扰(例如室内飞行时),此时其速度、位置信息仅由惯性传感器解算得到。当四旋翼飞行器的卫星导航系统不可用时,惯性传感器在解算速度、位置信息时采用推算算法,且四旋翼飞行器采用的惯性传感器精度通常较低,致使其误差随时间快速发散,难以保证其定位需求。
发明内容
本发明所要解决的技术问题是:提供一种四旋翼飞行器的气动模型辅助导航方法,通过采用气动模型参数作为辅助参数,与其机载传感器相结合,计算四旋翼飞行器机体系下的速度,进一步计算导航系下的速度,提高了计算精度,解决了四旋翼飞行器在卫星导航系统不可用时的自主测速、定位不精确的问题。
本发明为解决上述技术问题采用以下技术方案:
一种四旋翼飞行器的气动模型辅助导航方法,包括如下步骤:
步骤二:按照如下公式计算k时刻四旋翼飞行器机体系下的速度Vb k:
其中,分别为k时刻四旋翼飞行器速度在机体系下的X轴分量及Y轴分量;按照如下公式计算: 其中Fbxk、Fbyk为k时刻机体系下四旋翼飞行器的水平方向气动力矢量Fb k在X、Y轴的分量,ka2vk为k时刻四旋翼飞行器的第一气动参数;Fb k按照如下公式计算:
其中m为四旋翼飞行器质量,fb k为k时刻三轴加速度的矢量表示,为四旋翼飞行器k时刻导航系到机体系的坐标转换矩阵,为k时刻地球自转角速度矢量在导航系下的投影,为k时刻导航系相对于地球系的角速度矢量在导航系下的投影,Vn k-1为四旋翼飞行器k-1时刻导航系下的速度;
ka2vk按照如下公式计算:
其中,v1k为四旋翼飞行器k时刻的诱导速度,C1为第二气动参数,C2为第三气动参数,ω1k、ω2k、ω3k、ω4k分别为四个旋翼的转速,A为旋翼旋转面积,R为旋翼的半径;C1、C2分别按下式计算:
步骤四:计算k时刻四旋翼飞行器的经度λk、纬度Lk,Lk-1为k-1时刻纬度,为Vn k的Y轴分量,ΔT为采样时间,Re为地球半径,hbk为四旋翼飞行器的高度;λk-1为k-1时刻经度,为Vn k的X轴分量。
(a)计算k时刻卡尔曼滤波器一步预测均方误差Pk|k-1
其中,Pk-1为k-1时刻的状态估计均方差,Fk,k-1为滤波器k-1时刻到k时刻的滤波器一步转移矩阵,按照下式计算:
(b)计算k时刻卡尔曼滤波器滤波增益Kk
(c)计算k时刻卡尔曼滤波器估计均方误差Pk|k
Pk|k=(I-KkHk)Pk|k-1,其中I为单位矩阵;
与现有技术相比,本发明具有以下有益效果:
1、本发明利用四旋翼飞行器的气动模型,结合四旋翼飞行器机载传感器,根据四旋翼飞行器气动模型与导航参数的关系,对其速度、位置进行估计,可有效提高四旋翼飞行器在无GNSS环境下飞行时的测速、定位精度。
2、该方法无需增加任何外部设备,具有成本低、零载重、自主性强等优点,是一种较好的四旋翼飞行器自主导航方法。
附图说明
图1为本发明方法的流程示意图。
图2为采用本发明方法后四旋翼飞行器悬停状态下的定位误差。
图3为采用本发明方法后四旋翼飞行器悬停状态下的东向速度误差。
图4为采用本发明方法后四旋翼飞行器悬停状态下的北向速度误差。
图5为四旋翼飞行器飞行航迹以及采用本发明方法后的定位结果。
图6为采用本发明方法后四旋翼飞行器在航迹飞行状态下的定位误差。
图7为采用本发明方法后四旋翼飞行器在航迹飞行状态下的东向、北向速度误差。
具体实施方式
本发明方法的流程如图1所示,其具体步骤如下:
步骤一:读取机载传感器数据,以周期ΔT读取k时刻四旋翼飞行器航姿系统输出数据,包括横滚角φk、俯仰角θk、航向角ψk,三轴加速度计的输出三轴陀螺仪的输出气压高度计的输出hbk,四个旋翼的转速分别为ω1k、ω2k、ω3k、ω4k;
(a)由三轴加速度计的输出推算四旋翼飞行器的天向速度与高度
以ab k表示k时刻四旋翼飞行器机体系下的加速度,根据加速度计敏感到的比力的物理量概念,推算得 其中为步骤一中采集得到的k时刻三轴加速度计输出的矢量形式;为四旋翼飞行器k时刻导航系到机体系的坐标转换矩阵;Vb k-1为机体系下k-1时刻的速度;为k时刻地球自转角速度矢量在导航系下的投影;为k时刻导航系相对于地球系的角速度矢量在导航系下的投影;Vn k-1为导航系下k-1时刻的速度;为k时刻机体系相对于导航系的角速度矢量在机体系下的投影;为k时刻导航系下的地球重力加速度矢量,其值为gn k=[00-g],g为地球重力加速度;
(b)计算k时刻卡尔曼滤波器一步预测均方误差Pk|k-1
(c)计算k时刻卡尔曼滤波器滤波增益Kk
(d)计算k时刻卡尔曼滤波器估计均方误差Pk|k
Pk|k=(I-KkHk)Pk|k-1,其中I为单位矩阵;
令其中δhk为四旋翼飞行器高度误差,Xk|k=KkZk;其中Zk为k时刻的量测向量,其值为Zk=hdk-hbk,其中hdk为k时刻一步预测的高度,按照下式计算:
步骤三:计算k时刻四旋翼飞行器机体系下的速度Vb k,具体步骤如下:
(a)计算k时刻机体系下四旋翼飞行器的水平方向气动力矢量方程Fb k
(b)计算k时刻第一气动参数ka2vk
计算四旋翼悬停时每个旋翼提供的升力FH,其值为FH=mg/4,其中g为地球重力加速度;计算k时刻的水平空速V0k, 为k时刻机体系下四旋翼飞行器的X轴速度,可用替代,为k时刻机体系下四旋翼飞行器的Y轴速度,可用替代;计算旋翼旋转面积A,其值为A=πR2,其中R为旋翼的半径;计算k时刻的诱导速度v1k,其值为 其中ρ为空气密度;计算第二气动参数C1,其值为C1=ρσaθs,其中σ为旋翼实度,a为升力斜率,θs为旋翼安装角;计算第三气动参数C2,其值为其中为阻力系数;计算ka2vk,其值为 其中由步骤二得到,ω1k、ω2k、ω3k、ω4k由步骤一得到;
实施例:
采用仿真的形式,对使用本发明方法后的四旋翼飞行器定位精度进行验证。其中机载传感器精度设置如下:陀螺零偏稳定性为10deg/h,deg/h为度/小时,加速度计零偏稳定性为10-4g,航姿系统的姿态精度为1deg,气压高度计误差为1m。四旋翼飞行器气动模型参数误差设为5%。
令四旋翼飞行器悬停5分钟。图2为四旋翼飞行器在悬停状态下5分钟内采用本发明方法后的定位误差,可以看出定位精度在0.1m以内。采用现有方法(即纯惯性导航方法),其定位误差在100m以上,本方法精度提高了3个数量级以上。
图3、图4分别为四旋翼飞行器在悬停状态下5分钟内东向、北向速度误差,速度误差整体在0.001m/s以内。速度误差在1~10s时较大,是由于四旋翼飞行器在该时段未达到悬停稳定状态,存在一定机动。采用现有方法,东向、北向速度误差在1m/s以上,本方法精度提高了3个数量级以上。
令四旋翼飞行器按照某航迹飞行。图5为四旋翼飞行器飞行航迹以及采用采用本发明方法后的定位结果。
图6为在图5航迹中本方法的定位误差,可以看出定位精度在0.2m以内。采用现有方法,其定位误差在500m以上,本方法精度提高了3个数量级以上。
图7为在图5航迹中本方法的速度误差,可以看出速度误差在0.05m/s以内。采用现有方法,东向、北向速度误差在5m/s以上,本方法精度提高了2个数量级以上。
Claims (4)
1.一种四旋翼飞行器的气动模型辅助导航方法,其特征在于,包括如下步骤:
步骤二:按照如下公式计算k时刻四旋翼飞行器机体系下的速度Vb k:
其中,分别为k时刻四旋翼飞行器速度在机体系下的X轴分量及Y轴分量;按照如下公式计算:,其中Fbxk、Fbyk为k时刻机体系下四旋翼飞行器的水平方向气动力矢量Fb k在X、Y轴的分量,ka2vk为k时刻四旋翼飞行器的第一气动参数;Fb k按照如下公式计算:
,其中m为四旋翼飞行器质量,fb k为k时刻三轴加速度的矢量表示,为四旋翼飞行器k时刻导航系到机体系的坐标转换矩阵,为k时刻地球自转角速度矢量在导航系下的投影,为k时刻导航系相对于地球系的角速度矢量在导航系下的投影,Vn k-1为四旋翼飞行器k-1时刻导航系下的速度;
ka2vk按照如下公式计算:
其中,v1k为四旋翼飞行器k时刻的诱导速度,C1为第二气动参数,C2为第三气动参数,ω1k、ω2k、ω3k、ω4k分别为四个旋翼的转速,A为旋翼旋转面积,R为旋翼的半径;C1、C2分别按下式计算:
3.根据权利要求1所述的四旋翼飞行器的气动模型辅助导航方法,其特征在于,计算卡尔曼滤波器对的在线补偿参数采用如下方法:
(a)计算k时刻卡尔曼滤波器一步预测均方误差Pk|k-1
其中,Pk-1为k-1时刻的状态估计均方差,Fk,k-1为滤波器k-1时刻到k时刻的滤波器一步转移矩阵,按照下式计算:
(b)计算k时刻卡尔曼滤波器滤波增益Kk
(c)计算k时刻卡尔曼滤波器估计均方误差Pk|k
Pk|k=(I-KkHk)Pk|k-1,其中I为单位矩阵;
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201410079513.6A CN103837151B (zh) | 2014-03-05 | 2014-03-05 | 一种四旋翼飞行器的气动模型辅助导航方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201410079513.6A CN103837151B (zh) | 2014-03-05 | 2014-03-05 | 一种四旋翼飞行器的气动模型辅助导航方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN103837151A true CN103837151A (zh) | 2014-06-04 |
CN103837151B CN103837151B (zh) | 2016-08-24 |
Family
ID=50800879
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201410079513.6A Active CN103837151B (zh) | 2014-03-05 | 2014-03-05 | 一种四旋翼飞行器的气动模型辅助导航方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN103837151B (zh) |
Cited By (12)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104792336A (zh) * | 2015-03-31 | 2015-07-22 | 北京航空航天大学 | 一种飞行状态测量方法及装置 |
CN104808673A (zh) * | 2015-02-12 | 2015-07-29 | 武汉顶翔智控科技有限公司 | 一种基于卡尔曼滤波的四旋翼飞行器高度估计方法 |
CN106871892A (zh) * | 2017-02-17 | 2017-06-20 | 张梦 | 一种航空器组合导航方法和装置 |
CN106885573A (zh) * | 2017-02-15 | 2017-06-23 | 南京航空航天大学 | 面向四旋翼飞行器的运动捕捉系统实时测姿方法 |
CN107063248A (zh) * | 2017-02-10 | 2017-08-18 | 南京航空航天大学 | 基于旋翼转速的动力学模型辅助惯导的导航方法 |
CN107101636A (zh) * | 2017-05-23 | 2017-08-29 | 南京航空航天大学 | 一种使用卡尔曼滤波器辨识多旋翼动力学模型参数的方法 |
CN107110975A (zh) * | 2014-12-11 | 2017-08-29 | 空客直升机 | 用于旋翼飞行器的驾驶传感器的冗余设备 |
CN108168509A (zh) * | 2017-12-06 | 2018-06-15 | 南京航空航天大学 | 一种升力模型辅助的四旋翼飞行器高度容错估计方法 |
CN108536163A (zh) * | 2018-03-15 | 2018-09-14 | 南京航空航天大学 | 一种单面结构环境下的动力学模型/激光雷达组合导航方法 |
CN108592911A (zh) * | 2018-03-23 | 2018-09-28 | 南京航空航天大学 | 一种四旋翼飞行器动力学模型/机载传感器组合导航方法 |
CN111006659A (zh) * | 2019-12-06 | 2020-04-14 | 江西洪都航空工业集团有限责任公司 | 一种具备多导航源信息融合功能的导航系统 |
CN112462794A (zh) * | 2020-11-09 | 2021-03-09 | 航天科工火箭技术有限公司 | 一种演示验证火箭悬停制导方法及系统 |
Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20040250616A1 (en) * | 1999-01-18 | 2004-12-16 | Peter Adebjork | Redundant system for the indication of heading and attitude in an aircraft |
CN102073755A (zh) * | 2010-11-10 | 2011-05-25 | 南京航空航天大学 | 近空间高超声速飞行器运动控制仿真方法 |
CN102809377A (zh) * | 2012-08-15 | 2012-12-05 | 南京航空航天大学 | 飞行器惯性/气动模型组合导航方法 |
-
2014
- 2014-03-05 CN CN201410079513.6A patent/CN103837151B/zh active Active
Patent Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20040250616A1 (en) * | 1999-01-18 | 2004-12-16 | Peter Adebjork | Redundant system for the indication of heading and attitude in an aircraft |
CN102073755A (zh) * | 2010-11-10 | 2011-05-25 | 南京航空航天大学 | 近空间高超声速飞行器运动控制仿真方法 |
CN102809377A (zh) * | 2012-08-15 | 2012-12-05 | 南京航空航天大学 | 飞行器惯性/气动模型组合导航方法 |
Non-Patent Citations (4)
Title |
---|
BUCHHOLZ T T: "Construction of a Four Rotor Helicopter Control System", 《TECHNICAL UNIVERSITY OF DENMARK KGS LYNGBY DENMARK》, 31 December 2009 (2009-12-31), pages 1 - 153 * |
LIU JIANYE等: "Inner Attitude Integration Algorithm Based on Fault Detection for Strapdown Inertial Attitude and Heading Reference System", 《CHINESE JOURNAL OF AERONAUTICS》, vol. 23, no. 1, 31 December 2010 (2010-12-31), pages 68 - 74 * |
刘建业等: "微小型四旋翼飞行器多信息非线性融合导航方法及实现", 《南京航空航天大学学报》, vol. 45, no. 5, 31 October 2013 (2013-10-31), pages 575 - 582 * |
韩志凤: "小型四旋翼飞行器动力学模型优化", 《控制工程 CONTROL ENGINEERING OF CHINA》, vol. 20, 31 May 2013 (2013-05-31), pages 158 - 162 * |
Cited By (17)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107110975A (zh) * | 2014-12-11 | 2017-08-29 | 空客直升机 | 用于旋翼飞行器的驾驶传感器的冗余设备 |
US10935672B2 (en) | 2014-12-11 | 2021-03-02 | Airbus Helicopters | Redundant device of piloting sensors for a rotary-wing aircraft |
CN104808673A (zh) * | 2015-02-12 | 2015-07-29 | 武汉顶翔智控科技有限公司 | 一种基于卡尔曼滤波的四旋翼飞行器高度估计方法 |
CN104808673B (zh) * | 2015-02-12 | 2017-12-22 | 武汉顶翔智控科技有限公司 | 一种基于卡尔曼滤波的四旋翼飞行器高度估计方法 |
CN104792336A (zh) * | 2015-03-31 | 2015-07-22 | 北京航空航天大学 | 一种飞行状态测量方法及装置 |
CN107063248A (zh) * | 2017-02-10 | 2017-08-18 | 南京航空航天大学 | 基于旋翼转速的动力学模型辅助惯导的导航方法 |
CN106885573A (zh) * | 2017-02-15 | 2017-06-23 | 南京航空航天大学 | 面向四旋翼飞行器的运动捕捉系统实时测姿方法 |
CN106871892A (zh) * | 2017-02-17 | 2017-06-20 | 张梦 | 一种航空器组合导航方法和装置 |
CN107101636B (zh) * | 2017-05-23 | 2019-07-19 | 南京航空航天大学 | 一种使用卡尔曼滤波器辨识多旋翼动力学模型参数的方法 |
CN107101636A (zh) * | 2017-05-23 | 2017-08-29 | 南京航空航天大学 | 一种使用卡尔曼滤波器辨识多旋翼动力学模型参数的方法 |
CN108168509A (zh) * | 2017-12-06 | 2018-06-15 | 南京航空航天大学 | 一种升力模型辅助的四旋翼飞行器高度容错估计方法 |
CN108536163A (zh) * | 2018-03-15 | 2018-09-14 | 南京航空航天大学 | 一种单面结构环境下的动力学模型/激光雷达组合导航方法 |
CN108592911A (zh) * | 2018-03-23 | 2018-09-28 | 南京航空航天大学 | 一种四旋翼飞行器动力学模型/机载传感器组合导航方法 |
CN108592911B (zh) * | 2018-03-23 | 2021-09-17 | 南京航空航天大学 | 一种四旋翼飞行器动力学模型/机载传感器组合导航方法 |
CN111006659A (zh) * | 2019-12-06 | 2020-04-14 | 江西洪都航空工业集团有限责任公司 | 一种具备多导航源信息融合功能的导航系统 |
CN112462794A (zh) * | 2020-11-09 | 2021-03-09 | 航天科工火箭技术有限公司 | 一种演示验证火箭悬停制导方法及系统 |
CN112462794B (zh) * | 2020-11-09 | 2024-03-26 | 航天科工火箭技术有限公司 | 一种演示验证火箭悬停制导方法及系统 |
Also Published As
Publication number | Publication date |
---|---|
CN103837151B (zh) | 2016-08-24 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN103837151B (zh) | 一种四旋翼飞行器的气动模型辅助导航方法 | |
Cho et al. | Wind estimation and airspeed calibration using a UAV with a single-antenna GPS receiver and pitot tube | |
CN102809377B (zh) | 飞行器惯性/气动模型组合导航方法 | |
Bryson et al. | Vehicle model aided inertial navigation for a UAV using low-cost sensors | |
CN103363992B (zh) | 基于梯度下降的四旋翼无人机姿态航向参考系统解算方法 | |
CN106643737A (zh) | 风力干扰环境下四旋翼飞行器姿态解算方法 | |
CN106871928A (zh) | 基于李群滤波的捷联惯性导航初始对准方法 | |
CN105929836B (zh) | 用于四旋翼飞行器的控制方法 | |
CN103245360A (zh) | 晃动基座下的舰载机旋转式捷联惯导系统自对准方法 | |
CN105021183A (zh) | 多旋翼飞行器gps和ins低成本组合导航系统 | |
CN202939489U (zh) | 一种多旋翼自动平衡飞行控制器 | |
CN101963512A (zh) | 船用旋转式光纤陀螺捷联惯导系统初始对准方法 | |
CN108592911B (zh) | 一种四旋翼飞行器动力学模型/机载传感器组合导航方法 | |
Hollenbeck et al. | Wind measurement and estimation with small unmanned aerial systems (suas) using on-board mini ultrasonic anemometers | |
CN107101636B (zh) | 一种使用卡尔曼滤波器辨识多旋翼动力学模型参数的方法 | |
CN104374388A (zh) | 一种基于偏振光传感器的航姿测定方法 | |
CN105928515A (zh) | 一种无人机导航系统 | |
CN201004180Y (zh) | 无人机姿态控制系统 | |
CN107063248A (zh) | 基于旋翼转速的动力学模型辅助惯导的导航方法 | |
CN116992700B (zh) | 一种物流无人机导航精度确定的方法及设备 | |
Madany et al. | Modelling and simulation of robust navigation for unmanned air systems (UASs) based on integration of multiple sensors fusion architecture | |
Hua | Contributions to the automatic control of aerial vehicles | |
Crocoll et al. | Quadrotor inertial navigation aided by a vehicle dynamics model with in-flight parameter estimation | |
Nakanishi et al. | Measurement model of barometer in ground effect of unmanned helicopter and its application to estimate terrain clearance | |
Ng et al. | Flight Systems and Control |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
C14 | Grant of patent or utility model | ||
GR01 | Patent grant |