航向的确定方法、设备、存储介质和可移动平台与流程

文档序号:21108008发布日期:2020-06-16 21:29阅读:361来源:国知局
航向的确定方法、设备、存储介质和可移动平台与流程

本发明实施例涉及控制技术领域,尤其涉及一种航向的确定方法、一种航向的确定设备、一种计算机可读存储介质和一种可移动平台。



背景技术:

从上个世纪年代以来,国内外就己经在卫星定位和定向测姿等领域进行了广泛的研究,与其他定向测姿系统相比,它具有成本低、体积小、精度高而稳定等优点,主流的定向测姿技术是基于载波信息相位差分技术实现,载波信息相位差分技术又称为rtk(realtimekinematic)技术,是建立在实时处理两个测站的载波信息相位基础上的,它能实时提供观测点的三维坐标,并达到厘米级的高精度。

与伪距差分原理相同,由基准站通过数据链实时将其载波信息观测量及站坐标信息一同传送给用户站。用户站接收gps卫星的载波信息相位与来自基准站的载波信息相位,并组成相位差分观测值(静态、快速静态和动态等)进行实时处理,能实时给出厘米级的定位结果。

相关技术中,将基于rtk技术开发的定位板卡(后文简称rtk板卡)输出的测量航向反馈至可移动平台的飞行控制器,飞行控制器根据测量航向实时调整飞行轨迹,因此,测量航向的准确度决定了可移动平台的飞行轨迹的准确度,但是,rtk板卡输出的测量航向是否可信却无从判断,这就可能导致可移动平台偏离预设的飞行轨迹,甚至丢失,造成严重的经济损失。



技术实现要素:

本发明的实施例旨在提供了一种航向的确定方法、航向的确定设备、可移动平台和计算机可读存储介质,以在输出测量航向的同时,确定测量航向是否为可信航向,进而提高测量航向和飞行轨迹的准确性。

为了实现上述目的,本发明的第一方面的技术方案,提高了一种航向的确定方法,包括:获取双rtk天线组件的基线的当前测量长度以及当前测量航向;根据所述双rtk天线组件的基线的当前测量长度,确定所述当前测量航向是否为可信航向;若是,则输出所述当前测量航向。

本发明的第二方面的技术方案提供了一种航向的确定设备,所述航向的确定设备包括处理器,所述处理器用于:获取双rtk天线组件的基线的当前测量长度以及当前测量航向;根据所述双rtk天线组件的基线的当前测量长度,确定所述当前测量航向是否为可信航向;若是,则输出所述当前测量航向。

本发明的第三方面的技术方案,提供了一种计算机可读存储介质,其上存储有计算机程序,其特征在于,计算机程序被执行时实现如本发明的实施例第一方面提供的航向的确定方法的步骤。

本发明的第四方面的技术方案,提供了一种可移动平台,包括:动力设装置,其被配置为实现所述可移动平台的移动;根据本发明的第二方面的技术方案限定的航向的确定设备,所述航向的确定设备被配置为确定测量航向的可信度。

基于本发明实施例提供的航向的确定方法、航向的确定设备、可移动平台和计算机可读存储介质,通过基线的当前测量长度来确定当前测量航向的可信度,尤其是,在当前测量航向不可信时,能够及时再次触发进行当前航向的测量,至输出的测量航向为可信航向为止,另外,在当前测量航向可信时,及时将当前测量航向提供至飞行控制器,以供飞行控制器实时调整和监控飞行轨迹,进而提升了可移动平台在执行飞行作业时的准确度和可靠性,降低了可移动平台遗失的可能性。

附图说明

为了更清楚地说明本发明的实施例中的技术方案,下面将对实施例描述中所需要使用的附图作一简单地介绍,显而易见地,下面描述中的附图是本发明的一些实施例,对于本领域普通技术人员来讲,在不付出创造性劳动性的前提下,还可以根据这些附图获得其他的附图。

图1示出了本发明的一个实施例的可移动平台系统的示意图;

图2示出了本发明的一个实施例的可移动平台的双rtk天线组件的示意图;

图3示出了本发明的一个实施例的航向的确定方案的示意图;

图4示出了本发明的另一个实施例的航向的确定方法的示意图;

图5示出了本发明的另一个实施例的计算机可读存储介质的示意图。

具体实施方式

下面将结合本发明的实施例中的附图,对本发明的实施例中的技术方案进行清楚地描述,显然,所描述的实施例仅仅是本发明一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都属于本发明保护的范围。

需要说明的是,当组件被称为“固定于”另一个组件,它可以直接在另一个组件上或者也可以存在居中的组件。当一个组件被认为是“连接”另一个组件,它可以是直接连接到另一个组件或者可能同时存在居中组件。

除非另有定义,本文所使用的所有的技术和科学术语与属于本发明的技术领域的技术人员通常理解的含义相同。本文中在本发明的说明书中所使用的术语只是为了描述具体的实施例的目的,不是旨在于限制本发明。本文所使用的术语“及/或”包括一个或多个相关的所列项目的任意的和所有的组合。

航向的确定方法,包括利用rtk进行确定,例如,通过可移动平台的双天线、可移动平台的单天线以及基站进行定向。该可移动平台可以是飞行器、手持测绘装置、汽车、船舶等。该方法可以用于可移动平台出厂检测、可移动平台轨迹校正、可移动平台作业等场景。

在一些实施例中,获取双rtk天线组件的基线的当前测量长度以及当前测量航向;根据所述双rtk天线组件的基线的当前测量长度,确定所述当前测量航向是否为可信航向,最终输出可信的当前测量航向。

