一种无人机定向天线自跟踪系统设计方法
【技术领域】
[0001] 本发明属于无人机控制领域，涉及自动跟踪，具体涉及一种无人机定向天线自跟 踪系统的设计方法。
【背景技术】
[0002] 随着无人机技术的快速发展，应用越来越广泛。在许多应用中，无人机与地面控制 系统间有大量的观测、控制数据需要实时传输，为了保证数据收发准确可靠，同时提高接收 增益和抗干扰能力，这种远距离、高带宽的通信，通常采用定向天线。定向天线工作时，只有 发射天线和接收天线主瓣对准时，才有较高的增益。如果不能保证定向天线实时对准，将使 无人机与地面控制系统间信号中断，这不仅会丢失观测数据，影响任务的完成，还会造成无 人机的失控，可能导致无人机丢失、坠毁等严重事故，因此，需要保证定向天线实时对准。实 现定向天线对准跟踪主要有人工跟踪和自动跟踪，人工跟踪存在误差大、实时性差等不足。 自动跟踪是定向天线根据目标的运动，自动实现对目标的跟踪，是目前主要跟踪方式。根据 目标角确定方法的不同，定向天线自跟踪可分为两种主要方式，最常用的是通过信号相位 关系来进行目标角判断，这需要一套复杂的天线伺服反馈系统，成本很高，此外，该方法抗 干扰能力较差。另一种方法是利用无人机实时发送给地面站的GPS位置信息，根据无人机 和定向天线的相对位置来确定跟踪目标角。由于GPS位置信号具有比前者跟踪信号更加稳 定、实现简单等特点，两者相比，后者更有优势。但基于GPS位置信号来设计定向天线自动 跟踪系统，目前存在如下不足：根据无人机和定向天线的相对位置来确定跟踪目标角，目前 的计算方法需要根据定向天线和无人机的相对位置来判断真实的方位角所在象限，在象限 边界处容易引起歧义，增加了控制系统实现的复杂度，给工程应用带来了困难。由于通信链 路传输能力以及低成本GPS接收机动态特性的限制，通常无人机发送给地面控制系统的位 置更新频率较低，在近距离跟踪时，跟踪角变化波动较大，容易造成跟踪系统运动波动和较 大的跟踪误差，会显著增加系统磨损。随着无人机的广泛应用，在许多应用领域需要定向天 线跟踪系统具有机动跟踪能力，以提高系统的机动性和隐蔽性，但在机动过程中，定向天线 的GPS位置信息，容易受隧道、树木、建筑等干扰，造成位置信息不准，从而导致跟踪目标的 丢失。
【发明内容】
[0003] 为解决基于GPS位置信号来设计定向天线自动跟踪系统目前存在的上述问题，本 发明提出了一种无人机定向天线自跟踪系统设计方法。利用该方法设计定向天线自动跟踪 系统具有运行稳定、误差小、工程实现方便和具有机动跟踪能力等特点。
[0004] 本发明提供的一种无人机定向天线自跟踪系统设计方法，采用的技术方案为：
[0005] 在载车上安装GPS接收机来实时获取定向天线的位置和速度。利用无人机地面控 制系统接收无人机通过数据链实时下传的无人机的位置和速度。主控制器利用定向天线和 无人机的位置获取出定向天线的跟踪目标角，跟踪目标角包括目标的方位角和俯仰角。主 控制器利用定向天线和无人机的速度实现对位置的预测平滑以及实现当无人机飞过定向 天线顶点时对方位运动增加前馈。在载车上安装方位角和俯仰角测量仪测量载车的当前方 位角和俯仰角，通过角度传感器来测量定向天线相对于载车的方位角和俯仰角，从而获得 定向天线的当前角。主控制器根据定向天线的跟踪目标角与当前角的差值计算控制量，驱 动定向天线到达目标位置，从而实现无人机定向天线的自动跟踪。
[0006] 所述的主控制器利用定向天线和无人机的位置获取定向天线的跟踪目标角，实现 步骤是：
[0007] 步骤1 :对于方位角，设定以正北为零度，顺时针方向为[0,31]，逆时针方向为 [0，-n];对于俯仰角，设定水平面以上为正，水平面以下为负。
[0008] 步骤2 :根据车载GPS接收机获得定向天线的经度和炜度，计算出参考椭圆地球模 型的子午面曲率半径馬和横向曲率半径RE;利用RRE，计算无人机相对于定向天线在当 地地理导航坐标系上的相对距离（PN，PE，PD)。所述的当地地理导航坐标系是以定向天线当 前位置为原点，北向为N轴，东向为E轴，当地垂线向下方向为D轴。
[0010] 式中，（L。，xe，h。）为载车的经度、炜度和海拔高度，（LT，XT，hT)为无人机位置的经 度、炜度和海拔高度。PjPPD分别为无人机与定向天线在北向和东向的水平距离，PE为无 人机与定向天线的垂直距离。
[0011] 步骤3:利用以上计算出的相对距离$1<，？￡，？1))，确定目标方位角1^和目标俯仰 角9 t;
[0013] 跟踪目标角包括目标方位角步7和目标俯仰角0 T。
[0014] 所述的主控制器利用定向天线和无人机的速度实现对位置的预测平滑，包括步骤 31和步骤22。
[0015] 步骤21:在控制周期中，首先判断载车位置是否更新，如已更新且有效，则使用更 新的载车位置来计算跟踪目标角，如没有更新或者无效，则利用载车的速度乘以控制周期 的时间作为位置的增量来预测载车当前位置。
[0016] 步骤22:判断无人机的位置是否更新，如已更新且有效，则使用更新的无人机位 置来计算跟踪目标角，如没有更新或者无效，则利用无人机的速度乘以控制周期的时间作 为位置的增量来预测无人机当前位置。
[0017] 所述的主控制器实现当无人机飞过定向天线顶点时对方位运动增加前馈，包括步 骤31和步骤32。
[0018] 步骤31:确定无人机与定向天线的水平距离S、水平方向上的相对速度V和到顶时 间t;
[0020]t=S/abs(V)
[0021] 其中：VjPV^别为无人机在北向和东向的水平速度；v，^分别为定向天线在 北向和东向的水平速度；
[0022] 步骤32 :根据到顶时间t和相对速度V进行判断，判断是否满足条件t< '且V <%，若满足，则将定向天线的目标方位角增加180°，实现方位提前运动；否则，不需要提 前运动。其中，h为定向天线在方位方向上运行90°时的运行时间，V。为预先设定的速度 阈值。
[0023] 本发明的无人机定向天线自跟踪系统设计方法的优点和积极效果在于：
[0024] (1)通过实时采集载车航向、俯仰和位置等信息，利用基于相对位置的目标角计算 方法，可实现定向天线在机动过程中的自跟踪能力，从而提高了系统的机动性和隐蔽性。
[0025] (2)提出基于相对位置计算跟踪目标角的新方法，与现有方法相比，不用象限判 断，不会造成歧义，易于工程实现。
[0026] (3)利用速度对位置进行预测平滑，不仅有效平滑了定向天线跟踪动作，降低了运 动部件的磨损，提高了系统跟踪精度，而且当位置信息丢失，速度变化不大时，还可保持定 向天线的正确指向，避免目标丢失，提高了系统可靠性。
[0027] (4)利用方位运动前馈控制策略，有效降低了过顶跟踪误差，提高了系统可靠性和 适应性。
【附图说明】
[0028] 图1为本发明方法所应用的定向天线自动跟踪系统的硬件组成框图；
[0029] 图2为本发明定向天线自动跟踪系统软件主流程图。
【具体实施方式】
[0030] 本发明在于提供一种无人机定向天线自跟踪系统设计方法，下面将结合附图对本 发明做详细说明。
[0031] 如图1所示，本发明所应用的定向天线自动跟踪系统，硬件组成主要包括：GPS接 收机1、无人机地面控制系统2、主控制器3、方位角和俯仰角测量仪4、角度传感器5、电机驱 动电路6、电机及减速器7和定向天线8。
[0032] 在载车上安装GPS接收机1来实时获取定向天线的位置和速度，并传送给主控制 器3。利用无人机地面控制系统2接收无人机通过数据链实时下传的无人机的位置和速度， 再转发给主控制器3。主控制器3实现的功能是：利用定向天线和无人机的位置计算出定向 天线的跟踪目标角，目标角包括方位角和俯仰角；利用定向天线和无人机的速度来实现对 位置的预测平滑以及实现当无人机飞过定向天线顶点时对方位运动增加前馈。通过主控制 器3实现的功能达到减小跟踪误差、降低跟踪磨损、提高跟踪平稳的目的。通过在载车上安 装方位角和俯仰角测量仪4来测量载车的当前方位角和俯仰角，通过电机输出轴上的角度 传感器5来测量定向天线相对于载车的方位角和俯仰角，根据相应的方位角之和、俯仰角 之和就可获得定向天线的当前方位角和当前俯仰角，当前方位角和俯仰角简称当前角。主 控制器3根据定向天线的跟踪目标角与当前角的差值，计算电机驱动电路6的控制量，发送 相应的控制指令给电机驱动电路6。电机驱动电路6把控制指令转化为电机的实际驱动控 制信号输出给电机及减速器7,使得安装在输出轴上的定向天线8快速、平稳的到达目标位 置，从而实现无人机定向天线的自动跟踪。由于在载车上安装有GPS接收机1与方位角和 俯仰角测量仪4,不论载车是否运动，都能够实时获得定向天线8的跟踪目标角和当前角， 从而使得该跟踪系统具有机动跟踪能力。
[0033] 本发明的无人机定向天线自跟踪系统设计方法，体现在主控制器3的功能实现 上，包括基于位置来计算目标角的新方法，利用速度信息对位置进行预测平滑方法和实现 无人机飞过定向天线顶点时对方位运动增加前馈的方法。
[0034]首先，说明利用定向天线和无人机的位置计算定向天线的跟踪目标角的方法，包 括下面步骤1~步骤3。
[0035] 步骤1:对于方位角，设定以正北为零度，顺时针方向为[0,31]，逆时针方向为 [0，-n]。俯仰角规定水平面以上为正，水平面以下为负。
[0036] 步骤2:根据车载GPS接收机1所获得的定向天线的经度和炜度，计算出参考椭圆 地球模型的子午面曲率半径RN和横向曲率半gRE，如式（1)所示。
[0038] 式中，R= 6378137. 0m为地球长半轴，e= 0. 08181919