首页 > 专利 > 杭州电子科技大学 > 一种提高便携设备定位精度的方法专利详情

一种提高便携设备定位精度的方法   0    0

有效专利 查看PDF
专利申请流程有哪些步骤?
专利申请流程图
申请
申请号:指国家知识产权局受理一件专利申请时给予该专利申请的一个标示号码。唯一性原则。
申请日:提出专利申请之日。
2019-12-31
申请公布
申请公布指发明专利申请经初步审查合格后,自申请日(或优先权日)起18个月期满时的公布或根据申请人的请求提前进行的公布。
申请公布号:专利申请过程中,在尚未取得专利授权之前,国家专利局《专利公报》公开专利时的编号。
申请公布日:申请公开的日期,即在专利公报上予以公开的日期。
2020-06-02
授权
授权指对发明专利申请经实质审查没有发现驳回理由,授予发明专利权;或对实用新型或外观设计专利申请经初步审查没有发现驳回理由,授予实用新型专利权或外观设计专利权。
2022-04-01
预估到期
发明专利权的期限为二十年,实用新型专利权期限为十年,外观设计专利权期限为十五年,均自申请日起计算。专利届满后法律终止保护。
2039-12-31
基本信息
有效性 有效专利 专利类型 发明专利
申请号 CN201911421709.8 申请日 2019-12-31
公开/公告号 CN111123323B 公开/公告日 2022-04-01
授权日 2022-04-01 预估到期日 2039-12-31
申请年 2019年 公开/公告年 2022年
缴费截止日
分类号 G01S19/40G01S19/42G01S5/02 主分类号 G01S19/40
是否联合申请 独立申请 文献类型号 B
独权数量 1 从权数量 2
权利要求数量 3 非专利引证数量 1
引用专利数量 1 被引证专利数量 0
非专利引证 1、2010.02.25吴文健等.一种改进的加权三边定位算法. 《郑州轻工业学院学报(自然科学版)》.2012,Choi Seung-Hwan,et al.EKF BasedOutdoor Positioning System using MultipleGPS Receivers《.Journal of Korea RoboticsSociety 》.2013,夏泽斌等.多GPS架构下汽车测试数据处理方法《.汽车工程》.2017,李华景.多GPS制导自动车辆运动控制系统的研究《.万方》.2018,;
引用专利 WO2010021657A 被引证专利
专利权维持 3 专利申请国编码 CN
专利事件 事务标签 公开、实质审查、授权
申请人信息
申请人 第一申请人
专利权人 杭州电子科技大学 当前专利权人 杭州电子科技大学
发明人 颜成钢、张杰华、史治国、孙垚棋、张继勇、张勇东 第一发明人 颜成钢
地址 浙江省杭州市下沙高教园区2号大街 邮编 310018
申请人数量 1 发明人数量 6
申请人所在省 浙江省 申请人所在市 浙江省杭州市
代理人信息
代理机构
专利代理机构是经省专利管理局审核,国家知识产权局批准设立,可以接受委托人的委托,在委托权限范围内以委托人的名义办理专利申请或其他专利事务的服务机构。
杭州君度专利代理事务所 代理人
专利代理师是代理他人进行专利申请和办理其他专利事务,取得一定资格的人。
杨舟涛
摘要
本发明涉及一种提高便携设备定位精度的方法。本发明利用多个普通GPS/BDS芯片同时进行定位,将每个普通GPS/BDS芯片的数据不同的权重进行融合,然后用卡尔曼滤波器对融合后的数据进行滤波,从而提高便携设备定位精度。本发明的多GPS/BDS芯片结构的定位精度有明显的优化,并且大大克服了普通GPS/BDS芯片受到干扰产生漂移的问题。加权方法用GPS/BDS芯片间的相对几何位置对检测数据进行约束,从而解决了多个GPS数据间的加权问题,更加可以削弱漂移数据的影响。没有复杂的数学计算,既有利于工程实现,又有利于减轻处理器的运算负担。
  • 摘要附图
    一种提高便携设备定位精度的方法
  • 说明书附图:图1
    一种提高便携设备定位精度的方法
  • 说明书附图:图2
    一种提高便携设备定位精度的方法
  • 说明书附图:图3
    一种提高便携设备定位精度的方法
