一种基于双卫星接收机的无人机寻的回收导引控制方法
【专利摘要】一种基于双卫星接收机的无人机寻的回收导引控制方法，双卫星定位接收机是指分别在无人机和回收点处各安装一台卫星定位接收机，寻的回收是指通过控制约束使无人机与特定目标发生交会，从而达到无人机回收的目的。无人机寻的回收的导引控制方法包括了导引信息获取方法和无人机寻的过程中的控制方法以及在异常情况下防止回收机构的载具与无人机发生碰撞的复飞策略。通过本方法导引和控制无人机撞击移动的船舶、车辆上部署的阻拦网或阻拦绳等回收机构，解决了回收导引系统通常需要配备复杂导引设备或受能见度影响的不便的同时，达到安全、精确的回收无人机的需求。
【专利说明】一种基于双卫星接收机的无人机寻的回收导引控制方法
【技术领域】
[0001]本发明涉及一种基于双卫星接收机的无人机寻的回收导引控制方法，可以通过间接测量无人机相对与特定目标的视线角速率导引控制无人机与该目标进行交会以达到回收的目的，主要在无人机在移动平台上的精确回收。
【背景技术】
[0002]无人机的回收导引控制技术是无人机重复使用的基础。大多数无人机通过伞降回收或机场跑道进行回收。小型无人机一般使用伞降回收，大中型无人机一般使用机场跑道进行回收。使用伞降回收时，无人机的回收精度和效率受风场影响严重，在陆地上使用时受回收场地形地貌的制约，在海上使用是还要考虑防水密封结构死重较高，影响载荷能力和航程、航时。使用机场跑道进行回收时，无人机的部署和使用受到了很大制约。
[0003]在机动平台上通过阻尼网、阻尼绳吸能捕获回收无人机，可以极大的提高无人机的回收效率和部署能力，更加充分的利用无人机特别是小型无人机有限的航程、航时能力，提闻无人机的使用效率。
[0004]目前，我国公知的通过阻尼网、阻尼绳吸能捕获回收无人机一般通过两种方法获取导引信息:
[0005]一种是在无人机上装备精密的(可见光、红外)光学设备和回收点附近的合作目标获取导引信息，这种方法的可靠性受能见度条件的影响严重，影响无人机的出勤率，且相关软件相当复杂。
[0006]另外一种是通过在回收平台上装备复杂的无线电导引系统或雷达系统获取导引信息，这种方法回收平台提出了较高的要求，针对小型无人机效费比较低。
[0007]目前，我国公知的通过阻尼网、阻尼绳吸能捕获回收无人机一般采用无人机飞行轨迹控制的方法控制无人机被阻尼网、阻尼绳吸能捕获。在回收点机动的条件下，飞行轨迹的计算方法和响应控制方法都非常复杂，软件也相当复杂。
【发明内容】
[0008]本发明的技术解决问题是:克服现有技术的不足，提供了一种基于双卫星定位接收机的无人机寻的回收导引控制方法，实现了的无人机寻的回收导引控制，可满足在机动平台上通过阻尼网、阻尼绳吸能捕获回收无人机的需求。
[0009]本发明的技术解决方案是:
[0010]一种基于双卫星接收机的无人机寻的回收导引控制方法，所述双卫星接收机指分别安装在无人机和移动回收点处的两个相同型号的卫星定位接收机，定义为接收机A和接收机B，步骤如下:
[0011](I)判断当前时刻接收机A和接收机B是否处于正常工作模式，若处于正常工作模式，令接收机A和接收机B使用相对差分模式导引控制无人机，之后进入步骤(2);若未处于正常工作模式，则分别单点获取接收机A和接收机B的位置，进而得到接收机A和接收机B的相对位置，之后进入步骤(3 );所述正常工作模式是指同时可用于接收机A与接收机B定位的卫星颗数大于8颗；
[0012](2)判断无人机与回收点是否完成交会，若未完成交会返回步骤(1)，若完成交会则完成了基于双卫星接收机的无人机寻的回收导引控制；
[0013](4)根据公式
【权利要求】
1.一种基于双卫星接收机的无人机寻的回收导引控制方法，其特征在于:所述双卫星接收机指分别安装在无人机和移动回收点处的两个相同型号的卫星定位接收机，定义为接收机A和接收机B，步骤如下: (1)判断当前时刻接收机A和接收机B是否处于正常工作模式，若处于正常工作模式，令接收机A和接收机B使用相对差分模式导引控制无人机，之后进入步骤(2);若未处于正常工作模式，则分别单点获取接收机A和接收机B的位置，进而得到接收机A和接收机B的相对位置，之后进入步骤(3);所述正常工作模式是指同时可用于接收机A与接收机B定位的卫星颗数大于8颗； (2)判断无人机与回收点是否完成交会，若未完成交会返回步骤(1)，若完成交会则完成了基于双卫星接收机的无人机寻的回收导引控制； (3)根据公式
2.根据权利要求1所述的一种基于双卫星接收机无人机寻的回收导引控制方法，其特征在于:所述步骤(1)中使用相对差分模式导引控制无人机按照如下步骤进行: (a)犾取接收机B经度、纟韦度； (b)剔除未被接收机A、接收机B同时接收的卫星的定位数据； (c)将接收机A、B对应每颗卫星的伪距进行差分； Cd)通过最小二乘法解算无人机在地心坐标系下接收机A指向接收机B的位置矢量估计值毛ω; (e)通过坐标系旋转获取^在以接收机B为原点的北天东坐标系的北向坐标Dn，天向坐标Du、东向坐标De,同时通过对接收机A获取北向坐标Vn^Vnfi，天向坐标V1^Vub,东向坐标VeA、相减获取以接收机B为原点的北天东坐标系下接收机A的北向速度Vn，天向速度Vu、东向速度入 Cf)根据步骤(e)中相对坐标系列中的速度矢量和位置矢量观测值通过速度、位置关系，通过kalman滤波方法对无人机在地心坐标系下相对坐标系列中的速度矢量和位置矢量进行滤波，并计算视线高低角和方位角； (g)根据步骤(f)中得出的无人机在相对坐标系列中的速度矢量和位置矢量滤波输出和高低角、方位角计算无人机相对回收点的视线高低、偏航角速率； (h)生成升降舵的平飞配平指令、方向舵荷兰滚阻尼指令以及副翼平飞控制指令，并通过使用比例导引方法生成方向舵和升降舵的比例导引指令； (i)将步骤(h)中得到各控制舵面指令相加产生舵控指令，并根据舵控指令控制方向舵、升降舵、副翼偏转到相应位置。
3.根据权利要求1所述的一种基于双卫星接收机的无人机寻的回收导引控制方法，其特征在于:所述步骤(3)中描述的复飞是指无人机拉起并转弯远离回收点，无人机的复飞状态包括正常复飞和紧急复飞，无人机正常复飞是指能保证无人机安全飞行的工作模式，无人机紧急复飞是指为了使无人机不与载具发生碰撞而进行的复飞，其不保证无人机的飞行安 全。
【文档编号】G05D1/10GK103529852SQ201310533458
【公开日】2014年1月22日 申请日期:2013年10月31日 优先权日:2013年10月31日
【发明者】胡强, 成海朋, 李刚, 杨宁 申请人:中国航天空气动力技术研究院