专利名称：一种采用双天线gps实现可控翼伞精确定点回收的方法
技术领域：
本发明属于航天返回与着陆技术领域，涉及一种应用双天线GPS实现航天器及其它物资乘可控翼伞精确定点回收的方法。
背景技术：
返回式航天器返回过程的最终阶段是安全着陆，这也是这类航天器整个飞行任务的最终阶段。随着航天返回与着陆技术的迅速发展，对航天器回收与着陆的精度要求也越来越高，从而对降落伞系统提出了具有滑翔能力和可操作性的技术要求。八十年代中期，美国开始研制用于航天器回收的大型可控翼�。〉昧撕芎玫睦砺酆褪匝檠芯砍晒�。翼伞技术进入航天器回收技术领域，使降落伞减速装置由传统的“无控下落”变成“可控滑翔下落至预定区域”，克服了传统降落伞随风飘、着陆点散布大的缺点。冲压翼伞的优异性能预示着它将在航天器回收领域有着广泛的应用前景。为了提高可控翼伞的着陆精度提出了许多方法，如采用地面信标机、磁方向传感器、罗盘、GPS等。其中后两种方法在工程实际中采用较多。地面信标机和磁方向传感器信号覆盖范围较�。掖嬖诿そ牵谑导视τ弥杏薪洗蟮木窒扌�。罗盘装置受地域的影响较大。传统单天线GPS只能获得翼伞的位置、高度和速度信息，无法获得翼伞的航向角信息，使得可控翼伞的控制精度无法提高。
发明内容
本发明的技术解决问题是克服现有技术的不足，提供一种采用双天线GPS实现可控翼伞精确定点回收的方法，可以解决实时获取可控翼伞的航向角，实现可控翼伞的精确控制问题。本发明的技术解决方案是一种采用双天线GPS实现可控翼伞精确定点回收的方法，步骤如下(1)利用双天线GPS接收机内置两个独立的GPS�？椋直鸹袢×礁鎏煜連i、B2 的位置信息；GPS接收机和双天线的安装方式双天线中的主天线和从天线安装位于同一直线上，由主天线指向从天线，该直线指向与可控翼伞模型航向一致，两天线之间安装距离 d固定且已知；(2)根据两个天线的位置信息，计算可控翼伞航向角β，具体计算过程如下假设 Bl点的经度为Xtll,纬度为Υ01，Β2点的经度为Xtl2，纬度为Y02,PJ 当β在第一象限时β = arctan[ (X02-X01) (cosY01) / (Y02-Y01)]；当β在第二象限时β = 2 π +arctan [ (X02-X01) (CosY01) / (Y02-Y01)]；当β在第三、四象限时β = π +arctan [ (X02-X01) (cosY01) / (Y02-Y01)]；其中，K1JcilJci2Jc^ β的单位均为弧度；
(3)进行航向角测量的准确性校验首先根据天线Bi、B2的位置信息计算两个天线之间的实际距离dl，然后计算dl与d的差值d’，判断d’与预先设定的阈值S之间大�。� 若d’ > s，则航向角测量失效，转步骤；若d’ ^ s，则利用步骤(2)计算的航向角β控制翼伞归航，方法结束；(4)当航向角测量失效，或者可控翼伞转弯速率>90° /s，或者步骤(1)中的一个天线失效时，利用单天线的位置信息，计算翼伞的航迹向角数据，利用该航迹向角控制翼伞归航。所述的两天线之间安装距离d取值Im an。本发明与现有技术相比有益效果为(1)提高可控翼伞归航控制的精度。本发明利用双天线GPS作为翼伞的输入敏感器，不但可以获得翼伞的位置、高度、速度数据，同时可以获得翼伞准确的实时航向角数据， 从而对翼伞飞行状态进行更加准确的控制。(2)提高翼伞归航控制系统的鲁棒性和可靠性。应用本发明可以同时获得翼伞航向与航迹向信息，互为备份。当翼伞转弯速率>90° /s航向信息失锁时，采用航迹向信息； 当翼伞为静态航迹向信息无法获得时，可以采用航向信息；当两者同时有时，优先采用航向信息作为归航控制的依据。另外，由于双天线的GPS接收机内部集成了两个独立的GPS模块和两个天线，当其中一个�？榛蛱煜咭蛭馔庠蚴保硗庖桓瞿？榛故强梢晕砩√峁┗镜己剿璧奈恢煤秃郊Ｏ蛐畔ⅲ挂砩〉牡己饺匀豢梢酝瓿伞�
图1为本发明机载设备组成框图；图2为本发明地面设备组成框图；图3为本发明航向角和航迹向角的夹角示意图；图4为本发明双天线GPS接收机和天线在可控翼伞上的安装方式；图5为本发明航向角的定义示意图；图6为本发明航迹向角的定义示意图。
具体实施例方式(1)可控翼伞归航控制系统由机载设备和地面设备两部分构成。其中机载部分包括归航控制器、GPS定位定向仪(含GPS接收双天线)、机载数传机(含机载数传天线)、左右电机驱动器、左右电机等。机载设备组成见图1。地面部分包括地面数传机(含数传天线)、地面控制计算机等。地面设备组成见图2。在可控翼伞回收阶段，归航控制计算机根据GPS定位定向仪接收到的定位、姿态、 速度、航向等信息，依据归航算法进行解算，向左右电机驱动器输出控制指令，再由驱动器驱动左右电机控制翼伞的左右操纵绳收紧或放松，使翼伞转向并逼近目标点。同时，归航控制计算机还将GPS接收到的定位信息通过数传机转发到地面，由地面计算机进行实时显示和储存。在人工�？夭僮菘刂品绞绞保孛娴囊？乜刂浦噶钔ü洗焦楹娇刂萍扑慊砸砩〗幸？毓楹娇刂�。(2)在可控翼伞归航的过程中，需要获取翼伞的位置、速度、高度、航向角等数据通过运算来确定翼伞左右电机的操纵量。传统方法采用单天线的GPS只能获得翼伞的经度、 纬度和高度信息，无法获得翼伞的航向角信息，只能采用航迹向角信息代替航向角信息进行导航。航迹向角与翼伞的真实航向角有一定的误差θ，见图3。从而使得翼伞的导航输入数据无法准确。本发明利用特定的安装方式见图4 =GPS两个天线的安装位于同一直线上， 由主天线指向从天线，该直线指向与翼伞模型航向指向一致。主天线与从天线的安装距离为一固定数值d (根据经验，d取值Im an之间最合适。d的值小于Im则影响测量精度， d的值大于an则会增加解算时间，影响翼伞响应速度)。GPS的面板朝向主天线方向。两个独立的天线和两个独立的内置GPS模块分别获得天线Bl和B2的位置数据，见图5。通过两个天线位置数据的运算可以获得翼伞模型准确的航向角数据。(3)航向角β的计算方法如下假设Bl点的经度为)CQ1，纬度为YQ1。B2点的经度为\2，纬度为Yo2。则可控翼伞航向角β为当β在第一象限时β = arctan[ (X02-X01) (cosY01) / (Y02-Y01)]；当β在第二象限时β = 231 +arctan [ (X02-X01) (cosY01) / (Y02-Y01)]；当β在第三、四象限时β = π+arctan [(Xci2-Xcil) (CosYcil)Z(Yci2-Ycil)]；其中，K1Jc^ K2Jc^ β的单位均为弧度。(4)经过准确性校验可以得知双天线GPS的安装是否正确及航向角β的测量结果是否正确。方法如下假设地球半径为r，则B2点和Bl点之间的计算距离为dl
权利要求
1.一种采用双天线GPS实现可控翼伞精确定点回收的方法，其特征在于步骤如下(1)利用双天线GPS接收机内置两个独立的GPS�？椋直鸹袢×礁鎏煜連i、B2的位置信息；GPS接收机和双天线的安装方式双天线中的主天线和从天线安装位于同一直线上，由主天线指向从天线，该直线指向与可控翼伞模型航向一致，两天线之间安装距离d固定且已知；(2)根据两个天线的位置信息，计算可控翼伞航向角β，具体计算过程如下假设Bl点的经度为)^，纬度为Ytll, B2点的经度为Xtl2，纬度为Ytl2，则当β在第一象限时β = arctan[ (X02-X01) (cosY01) / (Y02-Y01)]；当β在第二象限时β = 231 +arctan [ (X02-X01) (cosY01) / (Y02-Y01)]；当β在第三、四象限时β = Ji +arctan [ (X02-X0i) (cosY01) / (Υ02-Υ0ι)]；其中，KrYc^β的单位均为弧度；(3)进行航向角测量的准确性校验首先根据天线Bi、Β2的位置信息计算两个天线之间的实际距离dl，然后计算dl与d的差值d’，判断d’与预先设定的阈值s之间大小，若d’ > s，则航向角测量失效，转步骤(4)；若d’ ^ s，则利用步骤(2)计算的航向角β控制翼伞归航，方法结束；(4)当航向角测量失效，或者可控翼伞转弯速率>90°/s，或者步骤(1)中的一个天线失效时，利用单天线的位置信息，计算翼伞的航迹向角数据，利用该航迹向角控制翼伞归航。
2.根据权利要求1所述的一种采用双天线GPS实现可控翼伞精确定点回收的方法，其特征在于所述的两天线之间安装距离d取值Im an。
全文摘要
一种采用双天线GPS实现可控翼伞精确定点回收的方法，(1)利用双天线GPS接收机内置两个独立的GPS�？椋直鸹袢×礁鎏煜叩奈恢眯畔ⅲ恢魈煜吆痛犹煜甙沧拔挥谕恢毕呱希芍魈煜咧赶虼犹煜撸弥毕咧赶蛴肟煽匾砩∧Ｐ秃较蛞恢拢教煜咧浒沧熬嗬雂固定且已知；(2)根据两个天线的位置信息，计算可控翼伞航向角β；(3)进行航向角测量的准确性校验首先计算两个天线之间的实际距离d1，然后计算d1与d的差值d’，若d’＞s，则航向角测量失效，转步骤(4)；否则，利用航向角β控制翼伞归航；(4)当航向角测量失效，或可控翼伞转弯速率＞90°/s，或一个天线失效时，利用单天线的位置信息，计算翼伞的航迹向角数据，利用该航迹向角控制翼伞归航。
文档编号G01S19/53GK102520728SQ20111037197
公开日2012年6月27日 申请日期2011年11月22日 优先权日2011年11月22日
发明者吕智慧, 李春, 沈超, 黄伟 申请人:北京空间机电研究所
专业数控铣床产品供应商
20年生产经验，实力工厂，精工品质，质量有保障