法律状态
序号 法律状态公告日 法律状态 法律状态信息
1 2022-04-01 授权
2 2021-08-17 著录事项变更 发明人由颜成钢 张杰华 孙垚棋 张继勇 张勇东 变更为颜成钢 张杰华 史治国 孙垚棋 张继勇 张勇东 
3 2020-06-02 实质审查的生效 IPC(主分类): G01S 19/40 专利申请号: 201911421709.8 申请日: 2019.12.31
4 2020-05-08 公开
权利要求
权利要求书是申请文件最核心的部分,是申请人向国家申请保护他的发明创造及划定保护范围的文件。
1.一种提高便携设备定位精度的方法,其特征在于:包括以下步骤:
步骤一、将四个普通GPS定位芯片摆放成一个边长为a的正方形,定位芯片的TXD引脚、RXD引脚分别与单片机RX、TX引脚连接,为每个定位芯片连接有源天线增强搜星能力;通过四个芯片采集位置信息,得到初始GPS坐标;
步骤二、将步骤一中四个芯片采集到的位置信息按如下方式处理后得到所需的权值:
将四个GPS坐标点生成一个四边形,从左上顶点开始按顺时针方向依次记为A、B、C、D,分别计算各顶点对应内角的角度θi;计算每个顶点相邻两边的长度di,j和di,k,其中i表示两边的公共顶点,j,k表示与i相邻的两顶点;计算角度权值: 其中,θi与前述θi含义相同,变量i取值为A、B、C、D;分母表示每个内角与直角之差绝对值的余弦值的和;计算边长权值: 分母表示每两个相邻所述GPS芯片之间距离减去其
GPS坐标间距离后用sigmoid函数处理结果的总和的两倍;取角度权值、边长权值加权结果的平均值:
更新顶点GPS坐标;以上两式xi、yi分别表示所述GPS芯片测得的纬度和经度,xi’、yi’表示加权结果;
步骤三、计算加权后四个坐标值的平均值: 其中x、y代表经过加
权计算后的纬度、经度坐标,通过加权运算修正了单个定位芯片的漂移,作为卡尔曼滤波的输入;其余符号同前,i取值同前;
步骤四、将步骤三所得平均值输入卡尔曼滤波器,对下一步的状态做出最优估计;完成上述步骤后,转步骤二,重新获取当前GPS坐标更新权重,直到被打断。

2.如权利要求1所述的一种提高便携设备定位精度的方法,其特征在于:步骤四具体包括以下步骤:
步骤1、建立系统状态方程:xk=Axk‑1+wk‑1;xk为k时刻系统状态变量,A为状态转移矩阵,wk‑1为系统噪声向量;选取纬度、经度的位置以及相应方向上的速度和误差;
其中x,y为步骤三得出的结果, 是x,y对时间的导数即速度,εx,εy为x,y方向上的位置误差;确定状态转移矩阵A,状态转移矩阵A选取CV模型、CA模型、singer模型或CS模型;确定wk‑1:wk‑1=[0 0 wx 0 0 wy];
其中 表示系统受到x方向与y方向的均值为0,方差为
高斯噪声的干扰;
步骤2、建立观测方程:zk=Hxk+vk;仅考虑平面坐标时系统的输出为经纬度,故zk=[x T
y],观测矩阵用于转换维度,故取:
同时考虑vk=[vx vy]为服从均值为0,方差分别为
的高斯噪声,即
步骤3、给定第一次执行步骤4时所需的初始条件:状态向量 状态估计误差P0,初始化部分完成,连续运行时前三步仅需执行一次;
步骤4、预测: 其中 是先验状态估计值,根据
状态向量初始值 或k‑1时刻的最优估计值 求得; 表示k时刻的先验状态估计误
差,由状态估计误差P0或最优协方差 求得; 是k‑1时刻的最优协方差;Q是过程噪声的协方差矩阵,为一对角阵,且元素值较小,通过调节这一矩阵调整滤波效果;此步骤在前面建立的系统状态空间模型的基础上,得到了k时刻的先验状态估计值 和先验状态估计误差 为下一步计算k时刻的后验状态估计值 与系统误差 做准备;
步骤5、更新:
其中Kk是一个中间变量,称作卡尔曼增益;R为测量噪声的协方差矩
阵,能够用实验确定来调节滤波效果; 是k时刻的后验状态估计值,也就是滤波的结果;
是在k时刻的系统误差。

