【技术实现步骤摘要】
定位方法及相关装置
[0001]本申请涉及定位领域,具体而言,涉及一种定位方法及相关装置。
技术介绍
[0002]随着定位技术的发展,业界提出了多种定位方式以适应不同场景下的定位需要;然而,研究发现,不同的定位方式仅能在各自擅长的领域取得很好的定位效果。
[0003]例如,RTK(Real Time Kinematic,实时差分定位)定位方式可以在室外空旷场景获取高精度的经纬度坐标,但RTK测量结果在室内、城市场景中存在大量噪声,从而测量结果存在极大的误差。而与之相反的是,VIO(Visual Inertial Odometry,视觉惯性里程计)定位方式可以在室内、城市场景中实现准确和鲁棒的姿态估计,但VIO在长期导航时会遇到轨迹漂移的问题。
[0004]因此,亟需一种在不同的场景下均能取得很好的定位效果的技术方案。
技术实现思路
[0005]为了克服现有技术中的至少一个不足,本申请提供一种定位方法及装置,包括:
[0006]第一方面,本申请提供一种定位方法,应用于可移动平台,所述方法包括:
[0007]获取所述可移动平台的视觉信息、惯性信息及RTK定位信息;
[0008]根据所述视觉信息、所述惯性信息及所述RTK定位信息,获得视觉残差、惯性残差及RTK残差;其中,所述RTK残差为在同一坐标系下的RTK预估定位信息与所述RTK定位信息之差,所述RTK预估定位信息由所述惯性信息获得;
[0009]根据所述视觉残差、所述惯性残差及所述RTK残差,获得所述可移 ...
【技术保护点】
【技术特征摘要】
1.一种定位方法,其特征在于,应用于可移动平台,所述方法包括:获取所述可移动平台的视觉信息、惯性信息及RTK定位信息;根据所述视觉信息、所述惯性信息及所述RTK定位信息,获得视觉残差、惯性残差及RTK残差;其中,所述RTK残差为在同一坐标系下的RTK预估定位信息与所述RTK定位信息之差,所述RTK预估定位信息由所述惯性信息获得;根据所述视觉残差、所述惯性残差及所述RTK残差,获得所述可移动平台的目标位姿信息,所述目标位姿信息表征基于所述视觉残差、所述惯性残差及所述RTK残差处理所得的最大后验概率的最优解。2.根据权利要求1所述的定位方法,其特征在于,所述RTK残差包括第一残差以及第二残差,所述RTK预估定位信息包括第一定位信息以及第二定位信息,所述视觉信息包括相邻的两帧图像,所述惯性信息包括在所述两帧图像的采集时间之间采集的局部惯性信息以及惯性信息的预积分;所述根据所述视觉信息、所述惯性信息及所述RTK定位信息,获得所述RTK残差的步骤,包括:根据所述局部惯性信息以及所述RTK定位信息,获得所述第一残差,其中,所述第一残差为所述第一定位信息与所述RTK定位信息之差,所述第一定位信息由所述局部惯性信息获得;根据所述局部惯性信息、所述惯性信息的预积分以及所述RTK定位信息,获得所述第二残差,其中,所述第二残差为所述第二定位信息与所述RTK定位信息之差,第二定位信息由所述惯性信息的预积分以及所述局部惯性信息获得。3.根据权利要求2所述的定位方法,其特征在于,所述根据所述视觉残差、所述惯性残差及所述RTK残差,获得所述可移动平台的目标位姿信息的步骤,包括:基于所述视觉残差、所述惯性残差、所述第一残差以及所述第二残差,构建目标优化函数;计算所述目标优化函数的最小函数值,将所述最小函数值对应的位姿信息作为所述可移动平台的目标位姿信息。4.根据权利要求3所述的定位方法,其特征在于,所述基于所述视觉残差、所述惯性残差、所述第一残差以及所述第二残差,构建目标优化函数,包括:将至少一个所述视觉残差与鲁棒核函数之间的乘积、至少一个所述惯性残差、至少一个所述第一残差以及至少一个所述第二残差之间的残差之和,作为所述目标优化函数,其中,所述残差之和满足高斯概率分布。5.根据权利要求4所述的定位方法,其特征在于,所述根据所述局部惯性信息以及所述RTK定位信息,获得所述第一残差,包括:根据所述局部惯性信息,预估所述移动平台的第一定位信息;将所述第一定位信息与所述RTK定位信息以及高斯白噪声之差,作为所述第一残差。6.根据权利要求4所述的定位方法,其特征在于,所述根据所述局部惯性信息...
【专利技术属性】
技术研发人员:韩世豪,张润初,
申请(专利权)人:广州极飞科技股份有限公司,
类型:发明
国别省市:
还没有人留言评论。发表了对其他浏览者有用的留言会获得科技券。