在一些实施例中,获取双rtk天线组件的基线的当前测量长度以及当前测量航向;根据所述双rtk天线组件的基线的当前测量长度,确定所述当前测量航向是否为可信航向,当当前测量航向不可信时,能够发出提示信息,例如报警信息。

在一些实施例中,获取双rtk天线组件的基线的当前测量长度以及当前测量航向;根据所述双rtk天线组件的基线的当前测量长度,最终输出当前测量航向以及可移动平台的姿态。

下面结合附图,对本发明的一些实施方式作详细说明。在不冲突的情况下,下述的实施例及实施例中的特征可以相互组合。

如图1所示,可移动平台系统10可以包括控制终端110和可移动平台120。其中,可移动平台120可以单旋翼或者多旋翼可移动平台,在某些情况中,可移动平台120可以为固定翼可移动平台。

可移动平台120可以包括动力系统102、飞行控制系统104(内置有航向的确定系统)和机身。其中,当可移动平台120具体为多旋翼可移动平台时,机身可以包括中心架以及与中心架连接的一个或多个机臂,一个或多个机臂呈辐射状从中心架延伸出。可移动平台还可以包括脚架,其中,脚架与机身连接,用于在可移动平台着陆时起支撑作用。

动力系统102可以包括一个或多个动力部件1022,动力部件1022用于为可移动平台120提供飞行动力,该动力使得可移动平台120能够实现一个或多个自由度的运动。

航向的确定系统可以包括处理器502、存储器1044和传感系统1046。传感系统1046包括一种或者多种类型的传感器,其中,所述传感系统1046可以输出传输传感数据以测量可移动平台120的状态数据。其中,传感系统1046例如可以包括气压计、陀螺仪、超声传感器、电子罗盘、惯性测量单元、视觉传感器(单目传感器或者双目传感器)、全球导航卫星系统和气压计等传感器中的至少一种。例如,全球导航卫星系统可以是全球定位系统(globalpositioningsystem,gps)。

处理器502用于控制可移动平台的各种操作。例如,处理器502可以控制可移动平台的移动,再例如,处理器502可以控制可移动平台的传感系统1046采集数据。

在诸多实施例中,传感系统1046可以包括图像采集设备1064,图像采集设备1064例如可以是照相机或摄像机等用于捕获图像的设备,图像采集设备1064可以与处理器502通信,并在处理器502的航向的确定下进行拍摄。

在一些实施例中,可移动平台120还包括云台106,云台106可以包括电机1062,云台106用于携带图像采集设备1064,处理器502可以通过电机航向的确定云台106的运动。应理解,云台106可以独立于可移动平台120,也可以为可移动平台120的一部分。在一些实施例中,图像采集设备1064可以固定连接在可移动平台120的机身上。

可移动平台120还包括传输设备112,在处理器502的航向的确定下,传输设备112可以将传感系统1046和/或图像采集设备1064采集的数据发送到控制终端110。控制终端110可以包括传输设备(未示出),航向的确定终端的传输设备可以与可移动平台120的传输设备112建立无线通信连接,航向的确定终端的传输设备可以接收传输设备112发送的数据,另外,控制终端110还可以通过自身配置的传输设备向可移动平台120发送航向的确定指令。

控制终端110可以包括控制器1102和显示设备1104。控制器1102可以航向的确定航向的确定终端的各种操作。例如,控制器1102可以航向的确定传输设备接收可移动平台120通过传输设备112发送的数据,再例如,显示设备1104可以航向的确定显示设备1104显示发送的数据,其中,数据可以包括图像采集设备1064捕捉的环境的图像、姿态信息、位置信息和电量信息等等。

可移动平台120还包括电池系统108,电池系统108可以包括电池1082和bms(batterymanagementsystem,电池管理系统)1084,默认采用电池1082对可移动平台120供电,譬如,对动力部件1022、传输设备112、云台106、图像采集设备1064等硬件电子器件进行供电。

另外,结合图1和图2可知,可移动平台120上设有双rtk天线组件114,具体包括主rtk天线和从rtk天线,根据定位卫星发送的载波信息解算基线的测量长度,并根据测量长度继续得到测量航向。

可以理解的是,上述任一航向的确定器可以包括一个或多个处理器,其中,一个或多个处理器可以单独地或者协同地工作。

应理解,上述对于可移动平台120的各组成部分的命名仅是出于标识的目的,并不应理解为对本发明的实施例的限制。

结合图1、图2、图3和图4所示,根据本发明实施例提供的航向的确定方法,具体包括:

步骤s302,获取双rtk天线组件的基线的当前测量长度以及当前测量航向。

具体地,定位卫星发送至双rtk天线组件的载波信息,由定位卫星传播到双rtk天线组件需要一定时间,即传输时延。众所周知,载波信息的传输时延与传输的距离成正比,主rtk天线和从rtk天线到定位卫星的距离不同时,主rtk天线和从rtk天线接收的连续载波信息在同一时刻将具有不相同的相位,即相位差,进一步地结合整周模糊度和相位差,来计算基线的当前测量长度以及当前测量航向。

步骤s304,根据所述双rtk天线组件的基线的当前测量长度,确定所述当前测量航向是否为可信航向。

具体地,由于双rtk天线组件的基线存在实际基线尺寸,因此,计算得到的基线的当前测量长度与实际基线尺寸之间存在误差,基于此可以确定解算的基线的当前测量长度是否可信。如果基线的当前测量长度不可信,则需要重新执行步骤s302,至基线的当前测量长度处于误差允许的范围。在一个实施例中,如果基线的当前测量长度不可信,还可将基线的当前测量长度与其他数据进行融合,从而得到可信的当前测量长度。

