组合自主导航系统的地面半物理仿真平台的制作方法
【技术领域】
[0001] 本发明属于深空探测技术领域，更为具体地讲，设及一种组合自主导航系统的地 面半物理仿真平台。
【背景技术】
[0002] 深空探测飞行由于距离远、背景环境复杂、飞行程序复杂、器地通信时延大等原 因，要求飞行器能够实现自主导航，因此自主导航能力对任务的完成至关重要。在导航方法 和理论的研究和设计过程中，对飞行器导航系统进行性能评估和验证是一个非常重要的环 节。而真实飞行器平台建造时间长，成本高，实现结构复杂，为了对组合自主导航系统进行 检测评估，因此必须进行模拟测试。
[0003] 目前的模拟测试的方法分为软件模拟和半物理模拟。软件模拟中的飞行器参数和 深空环境参数都是人为设置的，对实际情况的模拟具有较大局限性。半物理模拟能够利用 各器件的真实误差特性进行仿真，较纯粹的软件模拟能够更加贴近实际情况，得到更加精 确的仿真结果。但是目前的半物理模拟方法大多是采用若干个计算机对组合自主导航系统 的各个模块进行软件模拟，仿真模拟程度不高。
【发明内容】
[0004] 本发明的目的在于克服现有技术的不足，提供一种组合自主导航系统的地面半物 理仿真平台，提高对深空探测飞行环境的模拟精度，从而提高对组合自主导航系统定位、定 速能力的评估准确度。
[0005] 为实现上述发明目的，本发明组合自主导航系统的地面半物理仿真平台，包括：模 拟天体、轨道、巡迹小车和上位机，其中；
[0006] 模拟天体的数量根据实际情况设置，至少为两个，模拟天体在平面场地内固定放 置，其位置要求为：巡迹小车在沿轨道运动过程中，始终至少有两个模拟天体位于巡迹小车 上搭载的摄像头导航模块的视场内；模拟天体之间根据颜色或形状区分，每个模拟天体上 设置有多普勒波源模块，多普勒波源的频率根据从上位机接收的波源参数设置信号进行 设置；
[0007] 轨道铺设在平面场地内，其轨迹根据实际需要设置；
[0008] 巡迹小车上搭载有多普勒导航模块、摄像头导航模块、巡迹控制模块、处理器模块 和通信模块，其中：
[0009] 多普勒导航模块在巡迹小车运动过程中接收模拟天体波源所发出的信号，根据多 普勒效应计算巡迹小车相对于各个模拟天体的速度，发送给处理器模块；
[0010] 摄像头导航模块的视线方向与巡迹小车的运动方向相同，在巡迹小车运动过程 中持续拍摄模拟天体的图像，对图像中的模拟天体进行识别，根据模拟天体图像在图像中 的位置，计算巡迹小车当前在平面场地中的与模拟天体位置的几何角度，发送给处理器模 块；
[0011] 巡迹控制模块对轨道进行路径识别，控制巡迹小车的速度和运动方向，使巡迹小 车按照预设速度沿轨道行驶；
[0012] 处理器模块接收多普勒导航模块发送的速度信息和摄像头导航模块发送的角度 信息，根据存储的模拟天体在平面场地中的坐标，调用组合自主导航算法计算巡迹小车的 坐标，并将速度信息、角度信息和坐标信息一起发送给通信模块；
[0013] 通信模块接收处理器模块发送的巡迹小车的速度信息、角度信息和坐标信息，上 传至上位机；
[0014] 上位机接收设置的波源频率信息，生成波源参数设置信号发送给模块天体上的多 普勒波源模块；接收巡迹小车的速度信息、角度信息和坐标信息进行显示，并根据坐标信息 拟合得到巡迹小车的轨迹，通过对比该轨迹与轨道的实际轨迹的相似度，判断得到组合自 主导航算法的性能。
[0015] 本发明组合自主导航系统的地面半物理仿真平台，在平面场地内设置模拟天体和 轨道，模块天体上设置有多普勒波源，巡迹小车模拟飞行器W预设速度沿轨道运动，在运动 过程中由巡迹小车上搭载的多普勒导航模块和摄像头导航模块分别模拟红移测速导航系 统和天文测角导航系统，得到巡迹小车的速度和与模拟天体的角度，再由巡迹小车上的处 理器模块计算得到巡迹小车的坐标并上传至上位机，上位机根据坐标信息拟合得到巡迹小 车的轨迹，再与轨道的实际轨迹进行对比，通过该轨迹与轨道的实际轨迹的相似度来判断 得到组合自主导航算法的性能。本发明通过巡迹小车的运动模拟了飞行器的飞行过程，相 对于现有的软件模拟和W计算机为主的半物理模拟，其仿真程度更高，提高了对深空探测 飞行环境的模拟精度，从而提高对组合自主导航系统定位、定速能力的评估准确度。
【附图说明】
[0016] 图1是本发明组合自主导航系统的地面半物理仿真平台的结构图；
[0017] 图2是巡迹小车的结构示意图；
[0018] 图3是巡迹小车与模拟天体角度计算的原理示意图；
[0019] 图4是摄像头导航模块的结构示意图；
[0020] 图5是巡迹控制模块的结构示意图；
[0021] 图6是组合自主导航系统的地面半物理仿真平台的示例图。
【具体实施方式】
[0022] 下面结合附图对本发明的【具体实施方式】进行描述，W便本领域的技术人员更好地 理解本发明。需要特别提醒注意的是，在W下的描述中，当已知功能和设计的详细描述也许 会淡化本发明的主要内容时，该些描述在该里将被忽略。
[0023] 实施例
[0024] 图1是组合自主导航系统的地面半物理仿真平台的结构示意图。如图1所示，本 发明组合自主导航系统的地面半物理仿真平台包括模拟天体1、轨道2、巡迹小车3、和上位 机4。
[0025] 模拟天体1的数量根据实际情况设置，至少为两个，模拟天体1在平面场地内固定 放置，其位置要求为：巡迹小车3在沿轨道2运动过程中，始终至少有两个模拟天体位于巡 迹小车3上搭载的摄像头导航模块32的视场内。模拟天体之间根据颜色或形状区分，每个 模拟天体上设置有多普勒波源，多普勒波源的频率和功率根据从上位机接收的波源参数设 置信号进行设置。
[0026] 多普勒波源和巡迹小车3上搭载的多普勒导航模块31配合，根据波的多普勒效应 来计算巡迹小车3与模拟天体1之间的相对速度。在常用的波源中，电磁波W光速传播，传 播速度快，由于巡迹小车3的移动速度与光速差异大，直接采用电磁波进行多普勒效应会 引入较大测量误差。因此在本实施例中，将电磁波替换为超声波，由于超声波速度较低，频 率较高，W超声波代替电磁波的多普勒效应更为显著。
[0027] 轨道2铺设在平面场地内，其轨迹根据实际需要设置。轨道2的材质根据所采用 的巡迹方法设置。例如采用电磁巡线方式，那么轨道2为电线，如果采用光电或摄像头的巡 线方式，则将轨道2涂成黑色或贴上黑色的胶布即可。
[002引图2是巡迹小车的结构示意图。如图2所示，巡迹小车3上搭载有多普勒导航模 块31、摄像头导航模块32、巡迹控制模块33、处理器模块34和通信模块35。
[0029] 多普勒导航模块31用于模拟红移测速导航系统，它在巡迹小车3运动过程中接收 模拟天体1波源所发出的信号，根据多普勒效应计算巡迹小车3相对于模拟天体1的速度， 发送给处理器模块34。
[0030] 摄像头导航模块32用于模拟天文测角导航系统，其视线方向应当与巡迹小车的 运动方向相同。摄像头导航模块32在巡迹小车3运动过程中持续拍摄模拟天体1的图像， 对图像中的模拟天体1进行识别，根据模拟天体图像在图像中的位置，计算巡迹小车3当前 在平面场地中与模拟天体1位置的几何角度，一般来说就是巡迹小车3与模拟天体1中两 个模拟天体之间的夹角，发送给处理器模块34。
[0031] 图3是巡迹小车与模拟天体角度计算的原理示意图。如图3所示，摄像头导航模 块32的视线方向始终垂直于所拍摄图像，并且位于所拍摄图像的中心从图像中可W知道 模拟天体1在图像上与图像中线的距离li和12。由于摄像头导航模块32的视角r和图像 的宽度L是已知的，因此就