3.如权利要求1所述的一种提高便携设备定位精度的方法,其特征在于:所述的状态转移矩阵A选择CV模型: T为所述GPS芯片采样周期。
说明书

技术领域

[0001] 本发明涉及卫星导航技术领域,具体涉及一种提高便携设备定位精度的方法。

背景技术

[0002] GPS(全球定位系统)与BDS(北斗导航系统)都是基于卫星的导航系统,可以提供接收端的空间位置和速度等信息。这两种导航系统在便携导航设备中都有着广泛的应用,例如手持GPS导航仪、手机定位、车载导航设备等。导航设备在接收到卫星发出的电文后解算出其中空间坐标和速度等信息。但是受到相关政策以及环境因素比如电离层延迟等的影响,普通接收端的定位的精度以及准确度往往不尽如人意,有时还会出现较为严重的漂移,严重的减弱了定位效果。
[0003] 由于高精度GPS价格昂贵,导航型GPS往往采用普通GPS芯片,定位精度低于预期,在GPS信号不好的地方会出现明显的漂移。提高定位精度则需要考虑处理器的运算能力,不能采用过于复杂的算法,以免对处理器造成过重的负担降低定位的实时性。如果采用多个普通GPS芯片进行定位,需要确定一个合理的数量,既要能够有效的消除误差,又要考虑经济性和处理器的运算能力,还需要考虑如何才能最好的利用多个GPS芯片结构产生的优势。
[0004] 卡尔曼滤波是一种用于时变线性系统的递归滤波器,其计算过程只需要k时刻的测量值与k‑1时刻的最优估计值就能获得当前最优状态估计,不需要存储大量数据,而且每一个步骤的计算量都较小,能够提供较好的实时性,比较适合便携设备的应用场景。

发明内容