步骤s306,若是,则输出所述当前测量航向。

具体地,通过在确定当前测量航向为可信航向时,输出当前测量航向,以供飞行控制系统来反馈调节可移动平台的飞行轨迹。

基于本发明实施例提供的航向的确定方法,双rtk天线组件在接收到定位卫星的载波信息时,可能由于搜星情况差,或存在多径干扰,或可移动平台处于室内时,通常双rtk天线组件解算得到的基线的当前测量长度是存在较大误差的,进而导致了当前测量航向存在更大的误差,而通过基线的当前测量长度来校验当前测量航向是否可信,能够提高双rtk天线组件对可移动平台进行定向测姿的可靠性和准确性。

在一些实施例中,所述获取双rtk天线组件的基线的当前测量长度以及当前测量航向,包括:接收定位卫星发送的载波信息,所述载波信息用于确定双rtk天线组件的基线的当前测量长度和当前测量航向。

具体地,接收定位卫星发送的载波信息,所述载波信息用于确定双rtk天线组件的基线的当前测量长度和当前测量航向,也即基于相位差解算获得基线的当前测量长度和当前测量航向。

在一些实施例中,所述双rtk天线组件用于接收定位卫星发送的载波信息。

在一些实施例中,双rtk天线组件包括主rtk天线以及从rtk天线,所述获取双rtk天线组件的基线的当前测量长度以及当前测量航向,包括:确定所述主rtk天线的载波信息相位和所述从rtk天线的载波信息相位;计算所述主rtk天线的载波信息相位和所述从rtk天线的载波信息相位之间的差值,并记作单差观测值;根据所述单差观测值生成所述双rtk天线组件的基线的当前测量长度以及当前测量航向。

具体地,通过确定所述主rtk天线的载波信息相位和所述从rtk天线的载波信息相位,并计算所述主rtk天线的载波信息相位和所述从rtk天线的载波信息相位之间的差值,并记作单差观测值,最后,根据所述单差观测值生成所述双rtk天线组件的基线的当前测量长度以及当前测量航向,能够将双rtk天线组件的定位精度提高到厘米级别。

其中,单差观测值的计算过程还加入时钟偏差、整周模糊度、传输系统的延迟误差、定位卫星的星历误差等,以进一步地提高解算基线的当前测量长度以及当前测量航向的可信度。

在一些实施例中,根据所述双rtk天线组件的基线的当前测量长度,确定所述当前测量航向是否为可信航向,具体包括:根据所述基线的当前测量长度是否满足预设误差范围,确定所述当前测量航向是否为可信航向。

具体地,通过比较所述基线的当前测量长度是否满足预设误差范围,可以判断双rtk天线组件的定位方案是否满足预设误差,因此,在判定基线的当前测量长度满足预设误差范围时,则可以确定根据基线的当前测量长度计算得到的当前测量航向也是可信的。

在一些实施例中,在获取双rtk天线组件的基线的当前测量长度前,还包括:根据所述双rtk天线组件的基线尺寸确定所述预设误差范围;根据所述误差范围和所述基线尺寸确定所述预设基线长度,并存储。

具体地,由于双rtk天线组件的基线尺寸直接关系于所述预设误差范围,因此,根据所述双rtk天线组件的基线尺寸确定所述预设误差范围,能够提高误差范围的可靠性和准确性,进而通过根据所述误差范围和所述基线尺寸确定所述预设基线长度,并存储,能够进一步地提高基线的当前测量长度是否可信,进而能够进一步地提高判断当前测量航向是否为可信航向的方案可靠性和准确性。

在一些实施例中,所述基线尺寸与所述误差范围之间为正相关。

具体地,也即如果实际的基线尺寸越大,则误差范围越大,也即当前测量航向的置信区间越大,同时,实际的基线尺寸越小,则误差范围越小,也即当前测量航向的置信区间越小。

在一些实施例中,在获取双rtk天线组件的基线的当前测量长度前,还包括:获取历史测量航向是否为可信航向的记录,确定所述预设基线长度,并存储。

具体地,通过获取历史测量航向是否为可信航向的记录,确定所述预设基线长度,并存储,历史测量航向也是基于基线长度解算的,历史测量航向更加符合可移动平台的实际飞行环境,因此,结合大量的历史测量航向,可以提供一个更符合实际飞行环境的预设基线长度,进而能够更加准确地根据预设基线长度和基线的当前测量长度,判断当前测量航向是否为可信航向。

在一些实施例中,所述误差范围小于或等于20厘米。

具体地,基于大量实验数据可以确定,误差范围小于或等于20厘米。

在一些实施例中,还包括:根据搜星情况获取对应的状态标识信息。

具体地,通过搜星情况获取对应的状态标识信息,状态标识信息辅助判断基线的当前测量长度是否可信,进而确定所述当前测量航向是否为可信航向。

其中,双rtk天线组件输出的状态标识信息具体如下表1:

表1

在一些实施例中,根据所述双rtk天线组件的基线的当前测量长度,确定所述当前测量航向是否为可信航向,具体包括:根据所述双rtk天线组件的基线的当前测量长度和所述状态标识信息,确定所述当前测量航向是否为可信航向。

具体地,根据双rtk天线组件的基线的当前测量长度,如表1所示,在状态标识信息为50的情况下,通过比较基线的当前测量长度与预设基线长度,从而判读出当前测量航向是否可信,从而减少了由于双rtk天线组件的误判导致可移动平台采用了错误的航向信息的情况,进而提升了可移动平台的飞行轨迹的准确性和可靠性。

