CN107656533A - 一种基于双天线测向的空投货台调姿控制方法 - Google Patents

一种基于双天线测向的空投货台调姿控制方法 Download PDF

Info

Publication number
CN107656533A
CN107656533A CN201711129160.6A CN201711129160A CN107656533A CN 107656533 A CN107656533 A CN 107656533A CN 201711129160 A CN201711129160 A CN 201711129160A CN 107656533 A CN107656533 A CN 107656533A
Authority
CN
China
Prior art keywords
load bed
posture adjustment
air
angle
drop
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.)
Pending
Application number
CN201711129160.6A
Other languages
English (en)
Inventor
陈潇
刘琦
张芃
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
AVIC Aerospace Life Support Industries Ltd
Original Assignee
AVIC Aerospace Life Support Industries Ltd
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by AVIC Aerospace Life Support Industries Ltd filed Critical AVIC Aerospace Life Support Industries Ltd
Priority to CN201711129160.6A priority Critical patent/CN107656533A/zh
Publication of CN107656533A publication Critical patent/CN107656533A/zh
Pending legal-status Critical Current

Links

Classifications

    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/08Control of attitude, i.e. control of roll, pitch, or yaw

Landscapes

  • Engineering & Computer Science (AREA)
  • Aviation & Aerospace Engineering (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Variable-Direction Aerials And Aerial Arrays (AREA)

Abstract

本发明公开了一种基于双天线测向的空投货台调姿控制方法,包括以下步骤:1)空投货台投放后,实时测量货台的下降轨迹;2)实时计算货台的航向姿态角;3)实时计算空投货台距地高度,当空投货台到达距地设定高度后,判断货台的航向姿态角与货台的运动方向角的差值;根据由重装空投系统自身的运动特性所确定的控制率,开启某组调姿动力装置进行驱动,然后开启另一组调姿动力装置进行制动,直到货台或装备的姿态角调整至安全范围内。本发明提出的基于双天线测向的空投货台调姿控制方法,可实现对货台或装备的主动式定向防翻功能,适应多种空投装备和货台的防翻需求。

Description