[0005] 本发明所要解决的技术问题是:受限于政策和环境因素以及普通GPS芯片本身的性能,便携导航设备容易出现定位不准确和漂移现象,不能够提供精准和稳定的定位服务。
[0006] 针对上述情况,提出了一种利用多个普通GPS芯片同时进行定位,将每个普通GPS芯片的数据不同的权重进行融合,然后用卡尔曼滤波器对融合后的数据进行滤波,从而提高便携设备定位精度。
[0007] 一种提高便携设备定位精度的方法,包括以下步骤:
[0008] 步骤一、将四个普通GPS定位芯片摆放成一个边长为a的正方形,定位芯片的TXD引脚、RXD引脚分别与单片机RX、TX引脚连接,必要时可为每个定位芯片连接有源天线增强搜星能力。通过四个芯片采集位置信息,得到初始GPS坐标。
[0009] 步骤二、将步骤一中四个芯片采集到的定位信息按如下方式处理后得到所需的权值:将四个GPS坐标点生成一个四边形,从左上顶点开始按顺时针方向依次记为A、B、C、D,分别计算各顶点对应内角的角度θi。计算每个顶点相邻两边的长度di,j和di,k,其中i表示两边的公共顶点,j,k表示与i相邻的两顶点。计算角度权值: 其中,θi与前述θi含义相同,变量i取值为A、B、C、D。分母表示每个内角与直角之差绝对值的余弦值的和。计算边长权值: 其中,a,di,j与di,k与前述含义相同。分母表示每两个相邻所述GPS芯片之间距离减去其GPS坐标间距离后用sigmoid函数处理结果的总和的两倍。取角度权值、边长权值加权结果的平均值:
[0010]
[0011]
[0012] 更新顶点GPS坐标。以上两式xi、yi分别表示所述GPS芯片测得的纬度和经度,xi’、yi’表示加权结果。
[0013] 步骤三、计算加权后四个坐标值的平均值: 其中x、y代表经过加权计算后的纬度、经度坐标,通过加权运算修正了单个定位芯片的漂移,作为卡尔曼滤波的输入。其余符号同前,i取值同前。
[0014] 步骤四、将步骤三所得平均值输入卡尔曼滤波器,对下一步的状态做出最优估计。具体如下:
[0015] 步骤1、建立系统状态方程:xk=Axk‑1+wk‑1;xk为k时刻系统状态变量,A为状态转移矩阵,wk‑1为系统噪声向量。根据实际需要选取纬度、经度的位置以及相应方向上的速度和误差。 其中x,y为步骤三得出的结果, 是x,y对时间的导数即速度,2x,εy为x,y方向上的位置误差。如果考虑三维坐标,则可以加入海拔信息和相应误差,同时如果考虑到GPS定位原理,接收机钟差等因素也可以作为状态向量。
[0016] 确定状态转移矩阵A,A的选取根据不同的模型有多种选择,例如CV模型、CA模型、singer模型、CS模型。
[0017] 考虑到算法的复杂度,以及实际情况中不论是行人还是汽车总以匀速运动的时间居多,选择CV模型: T为所述GPS/BDS芯片采样周期。确定wk‑1:wk‑1=[0 0 wx 0 0 wy];
[0018] 其中 表示系统受到x方向与y方向的均值为0,方差为 高斯噪声的干扰;
[0019] 步骤2、建立观测方程:zk=Hxk+vk;仅考虑平面坐标时系统的输出为经纬度,故zkT=[x y] ,观测矩阵用于转换维度,故取: 同时考虑vk=[vx 
vy]为服从均值为0,方差分别为 的高斯噪声,即
[0020] 步骤3、给定第一次执行下一步骤所需的初始条件:状态向量 状态估计误差P0,至此,初始化部分完成,连续运行时前三步仅需执行一次。
[0021] 步骤4、预测: 根据状态向量初始值 或k‑1时刻的最优估计值 输出的先验状态估计值 表示k时刻的先验估计误差,由初始估计误差P0或系统误差 求得;Q是过程噪声的协方差矩阵,为一对角阵,且元素值较小,通过调节这一矩阵调整滤波效果。在前面建立的系统状态空间模型的基础上,得到了k时刻的先验状态估计值 和先验状态估计误差 为下一步计算k时刻的后验状态估计值 与系统误差 做准备。
[0022] 步骤5、更新:其中Nk是一个中间变量,称作卡尔曼增益。R为测量噪声的协方差矩
阵,可用实验确定来调节滤波效果; 是k时刻的后验状态估计值,也就是滤波的结果;
是在k时刻的系统误差。
[0023] 完成上述步骤后,转步骤二,重新获取当前GPS坐标更新权重,直到被打断(如断电、中断等)。
[0024] 本发明与现有方法相比,优点在于:相对于单GPS/BDS芯片结构,本发明中的多GPS/BDS芯片结构的定位精度有明显的优化,并且大大克服了普通GPS/BDS芯片受到干扰产生漂移的问题。加权方法用GPS/BDS芯片间的相对几何位置对检测数据进行约束,从而解决了多个GPS数据间的加权问题,相比于“多数表决法”的加权更加可以削弱漂移数据的影响。没有复杂的数学计算,既有利于工程实现,又有利于减轻处理器的运算负担。

实施方案