在一些实施例中,所述搜星情况包括以下至少一项:搜到的卫星的数目、信噪比、仰角、锁定时间、定位信息。

例如,可移动平台在市区飞行时,由于高楼大厦较多,信号的传播过程受到干扰,导致了信号的衰落和相移,导致双rtk天线组件接收的信号不准确等问题。

例如,在低纬度地区,电离层活动较为活跃,会导致卫星的观测信噪比波动、信号频繁失锁、解算误差大等问题。

又例如,双rtk天线组件自身的设计不好,导致收到的卫星信号的信噪比较低和不稳定,过滤杂波能力差,信号容易丢失等问题。

再例如,搜星速度过快,容易引起漂移,即定位不准确,定位跑偏的现象。

在一些实施例中,所述根据搜星情况获取对应的状态标识信息,包括:根据搜星情况获取窄巷固定解或所述状态标识信息中的其他预存标识信息。

具体地,窄巷固定解涉及主rtk天线和从rtk天线的载波信息相位观测之和,窄巷固定解对应的载波信息的有效波长为10.7厘米,窄巷固定解在消除电离层对当前测量航向的影响非常有效,其他预存标识信息可以参考表1所示,但不限于此。

在一些实施例中,根据所述双rtk天线组件的基线的当前测量长度和所述状态标识信息,确定所述当前测量航向是否为可信航向,具体包括:在检测到所述状态标识信息为所述窄巷固定解时,比较所述基线的当前测量长度是否满足预设误差范围。

具体地,通过在检测到所述状态标识信息为所述窄巷固定解时,比较所述基线的当前测量长度是否满足预设误差范围,也即根据基线的当前测量长度来校验窄巷固定解是否可信。若是,则判定所述当前测量航向可信,并输出所述当前测量航向。若否,则重复上述步骤。在一些实施例中,所述当前测量航向包括偏航角和/或俯仰角;其中,所述偏航角为根据所述可移动平台的机头方向与预设航向确定的夹角,所述俯仰角为根据所述可移动平台的机身方向与水平方向确定的夹角。

在一些实施例中,根据所述单差观测值生成所述基线的当前测量长度和所述当前测量航向,具体包括:在第一坐标系中,根据所述单差观测值和对应的整周模糊度计算获得基线的测量结果;根据预设的坐标旋转矩阵将所述基线的测量结果由第一坐标系转换至第二坐标系,以确定所述主rtk天线对应的经度坐标和纬度坐标;根据所述经度坐标和所述纬度坐标确定所述当前测量航向。

具体地,在第一坐标系中,根据所述单差观测值和对应的整周模糊度计算获得基线的测量结果,进而根据预设的坐标旋转矩阵将所述基线的测量结果由第一坐标系转换至第二坐标系,以确定所述主rtk天线对应的经度坐标和纬度坐标,最后,根据所述经度坐标和所述纬度坐标确定所述当前测量航向,使得当前测量航向的精度提高至厘米级。

在一些实施例中,所述第一坐标系包括地心坐标系。

在一些实施例中,所述第二坐标系包括北天东坐标系。

在一些实施例中,输出所述当前测量航向,包括将当前测量航向发送给终端设备。终端设备可以是可移动平台,即双rtk天线组件的载体,还可以是遥控端,手机app。当输出所述当前测量航向时,用户能够得知该当前测量航向信息。

在一些实施例中,输出所述当前测量航向,还包括控制报警装置发出警报信息。当双rtk天线组件的载体距离障碍物较近,或者依据当前测量航向前进有撞到障碍物的风险时,这时报警装置将被控制,并发出警报信息。报警装置可以是可移动平台,即双rtk天线组件的载体,还可以是遥控端,手机app。警报信息可以通过报警灯发光、扬声器发出警报声音,或者振动器产生振动而发出。

下面根据图4对上述一些实施例的具体步骤进行说明:

如图4所示,可移动平台的航向的确定方法包括:步骤s402,获取双rtk天线组件的基线的当前测量长度以及当前测量航向;步骤s404,根据搜星情况获取对应的状态标识信息;步骤s406,判断状态标识信息是否为窄巷固定解,若是,则执行步骤s408,若否,则执行步骤s402;步骤s408,比较所述基线的当前测量长度是否满足预设误差范围,若是,则执行步骤s410,若否,则执行步骤s402;步骤s410,输出所述当前测量航向。

如图5所示,与上述航向的确定方法相对于的航向的确定设备500,具体包括的硬件装置和实现方案如下:

所述航向的确定设备包括处理器502,还包括双rtk天线组件504。

在一些实施例中,所述处理器502用于:

获取双rtk天线组件504的基线的当前测量长度以及当前测量航向。

具体地,定位卫星发送至双rtk天线组件504的载波信息,由定位卫星传播到双rtk天线组件504需要一定时间,即传输时延。众所周知,载波信息的传输时延与传输的距离成正比,主rtk天线和从rtk天线到定位卫星的距离不同时,主rtk天线和从rtk天线接收的连续载波信息在同一时刻将具有不相同的相位,即相位差,进一步地结合整周模糊度和相位差,来计算基线的当前测量长度以及当前测量航向。

所述处理器502根据所述双rtk天线组件504的基线的当前测量长度,确定所述当前测量航向是否为可信航向;若否,重复上述步骤。