一种基于双天线测向的空投货台调姿控制方法
技术领域
本发明涉及重装空投控制技术,尤其涉及一种基于双天线测向的空投货台调姿控制方法。
背景技术
空投系统受体积重量、空投高度、空投场地地形、装备重心变化、风场变化等条件的影响,具有着陆姿态不确定、对货台控制能力不足等特点,容易发生侧翻。而现有的防翻装置调姿能力与环境复杂度不匹配,技术不成熟(定向防翻受水平风速条件限制,无货台空投系统安装防翻架或防翻板结构受限)。
现有技术中:已应用的防翻稳定技术基本属于被动式防翻稳定技术,包含防翻支架稳定技术和定向防翻稳定技术。其中防翻支架稳定技术采用防翻支架结构安装固定在货台上面,着陆时加宽货台侧面的宽度,防止货台发生侧翻。定向防翻稳定技术采用地锚抓地后,连接绳受力并拉动战车转动到顺风向着陆,避免迎风侧向着陆。
防翻支架(或防翻板)在空投系统离机空投后按照工作程序展开。防翻支架(或防翻板)加大系统的自身重量,增加伞绳钩挂的风险,且防翻支架(或防翻板)在机舱内一旦提前意外展开会造成严重的飞行事故,所以对防翻支架(或防翻板)的可靠性要求较高。
定向防翻装置采用地锚及定向防翻连接绳等部件,在空投系统展开稳降过程中,打开定向防翻装置,连接货台的地锚及连接绳抛向地面,地锚着地后在风力作用下抓地并拉紧连接绳,转动货台顺风向着陆,因此风力太大或太小都起不到稳定效果。
发明内容
本发明要解决的技术问题在于针对现有技术中的缺陷,提供一种基于双天线测向的空投货台调姿控制方法,能适应多种类型的空投装备和货台的防翻需求,并主动对复杂环境进行适应,调姿能力不再因环境因素减弱。
本发明解决其技术问题所采用的技术方案是:一种基于双天线测向的空投货台调姿控制方法,所述空投货台上设有主动防翻装置,包括双天线卫星定位装置、调姿动力装置和航向姿态角控制器;所述双天线卫星定位装置用于获取卫星定位信息;调姿动力装置用于提供空投货台转动所需动力;调姿动力装置分为两组,能使空投货台能在水平面内顺时针和逆时针转动;
包括以下步骤:
1)空投货台投放后,双天线卫星定位系统启动,卫星接收机接收卫星信号,锁星定位,开始获取卫星定位系统导航信息,实时测量货台的下降轨迹;
2)将双天线卫星定位系统导航数据按照数据处理规则进行解算处理,实时计算货台的航向姿态角;所述货台的航向姿态角为货台轴线与正北方向的夹角;
3)实时计算空投货台距地高度,当空投货台到达距地设定高度后,判断货台的航向姿态角与货台的运动方向角的差值;所述运动方向角为所处环境水平风向与正北方向的夹角;
当货台的航向姿态角与运动方向角之差C1为正值时,通过调姿动力系统对空投货台施展推力F1,使其顺向调姿(顺时针旋转)直至航向姿态角缩小至预设值(0~±15°);
当货台的航向姿态角与运动方向角之差C2为负,通过调姿动力系统对空投货台施展推力F2,使其逆向调姿(逆时针旋转)直至航向姿态角缩小至预设值(0~±15°);
根据上述调姿动力装置控制方法,开启某组调姿动力装置进行驱动,然后开启另一组调姿动力装置进行制动,直到货台或装备的姿态角调整至安全范围内。
按上述方案,所述步骤3)中所述空投货台距地设定高度是根据目标着陆点参数计算得到的设定调姿动力装置启动的距地高度。
按上述方案,所述步骤3)中推力F的确定方式如下:
根据双天线测向卫星定位信号获知航向姿态角与运动方向角之差C,将货台航向姿态角对时间求导获得货台转动的角速度ω,将货台转动的角速度ω对时间求导获得转动角加速度通过地面试验测量调姿动力装置的推力F及最大推力下转动角度与时间的关系,获得推力F。
按上述方案,所述主动防翻装置固定设置在空投货台上。
本发明产生的有益效果是:本发明提出了一种基于双天线测向空投系统的货台调姿控制方法,克服了防翻支架稳定技术受限于无货台空投系统无防翻架或防翻板结构安装位置的问题,克服了定向防翻稳定技术受水平风速条件限制影响防翻效能的问题,适应性强、可靠性高、是一种能使战车主动调姿的新型防翻技术方案。本发明能保证空投系统的机内安全性,同时适应性强能在各种复杂风速环境中保证防翻效能。
附图说明
下面将结合附图及实施例对本发明作进一步说明,附图中:
图1是本发明实施例的方法流程图;
图2是本发明实施例的货台运动方向及航向姿态角示意图;
图3是本发明实施例的货台调姿示意图;
图4是本发明实施例的货台调姿控制示意图;
图5是本发明实施例的货台调姿控制流程图;
图6是本发明实施例的主动防翻系统结构图。
具体实施方式
为了使本发明的目的、技术方案及优点更加清楚明白,以下结合实施例,对本发明进行进一步详细说明。应当理解,此处所描述的具体实施例仅用以解释本发明,并不用于限定本发明。
如图1所示,一种基于双天线测向的空投货台调姿控制方法,所述空投货台上设有主动防翻装置,包括双天线卫星定位装置、调姿动力装置和航向姿态角控制器;所述双天线卫星定位装置用于获取卫星定位信息;调姿动力装置用于提供空投货台转动所需动力;调姿动力装置分为两组,能使空投货台能在水平面内顺时针和逆时针转动;
包括以下步骤:
1)空投货台投放后,双天线卫星定位系统启动,卫星接收机接收卫星信号,锁星定位,开始获取卫星定位系统导航信息,实时测量货台的下降轨迹;
2)将双天线卫星定位系统导航数据按照数据处理规则进行解算处理,实时计算货台的航向姿态角;所述货台的航向姿态角为货台轴线与正北方向的夹角;
通过天线1或天线2接收卫星定位信号,可获知货台的下降轨迹,空投系统稳降阶段,货台水平运动方向即所处环境水平风向与正北向夹角B;对比天线1和2的卫星定位信号,可获知天线1和2之间连线与正北向夹角A,根据天线1和2在货台上的安装位置,从图2可知A+B-90°即可获知货台的航向姿态角与运动方向角(运动方向与正北方向夹角)之差。
3)实时计算空投货台距地高度,当空投货台到达距地设定高度后,判断货台的航向姿态角与货台的运动方向角的差值;所述运动方向角为所处环境水平风向与正北方向的夹角;
如图3,当货台的航向姿态角与运动方向角之差C1为正值时,通过调姿动力系统对空投货台施展推力F1,使其顺向调姿(顺时针旋转)直至航向姿态角缩小至预设值(0~±15°);
当货台的航向姿态角与运动方向角之差C2为负,通过调姿动力系统对空投货台施展推力F2,使其逆向调姿(逆时针旋转)直至航向姿态角缩小至预设值(0~±15°);
推力F的确定方式如下:
根据双天线测向卫星定位信号获知航向姿态角与运动方向角之差C,将货台航向姿态角对时间求导获得货台转动的角速度ω,将货台转动的角速度ω对时间求导获得转动角加速度通过地面试验测量调姿动力装置的推力F及最大推力下转动角度与时间的关系,获得推力F,设定调姿动力系统启动时的货台距地高度
以实现空投货台顺向调姿90°为例说明控制方法,见图4。
货台的左后角位置表示为Z0,控制方法将实现货台的Z0位置调节控制至Zm位置。
启动正向动力装置工作,达到最大推力F1,货台开始顺时钟转动,并逐渐加速,转动角加速度逐渐增大,根据转动角速度ω、角加速度值,确定当转动角度达到D时,启动反向动力装置工作,施加推力F2,货台由Z0位置调至Zm位置,达到平衡,空投系统着陆,航向姿态满足要求。
基于双天线测向的空投货台调姿控制方法的控制流程见图5。其中货台的航向姿态角定义为货台轴线与正北方向的夹角,运动方向角定义为水平运动方向与正北方向的夹角,各夹角均以逆时针为正。
根据由重装空投系统自身的运动特性所确定的控制率,开启某组调姿动力系统进行驱动,然后开启另一组调姿动力系统进行制动,直到货台或装备的姿态角调整至安全范围内。
一个具体实施例:
如图6,应用基于双天线测向的空投货台调姿控制方法的主动防翻系统包括调整动力装置1、驱动器2、电源3、航向姿态角控制器与驱动器集成在一起、双天线卫星定位系统4;调姿动力装置分为两组,能使空投货台能在水平面内顺时针和逆时针转动,航向姿态角控制器根据卫星信号解算空投货台的运动方向和姿态角,并根据设定的控制率向调整动力装置1发出控制信号。安装方式如图6所示,主动防翻系统通过挂钩5固定安装在伞架上,而伞架通过拉杆固定在空投对象(可以是货台或装备)7上,主动防翻系统与挂钩所在伞架管垂直,双天线卫星定位系统4的天线与伞架管平行。
空投系统出机后,卫星定位系统开始正常工作,获知货台或装备的下降轨迹,由于物伞系统着陆之前处于稳降阶段,可认为其处于匀速直线运动状态。货台或装备垂直速度为固定值,货台或装备的水平速度即为环境风速,通过测量轨迹可推算出风速和风向。结合目标着陆点参数,设定调姿动力系统启动的距地高度(相对高度约200m),当系统到达预定高度。航向姿态角控制器通过对比双天线的卫星定位信号,可获知货台的航向姿态角。当航向姿态角与运动方向角(运动方向与正北方向夹角)之差为正时,货台处于航向姿态1的情况中,航向姿态角控制器对调姿动力装置发出控制指令,控制指令通过驱动器转化为电信号,控制调姿动力装置组1转动对空投货台施展推力F1,随后控制调姿动力装置组2减速,施加推力F2,使其顺向调姿直至航向姿态角缩小至预设值(0~±15°);当航向姿态角与运动方向角(运动方向与正北方向夹角)之差为负时,货台处于航向姿态2的情况中,航向姿态角控制器对调姿动力装置发出控制指令,控制指令通过驱动器转化为电信号,控制调姿动力装置组2转动对空投货台施展推力F2,随后控制调姿动力装置组1减速,施加推力F1,使其逆向调姿直至航向姿态角缩小至预设值(0~±15°)。
应当理解的是,对本领域普通技术人员来说,可以根据上述说明加以改进或变换,而所有这些改进和变换都应属于本发明所附权利要求的保护范围。

