[发明专利]视距与非视距混合环境中基于到达时间差的稳健定位方法有效
申请号: | 201610972773.5 | 申请日: | 2016-11-07 |
公开(公告)号: | CN106842121B | 公开(公告)日: | 2019-03-05 |
发明(设计)人: | 王刚;王伟;张帆;李有明 | 申请(专利权)人: | 宁波大学 |
主分类号: | G01S5/06 | 分类号: | G01S5/06 |
代理公司: | 宁波奥圣专利代理事务所(普通合伙) 33226 | 代理人: | 周珏 |
地址: | 315211 浙*** | 国省代码: | 浙江;33 |
权利要求书: | 查看更多 | 说明书: | 查看更多 |
摘要: | |||
搜索关键词: | 视距 混合 环境 基于 到达 时间差 稳健 定位 方法 | ||
1.一种视距与非视距混合环境中基于到达时间差的稳健定位方法,其特征在于包括以下步骤:
①为处于视距与非视距混合环境中的无线网络建立一个平面坐标系或一个空间坐标系作为参考坐标系,该无线网络中存在一个未知的目标源和N+1个传感器,任选一个传感器作为参考传感器,其余传感器作为非参考传感器,将目标源在参考坐标系中的坐标位置记为x,将参考传感器在参考坐标系中的坐标位置记为s0,将N个非参考传感器在参考坐标系中的坐标位置依次对应记为s1,s2,...,sN;将测量信号从目标源发出到参考传感器接收所经过的路径定义为参考路径,参考路径的路径状态已知,将测量信号在参考路径上传输所经历的时间记为t0;将测量信号从目标源发出到每个非参考传感器接收所经过的路径定义为普通路径,测量信号从目标源发出到第i个非参考传感器接收所经过的路径为第i条普通路径,每条普通路径的路径状态已知,将测量信号在第i条普通路径上传输所经历的时间记为ti;然后计算测量信号在每条普通路径上传输与测量信号在参考路径上传输的距离差,将测量信号在第i条普通路径上传输与测量信号在参考路径上传输的距离差记为di,di=c(ti-t0);再构建一个初始值为空集的视距集合Φl和一个初始值为空集的非视距集合Φn,在到达时间差的测量中,找出测量信号所经过的参考路径与普通路径都为视距路径情况下的所有普通路径,将这些普通路径各自所对应的非参考传感器的序号归属于视距集合Φl,而非视距集合Φn={1,2,…,N}-Φl;其中,N≥3,s1表示第1个非参考传感器在参考坐标系中的坐标位置,s2表示第2个非参考传感器在参考坐标系中的坐标位置,sN表示第N个非参考传感器在参考坐标系中的坐标位置,1≤i≤N,c为光速;
②建立测量信号在普通路径上传输与测量信号在参考路径上传输的距离差在非视距环境下的测量模型,表示为:di=ri-r0+ni+ei,i∈Φn,其中,ri=||x-si||,r0=||x-s0||,符号“||||”为欧几里德范数符号,si表示第i个非参考传感器在参考坐标系中的坐标位置,ni表示第i条普通路径上的测量噪声与参考路径上的测量噪声的差值,ei表示第i条普通路径上的非视距误差与参考路径上的非视距误差的差值,|ni|<<ei,符号“| |”为取绝对值符号;然后对di=ri-r0+ni+ei,i∈Φn进行形式转变,得到其中,(s0-si)T为s0-si的转置;
并建立测量信号在普通路径上传输与测量信号在参考路径上传输的距离差在视距环境下的测量模型,表示为:di=ri-r0+ni,i∈Φl;然后对di=ri-r0+ni,i∈Φl进行形式转变,得到其中,(si-s0)T为si-s0的转置;
③根据和采用最坏情况下的鲁棒最小二乘方法,将视距与非视距混合环境中的定位问题描述为:
其中,min{}为取最小值函数,max()为取最大值函数,y=[xT,r0,r1,...,rN]T,符号“[]”为矢量表示符号,xT为x的转置,[xT,r0,r1,...,rN]T为[xT,r0,r1,...,rN]的转置,r1=||x-s1||,rN=||x-sN||,“s.t.”表示“受约束于”,fl,i(x,r0)和fn,i(x,ri,ei)均为中间变量,
然后通过简单变换将
s.t.||x-si||=ri,i=1,…,N
||x-s0||=r0
转变为其中,符号“||”为取绝对值符号;
接着根据三角不等式,确定
,
其中,ρi表示ei的上限,0≤ei≤ρi,h(ei)为中间变量,之后将转变为
再将和与结合,
得到其中,gn,i(x,ri)为中间变量;
④根据中与的不平衡性,在中添加权值
得到加权最小二乘问题,描述为:
⑤在已知路径状态的情况下,根据得到非凸的定位问题,描述为:
其中,w0表示参考路径上的非视距误差的值,wi表示第i条普通路径上的非视距误差的值;
⑥在非凸的定位问题中引入辅助变量γ,τ1,τ2,…,τi,…,τN,η1,η2,…,ηi,…,ηN,得到等价的引入辅助变量后非凸的定位问题,描述为:
||x-si||=ri,i=1,...,N
||x-s0||=r0
||x||2=γ
其中,为si的转置,为s0的转置;
⑦采用二阶锥松弛将引入辅助变量后非凸的定位问题中的||x-si||=ri松弛为||x-si||≤ri、||x-s0||=r0松弛为||x-s0||≤r0、松弛为松弛为||x||2=γ松弛为||x||2≤γ,同时为了满足凸问题的要求,将gn,i(x,ri)展开为
得到二阶锥规划问题,描述为:
||x-si||≤ri,i=1,...,N
||x-s0||≤r0
⑧利用内点法对二阶锥规划问题进行求解,得到y的全局最优解,记为y*;然后将y*代入y=[xT,r0,r1,...,rN]T中,得到x的最优解,记为x*,x*为目标源在参考坐标系中的坐标位置的最终定位值。
该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于宁波大学,未经宁波大学许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服】
本文链接:http://www.vipzhuanli.com/pat/books/201610972773.5/1.html,转载请声明来源钻瓜专利网。