具体地,由于双rtk天线组件504的基线存在实际基线尺寸,因此,计算得到的基线的当前测量长度与实际基线尺寸之间存在误差,基于此可以确定解算的基线的当前测量长度是否可信,如果基线的当前测量长度不可信,则需要重新执行,至基线的当前测量长度处于误差允许的范围。

所述处理器502还用于:若确定所述当前测量航向是否为可信航向,则输出所述当前测量航向。

具体地,通过在确定当前测量航向为可信航向时,输出当前测量航向,以供飞行控制系统来反馈调节可移动平台的飞行轨迹。

基于本发明实施例提供的航向的确定方法,双rtk天线组件504在接收到定位卫星的载波信息时,可能由于搜星情况差,或存在多径干扰,或可移动平台处于室内时,通常双rtk天线组件504解算得到的基线的当前测量长度是存在较大误差的,进而导致了当前测量航向存在更大的误差,而通过基线的当前测量长度来校验当前测量航向是否可信,能够提高双rtk天线组件504对可移动平台进行定向测姿的可靠性和准确性。

在一些实施例中,所述处理器502所述获取双rtk天线组件504的基线的当前测量长度以及当前测量航向,包括:接收定位卫星发送的载波信息,所述载波信息用于确定双rtk天线组件504的基线的当前测量长度和当前测量航向。

具体地,接收定位卫星发送的载波信息,所述载波信息用于确定双rtk天线组件504的基线的当前测量长度和当前测量航向,也即基于相位差解算获得基线的当前测量长度和当前测量航向。

在一些实施例中,所述双rtk天线组件504用于接收定位卫星发送的载波信息。所述载波信息用于确定双rtk天线组件的基线的当前测量长度和当前测量航向。

在一些实施例中,双rtk天线组件504包括主rtk天线以及从rtk天线,所述处理器502所述获取双rtk天线组件504的基线的当前测量长度以及当前测量航向,包括:确定所述主rtk天线的载波信息相位和所述从rtk天线的载波信息相位;计算所述主rtk天线的载波信息相位和所述从rtk天线的载波信息相位之间的差值,并记作单差观测值;根据所述单差观测值生成所述双rtk天线组件504的基线的当前测量长度以及当前测量航向。

具体地,通过确定所述主rtk天线的载波信息相位和所述从rtk天线的载波信息相位,并计算所述主rtk天线的载波信息相位和所述从rtk天线的载波信息相位之间的差值,并记作单差观测值,最后,根据所述单差观测值生成所述双rtk天线组件504的基线的当前测量长度以及当前测量航向,能够将双rtk天线组件504的定位精度提高到厘米级别。

其中,单差观测值的计算过程还加入时钟偏差、整周模糊度、传输系统的延迟误差、定位卫星的星历误差等,以进一步地提高解算基线的当前测量长度以及当前测量航向的可信度。

在一些实施例中,所述处理器502根据所述双rtk天线组件504的基线的当前测量长度,确定所述当前测量航向是否为可信航向,具体包括:比较所述基线的当前测量长度是否满足预设误差范围;若否,则重复上述步骤;若是,则判定所述当前测量航向可信,并输出所述当前测量航向。

具体地,通过比较所述基线的当前测量长度是否满足预设误差范围,可以判断双rtk天线组件504的定位方案是否满足预设误差,因此,在判定基线的当前测量长度满足预设误差范围时,则可以确定根据基线的当前测量长度计算得到的当前测量航向也是可信的。

在一些实施例中,所述处理器502在获取双rtk天线组件504的基线的当前测量长度前,还用于:根据所述双rtk天线组件504的基线尺寸确定所述预设误差范围;根据所述误差范围和所述基线尺寸确定所述预设基线长度,并存储。

具体地,由于双rtk天线组件504的基线尺寸直接关系于所述预设误差范围,因此,根据所述双rtk天线组件504的基线尺寸确定所述预设误差范围,能够提高误差范围的可靠性和准确性,进而通过根据所述误差范围和所述基线尺寸确定所述预设基线长度,并存储,能够进一步地提高基线的当前测量长度是否可信,进而能够进一步地提高判断当前测量航向是否为可信航向的方案可靠性和准确性。

在一些实施例中,所述基线尺寸与所述误差范围之间为正相关。

具体地,也即如果实际的基线尺寸越大,则误差范围越大,也即当前测量航向的置信区间越大,同时,实际的基线尺寸越小,则误差范围越小,也即当前测量航向的置信区间越小。

在一些实施例中,所述处理器502在获取双rtk天线组件504的基线的当前测量长度前,还用于:获取历史测量航向是否为可信航向的记录,确定所述预设基线长度,并存储。

具体地,通过获取历史测量航向是否为可信航向的记录,确定所述预设基线长度,并存储,历史测量航向也是基于基线长度解算的,历史测量航向更加符合可移动平台的实际飞行环境,因此,结合大量的历史测量航向,可以提供一个更符合实际飞行环境的预设基线长度,进而能够更加准确地根据预设基线长度和基线的当前测量长度,判断当前测量航向是否为可信航向。

在一些实施例中,所述误差范围小于或等于20厘米。

具体地,基于大量实验数据可以确定,误差范围小于或等于20厘米。

在一些实施例中,所述处理器502还用于:根据搜星情况获取对应的状态标识信息。

具体地,通过搜星情况获取对应的状态标识信息,状态标识信息辅助判断基线的当前测量长度是否可信,进而确定所述当前测量航向是否为可信航向。

其中,双rtk天线组件504输出的状态标识信息具体如表1所示。