Claims (4)

1.一种基于双天线测向的空投货台调姿控制方法,其特征在于,所述空投货台上设有主动防翻装置,包括双天线卫星定位装置、调姿动力装置和航向姿态角控制器;所述双天线卫星定位装置用于获取卫星定位信息;调姿动力装置用于提供空投货台转动所需动力;调姿动力装置分为两组,能使空投货台能在水平面内顺时针和逆时针转动;
包括以下步骤:
1)空投货台投放后,双天线卫星定位系统启动,卫星接收机接收卫星信号,锁星定位,开始获取卫星定位系统导航信息,实时测量货台的下降轨迹;
2)将双天线卫星定位系统导航数据按照数据处理规则进行解算处理,实时计算货台的航向姿态角;所述货台的航向姿态角为货台轴线与正北方向的夹角;
3)实时计算空投货台距地高度,当空投货台到达距地设定高度后,判断货台的航向姿态角与货台的运动方向角的差值;所述运动方向角为所处环境水平风向与正北方向的夹角;
当货台的航向姿态角与运动方向角之差为正值时,通过调姿动力装置对空投货台施展推力,使其顺向调姿直至航向姿态角缩小至预设值;
当货台的航向姿态角与运动方向角之差为负值时,通过调姿动力装置对空投货台施展推力,使其逆向调姿直至航向姿态角缩小至预设值;
根据上述调姿动力装置控制方法,开启某组调姿动力装置进行驱动,然后开启另一组调姿动力装置进行制动,直到货台或装备的姿态角调整至安全范围内。
2.根据权利要求1所述的基于双天线测向的空投货台调姿控制方法,其特征在于,所述步骤3)中所述空投货台距地设定高度是根据目标着陆点参数计算得到的设定调姿动力装置启动的距地高度。
3.根据权利要求1所述的基于双天线测向的空投货台调姿控制方法,其特征在于,所述步骤3)中推力F的确定方式如下:
根据双天线测向卫星定位信号获知航向姿态角与运动方向角之差C,将货台航向姿态角对时间求导获得货台转动的角速度ω,将货台转动的角速度ω对时间求导获得转动角加速度然后根据地面试验测量调姿动力装置的推力F及最大推力下转动角度与时间的关系,获得推力F。
4.根据权利要求1所述的基于双天线测向的空投货台调姿控制方法,其特征在于,所述主动防翻装置固定设置在空投货台上。
CN201711129160.6A 2017-11-15 2017-11-15 一种基于双天线测向的空投货台调姿控制方法 Pending CN107656533A (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201711129160.6A CN107656533A (zh) 2017-11-15 2017-11-15 一种基于双天线测向的空投货台调姿控制方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201711129160.6A CN107656533A (zh) 2017-11-15 2017-11-15 一种基于双天线测向的空投货台调姿控制方法

Publications (1)

Publication Number Publication Date
CN107656533A true CN107656533A (zh) 2018-02-02

Family

ID=61119633

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201711129160.6A Pending CN107656533A (zh) 2017-11-15 2017-11-15 一种基于双天线测向的空投货台调姿控制方法

Country Status (1)

Country Link
CN (1) CN107656533A (zh)

Cited By (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN109343557A (zh) * 2018-11-16 2019-02-15 航宇救生装备有限公司 一种重装货台着陆姿态控制方法
CN109521815A (zh) * 2018-11-02 2019-03-26 航宇救生装备有限公司 一种空投件调姿系统电机补偿控制方法
CN110608713A (zh) * 2018-06-15 2019-12-24 中国人民解放军陆军工程大学 晃荡过程空运货台位姿与地面坡度检测方法
CN110780675A (zh) * 2019-10-29 2020-02-11 航宇救生装备有限公司 空投系统航向姿态控制方法
CN113155187A (zh) * 2021-04-14 2021-07-23 深圳市北斗云信息技术有限公司 一种被抛投物自正位方法
CN113320716A (zh) * 2021-06-16 2021-08-31 上海交通大学 具备自主调节足端触地点的外星逆境着陆器
CN117022650A (zh) * 2023-08-02 2023-11-10 南京理工大学 一种空投车辆横摆姿态调节系统

Citations (10)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN201534615U (zh) * 2009-05-08 2010-07-28 王硕 精确空投装置
CN102520728A (zh) * 2011-11-22 2012-06-27 北京空间机电研究所 一种采用双天线gps实现可控翼伞精确定点回收的方法
KR101266826B1 (ko) * 2012-09-10 2013-05-27 에스티엑스엔진 주식회사 선박용 위성안테나 이중화제어시스템에서 음영각에 따른 이중화 절체방법
CN103955223A (zh) * 2014-04-10 2014-07-30 北京控制工程研究所 一种深空探测软着陆过程的姿轨耦合控制方法
CN204347258U (zh) * 2014-08-18 2015-05-20 北京七维航测科技股份有限公司 双天线gnss/ins组合导航系统
CN106843281A (zh) * 2017-03-09 2017-06-13 北京航天控制仪器研究所 一种智能精确空降空投系统
US9684309B2 (en) * 2015-03-12 2017-06-20 The Charles Stark Draper Laboratory, Inc. Aircraft guidance based on partial differential equation for miss distance
CN107037469A (zh) * 2017-04-11 2017-08-11 北京七维航测科技股份有限公司 基于安装参数自校准的双天线组合惯导装置
CN107121940A (zh) * 2017-05-27 2017-09-01 南京航空航天大学 一种翼伞四自由度半实物仿真平台
CN206598984U (zh) * 2017-04-07 2017-10-31 西南科技大学 一种精准投放降落伞

Patent Citations (10)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN201534615U (zh) * 2009-05-08 2010-07-28 王硕 精确空投装置
CN102520728A (zh) * 2011-11-22 2012-06-27 北京空间机电研究所 一种采用双天线gps实现可控翼伞精确定点回收的方法
KR101266826B1 (ko) * 2012-09-10 2013-05-27 에스티엑스엔진 주식회사 선박용 위성안테나 이중화제어시스템에서 음영각에 따른 이중화 절체방법
CN103955223A (zh) * 2014-04-10 2014-07-30 北京控制工程研究所 一种深空探测软着陆过程的姿轨耦合控制方法
CN204347258U (zh) * 2014-08-18 2015-05-20 北京七维航测科技股份有限公司 双天线gnss/ins组合导航系统
US9684309B2 (en) * 2015-03-12 2017-06-20 The Charles Stark Draper Laboratory, Inc. Aircraft guidance based on partial differential equation for miss distance
CN106843281A (zh) * 2017-03-09 2017-06-13 北京航天控制仪器研究所 一种智能精确空降空投系统
CN206598984U (zh) * 2017-04-07 2017-10-31 西南科技大学 一种精准投放降落伞
CN107037469A (zh) * 2017-04-11 2017-08-11 北京七维航测科技股份有限公司 基于安装参数自校准的双天线组合惯导装置
CN107121940A (zh) * 2017-05-27 2017-09-01 南京航空航天大学 一种翼伞四自由度半实物仿真平台

Non-Patent Citations (2)

* Cited by examiner, † Cited by third party
Title
SHUAI HE 等: "High-Accuracy Localization Platform Using Asynchronous Time Difference of Arrival Technology", 《IEEE TRANSACTIONS ON INSTRUMENTATION AND MEASUREMENT》 *
李天明: "精确空投翼伞测控系统的地面基站研究", 《中国优秀硕士学位论文全文数据库 工程科技Ⅱ辑》 *

Cited By (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN110608713A (zh) * 2018-06-15 2019-12-24 中国人民解放军陆军工程大学 晃荡过程空运货台位姿与地面坡度检测方法
CN109521815A (zh) * 2018-11-02 2019-03-26 航宇救生装备有限公司 一种空投件调姿系统电机补偿控制方法
CN109521815B (zh) * 2018-11-02 2022-02-01 航宇救生装备有限公司 一种空投件调姿系统电机补偿控制方法
CN109343557A (zh) * 2018-11-16 2019-02-15 航宇救生装备有限公司 一种重装货台着陆姿态控制方法
CN110780675A (zh) * 2019-10-29 2020-02-11 航宇救生装备有限公司 空投系统航向姿态控制方法
CN113155187A (zh) * 2021-04-14 2021-07-23 深圳市北斗云信息技术有限公司 一种被抛投物自正位方法
CN113320716A (zh) * 2021-06-16 2021-08-31 上海交通大学 具备自主调节足端触地点的外星逆境着陆器
CN113320716B (zh) * 2021-06-16 2022-08-09 上海交通大学 具备自主调节足端触地点的外星逆境着陆器
CN117022650A (zh) * 2023-08-02 2023-11-10 南京理工大学 一种空投车辆横摆姿态调节系统

Similar Documents

Publication Publication Date Title
CN107656533A (zh) 一种基于双天线测向的空投货台调姿控制方法
CN107745814A (zh) 一种用于空投系统着陆的主动防翻控制机构
US11230371B2 (en) Maintaining attitude control of unmanned aerial vehicles by varying centers of gravity
US20200140075A1 (en) Maintaining attitude control of unmanned aerial vehicles using pivoting propulsion motors
US20200148387A1 (en) Recovery System for UAV
CN1997823B (zh) 控制风轮机叶片的倾斜速度的方法及其控制系统
JP6051327B1 (ja) 無人航空機
AU2007347147B2 (en) Method and apparatus for retrieving a hovering aircraft
CN207148654U (zh) 一种固定翼飞机货物空投与接收系统
US20050017515A1 (en) Precisely controlled flying electric generators
CN104590557B (zh) 一种多旋翼和固定翼复合飞行器的飞行控制方法及装置
CN104653393B (zh) 关闭风力涡轮的方法和系统
CN208470114U (zh) 一种植保无人飞机喷头主动平衡装置
CN108475069B (zh) 农业无人飞行器的控制方法、飞行控制器及农业无人机
CN102951548A (zh) 一种用于装卸风力发电机转子叶片的装置以及方法
CN101903648A (zh) 自转空中循环受控式发电的系统和方法
DK177278B1 (en) A wind turbine and associated control method
CN104931219A (zh) 一种着陆冲击试验装置及其试验方法
CN102787969A (zh) 风力涡轮机和风力涡轮机叶片
CN108045543A (zh) 无人机的投放系统
CN108750120A (zh) 一种植保无人飞机喷头主动平衡装置及调节方法
CN112764425B (zh) 一种临近空间垂直投放发射单通道增稳控制方法及系统
CN107472554A (zh) 一种无人机车载气动力测试系统
Park Wind and airspeed error estimation with GPS and pitot-static system for small UAV
CN114235329A (zh) 一种全机突风动载荷风洞试验装置

Legal Events

Date Code Title Description
PB01 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination
SE01 Entry into force of request for substantive examination
RJ01 Rejection of invention patent application after publication

Application publication date: 20180202

RJ01 Rejection of invention patent application after publication