[0028] 以下结合附图及实施例,对本发明进一步的详细说明。
[0029] 一种提高便携设备定位精度的方法,如图1所示,通过固定四个GPS/BDS芯片的位置,将它们的位置关系作为已知条件,将四边形的角度和边长作为加权的依据,计算出各个GPS/BDS芯片数据的权重,加权后再取平均值,输入到卡尔曼滤波器,滤波器采用匀速运动模型,对下一时刻的位置给出最优估计,在滤波结束前,滤波器需要不断的计算卡尔曼增益、后验估计协方差的矩阵,但是其每一步的计算量都很小,而且只需要存储当前的测量值和前一个采样周期的估计值就可以得到最优估计值。
[0030] 如图2所示,本发明所述方法包括以下步骤:
[0031] 步骤一、将四个GPS/BDS芯片固定成边长为a的正方形,且每个芯片都给定一个标号。例如应用在汽车定位时空间较大可选择a=0.5m,从左上角开始顺时针标记为A、B、C、D,采用相应的标号来表示所接收到的数据来自哪一个芯片。通过四个芯片采集定位信息,得到初始GPS坐标。
[0032] 步骤二、将步骤一中正方形的每个角标记为θi,两个点之间的距离标记为di,j。例如顶点A所在的角为θA,A、B间的距离为dA,B。计算角度权值: 以顶点A为例,其角度权值为:
[0033] 例如θA、θB、θC、θD均为直角,这时的角度权值就是各占1/4。
[0034] 计算边长权值: 以顶点A为例,其相邻的两个顶点为B、D,那么有i=A,j=B,k=D,取a=0.5,则A的边长权值为:
分母中的系数“2”是为了使得所有权值之和为1添加的,分母中另一项代表着对四边形每一条边都用sigmoid函数进行计算并求和,sigmoid函数的定义如下:
计算加权结果:
[0035]
[0036]
[0037] 以上两式;xi、yi分别表示所述GPS/BDS芯片测得的纬度和经度,通过芯片解读接收到的电文获取,左侧为加权结果。
[0038] 步骤三、计算加权后四个坐标值的平均值: 其中x、y代表经过加权计算后的纬度、经度坐标,通过加权运算修正了单个定位芯片的漂移,作为卡尔曼滤波的输入。单位采用NTU单位:NTU=度*100000;
[0039] 步骤四、将步骤三所得平均值输入卡尔曼滤波器,对未来的状态做出最优的估计:具体如下:前三步是初始化,第4步是用初始值或第5步的最优估计值进行不可靠预测,第5步是根据不可靠预测得到最优估计值。
[0040] 步骤1、建立系统状态方程:xk=Axk‑1+wk‑1;选择系统状态变量以及状态转移矩阵:wk‑1=[0 0 wx 0 0 wy];其中x,
y为步骤三所得结果, 是下x,y对时间的导数即速度,εx,εy为x,y方向上的位置误差,T是芯片的采样周期,一般为0.1秒左右,具体的可以在芯片的技术手册中找到采样频率换算;
其中 是符合高斯分布的白噪声。
[0041] 步骤2、建立观测方程:zk=Hxk+vk;仅考虑平面坐标时系统的输出为经纬度,故zk=[x Ty],观测矩阵H用于将状态向量xk转换到二维的zk故取: 提取
其中的经纬度。同时考虑vk=[v xvy]为服从高斯分布的噪声,
[0042] 步骤3、给定第一次执行步骤4时所需的初始条件:卡尔曼滤波是递推算法,因此需给定状态向量初始值等。这里给出一组初始值: P0=100000E;E为单位矩阵,阶数与状态转移矩阵相同,这里为6阶,E前的系数应该是一个较大的数以保证结果的无偏性。至此,初始化部分完成,连续运行时前三步仅需执行一次。
[0043] 步骤4、预测: 将初值或k‑1时刻最优估计值代入上式计算。此步骤在前面建立的系统状态空间模型的基础上,得到了k时刻的先验状态估计值 和先验状态估计误差 为下一步计算k时刻的后验状态估计值 与系统误差 做准备。
[0044] 步骤5、更新:zk测量值向量,是步骤2的结果。更新后k自增,将上三式中的后二式
代入 计算,同时 也是滤波器输出的结果,即最优估计。如此循环直到被打断。

附图说明

[0025] 图1为GPS/BDS芯片位置示意图;
[0026] 图2为本发明的流程图;
[0027] 图3为卡尔曼滤波的流程图。
版权所有:盲专网 ©2023 zlpt.xyz  蜀ICP备2023003576号