在一些实施例中,所述处理器502根据所述双rtk天线组件504的基线的当前测量长度,确定所述当前测量航向是否为可信航向,具体包括:根据所述双rtk天线组件504的基线的当前测量长度和所述状态标识信息,确定所述当前测量航向是否为可信航向。

具体地,根据双rtk天线组件504的基线的当前测量长度,如表1所示,在状态标识信息为50的情况下,通过比较基线的当前测量长度与预设基线长度,从而判读出当前测量航向是否可信,从而减少了由于双rtk天线组件504的误判导致可移动平台采用了错误的航向信息的情况,进而提升了可移动平台的飞行轨迹的准确性和可靠性。

在一些实施例中,所述搜星情况包括以下至少一项:搜到的卫星的数目、信噪比、仰角、锁定时间、定位信息。

在一些实施例中,所述处理器502所述根据搜星情况获取对应的状态标识信息,包括:根据搜星情况获取窄巷固定解或所述状态标识信息中的其他预存标识信息。

具体地,窄巷固定解涉及主rtk天线和从rtk天线的载波信息相位观测之和,窄巷固定解对应的载波信息的有效波长为10.7厘米,窄巷固定解在消除电离层对当前测量航向的影响非常有效,其他预存标识信息可以参考表1所示,但不限于此。

在一些实施例中,所述处理器502根据所述双rtk天线组件504的基线的当前测量长度和所述状态标识信息,确定所述当前测量航向是否为可信航向,具体包括:在检测到所述状态标识信息为所述窄巷固定解时,比较所述基线的当前测量长度是否满足预设误差范围。

具体地,通过在检测到所述状态标识信息为所述窄巷固定解时,比较所述基线的当前测量长度是否满足预设误差范围,也即根据基线的当前测量长度来校验窄巷固定解是否可信。若所述基线的当前测量长度满足预设误差范围,则判定所述当前测量航向可信,并输出所述当前测量航向;若否,则重复上述步骤。

在一些实施例中,所述当前测量航向包括偏航角和/或俯仰角;其中,所述偏航角为根据所述可移动平台的机头方向与预设航向确定的夹角,所述俯仰角为根据所述可移动平台的机身方向与水平方向确定的夹角。

在一些实施例中,所述处理器502根据所述单差观测值生成所述基线的当前测量长度和所述当前测量航向,具体包括:在第一坐标系中,根据所述单差观测值和对应的整周模糊度计算获得基线的测量结果;根据预设的坐标旋转矩阵将所述基线的测量结果由第一坐标系转换至第二坐标系,以确定所述主rtk天线对应的经度坐标和纬度坐标;根据所述经度坐标和所述纬度坐标确定所述当前测量航向。

具体地,在第一坐标系中,根据所述单差观测值和对应的整周模糊度计算获得基线的测量结果,进而根据预设的坐标旋转矩阵将所述基线的测量结果由第一坐标系转换至第二坐标系,以确定所述主rtk天线对应的经度坐标和纬度坐标,最后,根据所述经度坐标和所述纬度坐标确定所述当前测量航向,使得当前测量航向的精度提高至厘米级。

在一些实施例中,所述第一坐标系包括地心坐标系。

在一些实施例中,所述第二坐标系包括北天东坐标系。

如图5所示,本发明的实施例提供了一种计算机可读存储介质600,航向的确定设备500上设有处理器502和存储器1044,计算机可读存储介质600,其上存储有计算机程序602,计算机程序602被处理器502执行时实现如上任一实施例限定的航向的确定方法的步骤。

上述处理器502可以是中央处理单元(centralprocessingunit,cpu),该处理器502还可以是其他通用处理器、数字信号处理器(digitalsignalprocessor,dsp)、专用集成电路(applicationspecificintegratedcircuit,asic)、现成可编程门阵列(field-programmablegatearray,fpga)或者其他可编程逻辑器件、分立门或者晶体管逻辑器件、分立硬件组件等。通用处理器可以是微处理器或者该处理器也可以是任何常规的处理器等。

其中,存储器1044用于存储程序代码和记录状态数据。

在一些实施例中,处理器502执行计算机程序602,以实现航向的确定方法,具体执行以下步骤:

获取双rtk天线组件504的基线的当前测量长度以及当前测量航向。

具体地,定位卫星发送至双rtk天线组件504的载波信息,由定位卫星传播到双rtk天线组件504需要一定时间,即传输时延。众所周知,载波信息的传输时延与传输的距离成正比,主rtk天线和从rtk天线到定位卫星的距离不同时,主rtk天线和从rtk天线接收的连续载波信息在同一时刻将具有不相同的相位,即相位差,进一步地结合整周模糊度和相位差,来计算基线的当前测量长度以及当前测量航向。

根据所述双rtk天线组件504的基线的当前测量长度,确定所述当前测量航向是否为可信航向,若否,重复上述步骤。

具体地,由于双rtk天线组件504的基线存在实际基线尺寸,因此,计算得到的基线的当前测量长度与实际基线尺寸之间存在误差,基于此可以确定解算的基线的当前测量长度是否可信,如果基线的当前测量长度不可信,则需要重新执行,至基线的当前测量长度处于误差允许的范围。

若是,则输出所述当前测量航向。

具体地,通过在确定当前测量航向为可信航向时,输出当前测量航向,以供飞行控制系统来反馈调节可移动平台的飞行轨迹。

基于本发明实施例提供的航向的确定方法,双rtk天线组件504在接收到定位卫星的载波信息时,可能由于搜星情况差,或存在多径干扰,或可移动平台处于室内时,通常双rtk天线组件504解算得到的基线的当前测量长度是存在较大误差的,进而导致了当前测量航向存在更大的误差,而通过基线的当前测量长度来校验当前测量航向是否可信,能够提高双rtk天线组件504对可移动平台进行定向测姿的可靠性和准确性。

