[发明专利]一种无人机的定位方法、系统、装置及介质有效
申请号: | 202110046616.2 | 申请日: | 2021-01-14 |
公开(公告)号: | CN112924999B | 公开(公告)日: | 2023-08-22 |
发明(设计)人: | 罗飞;陈鹏飞;李长锋 | 申请(专利权)人: | 华南理工大学 |
主分类号: | G01S19/45 | 分类号: | G01S19/45;G01C21/16 |
代理公司: | 广州嘉权专利商标事务所有限公司 44205 | 代理人: | 常柯阳 |
地址: | 511458 广东省广州市*** | 国省代码: | 广东;44 |
权利要求书: | 查看更多 | 说明书: | 查看更多 |
摘要: | |||
搜索关键词: | 一种 无人机 定位 方法 系统 装置 介质 | ||
1.一种无人机的定位方法,其特征在于,包括以下步骤:
获取伪距测量值和载波相位测量值;
根据卫星提供的位置和时钟偏移的估计值校正所述伪距测量值和所述载波相位测量值;
根据校正后的测量值的双差消除大气误差、卫星位置和时钟的误差;
在消除误差后,采用3个GNSS接收机确定无人机的姿态,并根据参考站进行RTK定位,实现无人机的定位;
所述载波相位和伪距校正公式为:
其中,是从卫星k指向接收器u的归一化方向矢量,c表示光速;
基于坐标信息的校正公式为:
所述载波相位测量值的双差的公式如下:
载波相位测量值的双差取决于接收器u和r之间的相对位置载波波长λm、双差整数模糊度双差载波相位多径和双差相位噪声
所述伪距测量值的双差的公式如下:
其中,为双差伪距多径,为双差伪距噪声。
2.根据权利要求1所述的一种无人机的定位方法,其特征在于,所述伪距测量值为接收机与卫星之间的距离测量值,所述载波相位测量值为在同一接收时刻基准站接收的卫星信号的相位相对于接收机产生的载波信号相位的测量值;
所述伪距测量值和载波相位测量值通过GNSS接收机获得。
3.根据权利要求1所述的一种无人机的定位方法,其特征在于,所述采用3个GNSS接收机确定无人机的姿态,并根据参考站进行RTK定位,实现无人机的定位,包括:
通过3个GNSS接收机获取RTK基线和两个姿态基线的载波相位测量值和伪距测量值在n时刻的测量向量
通过惯性测量单元获取无人机机体的加速度和角速度,根据所述加速度和所述角速度获取所述惯性测量单元的测量向量
根据所述测量向量和所述测量向量获取无人机的状态向量,实现无人机的定位;
其中,所述状态向量包含无人机的位姿信息和速度信息。
4.根据权利要求1所述的一种无人机的定位方法,其特征在于,所述无人机的定位方法还包括根据定位结果验证定位的准确性的步骤,具体包括:
分析固定载波相位残差,所述固定载波相位残差描述了固定模糊度下测量和计算的载波相位之间的一致性;
无人机着陆后重新确定模糊度,将模糊度重新确定的解决方案与着陆后直接获得模糊度的解决方案进行比较,确定定位的准确度。
5.一种无人机的定位系统,其特征在于,包括:
测量模块,用于获取伪距测量值和载波相位测量值;
校正模块,用于根据卫星提供的位置和时钟偏移的估计值校正所述伪距测量值和所述载波相位测量值;
误差消除模块,用于根据校正后的测量值的双差消除大气误差、卫星位置和时钟的误差;
定位模块,用于在消除误差后,采用3个GNSS接收机确定无人机的姿态,
并根据参考站进行RTK定位,实现无人机的定位;
所述载波相位和伪距校正公式为:
其中,是从卫星k指向接收器u的归一化方向矢量,c表示光速;
基于坐标信息的校正公式为:
所述载波相位测量值的双差的公式如下:
载波相位测量值的双差取决于接收器u和r之间的相对位置载波波长λm、双差整数模糊度双差载波相位多径和双差相位噪声
所述伪距测量值的双差的公式如下:
其中,为双差伪距多径,为双差伪距噪声。
6.一种无人机的定位装置,其特征在于,包括:
至少一个处理器;
至少一个存储器,用于存储至少一个程序;
当所述至少一个程序被所述至少一个处理器执行,使得所述至少一个处理器实现权利要求1-4任一项所述的一种无人机的定位方法。
7.一种存储介质,其中存储有处理器可执行的程序,其特征在于,所述处理器可执行的程序在由处理器执行时用于执行如权利要求1-4任一项所述方法。
该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于华南理工大学,未经华南理工大学许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服】
本文链接:http://www.vipzhuanli.com/pat/books/202110046616.2/1.html,转载请声明来源钻瓜专利网。
- 同类专利
- 专利分类
G01S 无线电定向;无线电导航;采用无线电波测距或测速;采用无线电波的反射或再辐射的定位或存在检测;采用其他波的类似装置
G01S19-00 卫星无线电信标定位系统;利用这种系统传输的信号确定位置、速度或姿态
G01S19-01 .传输时间戳信息的卫星无线电信标定位系统,例如,GPS [全球定位系统]、GLONASS[全球导航卫星系统]或GALILEO
G01S19-38 .利用卫星无线电信标定位系统传输的信号来确定导航方案
G01S19-39 ..传输带有时间戳信息的卫星无线电信标定位系统,例如GPS [全球定位系统], GLONASS [全球导航卫星系统]或GALILEO
G01S19-40 ...校正位置、速度或姿态
G01S19-42 ...确定位置