在一些实施例中,所述获取双rtk天线组件504的基线的当前测量长度以及当前测量航向,包括:接收定位卫星发送的载波信息,所述载波信息用于确定双rtk天线组件504的基线的当前测量长度和当前测量航向。

具体地,接收定位卫星发送的载波信息,所述载波信息用于确定双rtk天线组件504的基线的当前测量长度和当前测量航向,也即基于相位差解算获得基线的当前测量长度和当前测量航向。

在一些实施例中,所述双rtk天线组件504用于接收定位卫星发送的载波信息。

在一些实施例中,双rtk天线组件504包括主rtk天线以及从rtk天线,所述获取双rtk天线组件504的基线的当前测量长度以及当前测量航向,包括:确定所述主rtk天线的载波信息相位和所述从rtk天线的载波信息相位;计算所述主rtk天线的载波信息相位和所述从rtk天线的载波信息相位之间的差值,并记作单差观测值;根据所述单差观测值生成所述双rtk天线组件504的基线的当前测量长度以及当前测量航向。

具体地,通过确定所述主rtk天线的载波信息相位和所述从rtk天线的载波信息相位,并计算所述主rtk天线的载波信息相位和所述从rtk天线的载波信息相位之间的差值,并记作单差观测值,最后,根据所述单差观测值生成所述双rtk天线组件504的基线的当前测量长度以及当前测量航向,能够将双rtk天线组件504的定位精度提高到厘米级别。

其中,单差观测值的计算过程还加入时钟偏差、整周模糊度、传输系统的延迟误差、定位卫星的星历误差等,以进一步地提高解算基线的当前测量长度以及当前测量航向的可信度。

在一些实施例中,根据所述双rtk天线组件504的基线的当前测量长度,确定所述当前测量航向是否为可信航向,具体包括:比较所述基线的当前测量长度是否满足预设误差范围;若否,则重复上述步骤;若是,则判定所述当前测量航向可信,并输出所述当前测量航向。

具体地,通过比较所述基线的当前测量长度是否满足预设误差范围,可以判断双rtk天线组件504的定位方案是否满足预设误差,因此,在判定基线的当前测量长度满足预设误差范围时,则可以确定根据基线的当前测量长度计算得到的当前测量航向也是可信的。

在一些实施例中,在获取双rtk天线组件504的基线的当前测量长度前,还包括:根据所述双rtk天线组件504的基线尺寸确定所述预设误差范围;根据所述误差范围和所述基线尺寸确定所述预设基线长度,并存储。

具体地,由于双rtk天线组件504的基线尺寸直接关系于所述预设误差范围,因此,根据所述双rtk天线组件504的基线尺寸确定所述预设误差范围,能够提高误差范围的可靠性和准确性,进而通过根据所述误差范围和所述基线尺寸确定所述预设基线长度,并存储,能够进一步地提高基线的当前测量长度是否可信,进而能够进一步地提高判断当前测量航向是否为可信航向的方案可靠性和准确性。

在一些实施例中,所述基线尺寸与所述误差范围之间为正相关。

具体地,也即如果实际的基线尺寸越大,则误差范围越大,也即当前测量航向的置信区间越大,同时,实际的基线尺寸越小,则误差范围越小,也即当前测量航向的置信区间越小。

在一些实施例中,在获取双rtk天线组件504的基线的当前测量长度前,还包括:获取历史测量航向是否为可信航向的记录,确定所述预设基线长度,并存储。

具体地,通过获取历史测量航向是否为可信航向的记录,确定所述预设基线长度,并存储,历史测量航向也是基于基线长度解算的,历史测量航向更加符合可移动平台的实际飞行环境,因此,结合大量的历史测量航向,可以提供一个更符合实际飞行环境的预设基线长度,进而能够更加准确地根据预设基线长度和基线的当前测量长度,判断当前测量航向是否为可信航向。

在一些实施例中,所述误差范围小于或等于20厘米。

具体地,基于大量实验数据可以确定,误差范围小于或等于20厘米。

在一些实施例中,还包括:根据搜星情况获取对应的状态标识信息。

具体地,通过搜星情况获取对应的状态标识信息,状态标识信息辅助判断基线的当前测量长度是否可信,进而确定所述当前测量航向是否为可信航向。

其中,双rtk天线组件504输出的状态标识信息具体如上表1所示。

在一些实施例中,根据所述双rtk天线组件504的基线的当前测量长度,确定所述当前测量航向是否为可信航向,具体包括:根据所述双rtk天线组件504的基线的当前测量长度和所述状态标识信息,确定所述当前测量航向是否为可信航向。

具体地,根据双rtk天线组件504的基线的当前测量长度,如表1所示,在状态标识信息为50的情况下,通过比较基线的当前测量长度与预设基线长度,从而判读出当前测量航向是否可信,从而减少了由于双rtk天线组件504的误判导致可移动平台采用了错误的航向信息的情况,进而提升了可移动平台的飞行轨迹的准确性和可靠性。

在一些实施例中,所述搜星情况包括以下至少一项:搜到的卫星的数目、信噪比、仰角、锁定时间、定位信息。

在一些实施例中,所述根据搜星情况获取对应的状态标识信息,包括:根据搜星情况获取窄巷固定解或所述状态标识信息中的其他预存标识信息。

具体地,窄巷固定解涉及主rtk天线和从rtk天线的载波信息相位观测之和,窄巷固定解对应的载波信息的有效波长为10.7厘米,窄巷固定解在消除电离层对当前测量航向的影响非常有效,其他预存标识信息可以参考表1所示,但不限于此。

在一些实施例中,根据所述双rtk天线组件504的基线的当前测量长度和所述状态标识信息,确定所述当前测量航向是否为可信航向,具体包括:在检测到所述状态标识信息为所述窄巷固定解时,比较所述基线的当前测量长度是否满足预设误差范围。

具体地,通过在检测到所述状态标识信息为所述窄巷固定解时,比较所述基线的当前测量长度是否满足预设误差范围,也即根据基线的当前测量长度来校验窄巷固定解是否可信。若所述基线的当前测量长度满足预设误差范围,则判定所述当前测量航向可信,并输出所述当前测量航向;若否,则重复上述步骤。

在一些实施例中,所述当前测量航向包括偏航角和/或俯仰角;其中,所述偏航角为根据所述可移动平台的机头方向与预设航向确定的夹角,所述俯仰角为根据所述可移动平台的机身方向与水平方向确定的夹角。

在一些实施例中,根据所述单差观测值生成所述基线的当前测量长度和所述当前测量航向,具体包括:在第一坐标系中,根据所述单差观测值和对应的整周模糊度计算获得基线的测量结果;根据预设的坐标旋转矩阵将所述基线的测量结果由第一坐标系转换至第二坐标系,以确定所述主rtk天线对应的经度坐标和纬度坐标;根据所述经度坐标和所述纬度坐标确定所述当前测量航向。

具体地,在第一坐标系中,根据所述单差观测值和对应的整周模糊度计算获得基线的测量结果,进而根据预设的坐标旋转矩阵将所述基线的测量结果由第一坐标系转换至第二坐标系,以确定所述主rtk天线对应的经度坐标和纬度坐标,最后,根据所述经度坐标和所述纬度坐标确定所述当前测量航向,使得当前测量航向的精度提高至厘米级。

在一些实施例中,所述第一坐标系包括地心坐标系。

在一些实施例中,所述第二坐标系包括北天东坐标系。

进一步地,可以理解的是,流程图中或在此以其他方式描述的任何过程或方法描述可以被理解为,表示包括一个或更多个用于实现特定逻辑功能或过程的步骤的可执行指令的代码的模块、片段或部分,并且本发明的优选实施方式的范围包括另外的实现,其中可以不按所示出或讨论的顺序,包括根据所涉及的功能按基本同时的方式或按相反的顺序,来执行功能,这应被本发明的实施例所属技术领域的技术人员所理解。

在流程图中表示或在此以其他方式描述的逻辑和/或步骤,例如,可以被认为是用于实现逻辑功能的可执行指令的定序列表,可以具体实现在任何计算机可读介质中,以供指令执行系统、装置或设备(如基于计算机的系统、包括处理器的系统或其他可以从指令执行系统、装置或设备取指令并执行指令的系统)使用,或结合这些指令执行系统、装置或设备而使用。就本说明书而言,“计算机可读介质”可以是任何可以包含、存储、通信、传播或传输程序以供指令执行系统、装置或设备或结合这些指令执行系统、装置或设备而使用的装置。计算机可读介质的更具体的示例(非穷尽性列表)包括以下:具有一个或多个布线的电连接部(电子装置),便携式计算机盘盒(磁装置),随机存取存储器(ram),只读存储器(rom),可擦除可编辑只读存储器(eprom或闪速存储器),光纤装置,以及便携式光盘只读存储器(cdrom)。另外,计算机可读介质甚至可以是可在其上打印程序的纸或其他合适的介质,因为可以例如通过对纸或其他介质进行光学扫描,接着进行编辑、解译或必要时以其他合适方式进行处理来以电子方式获得程序,然后将其存储在计算机存储器中。

应当理解,本发明的各部分可以用硬件、软件、固件或它们的组合来实现。在上述实施方式中,多个步骤或方法可以用存储在存储器中且由合适的指令执行系统执行的软件或固件来实现。例如,如果用硬件来实现,和在另一实施方式中一样,可用本领域公知的下列技术中的任一项或他们的组合来实现:具有用于对数据信号实现逻辑功能的逻辑门电路的离散逻辑电路,具有合适的组合逻辑门电路的专用集成电路,可编程门阵列(pga),现场可编程门阵列(fpga)等。

本技术领域的普通技术人员可以理解实现上述实施例方法携带的全部或部分步骤是可以通过程序来指令相关的硬件完成,的程序可以存储于一种计算机可读存储介质中,该程序在执行时,包括方法实施例的步骤之一或其组合。

此外,在本发明各个实施例中的各功能单元可以集成在一个处理模块中,也可以是各个单元单独物理存在,也可以两个或两个以上单元集成在一个模块中。上述集成的模块既可以采用硬件的形式实现,也可以采用软件功能模块的形式实现。集成的模块如果以软件功能模块的形式实现并作为独立的产品销售或使用时,也可以存储在一个计算机可读取存储介质中。

上述提到的存储介质可以是只读存储器,磁盘或光盘等。

以上仅为本发明的优选实施例而已,并不用于限制本发明,对于本领域的技术人员来说,本发明可以有各种更改和变化。凡在本发明的精神和原则之内,所作的任何修改、等同替换、改进等,均应包含在本发明的保护范围之内。

当前第1页1 2 
网友询问留言 已有0条留言
  • 还没有人留言评论。精彩留言会获得点赞!
1