欢迎来到知嘟嘟! 联系电话:13336804447 卖家免费入驻,海量在线求购! 卖家免费入驻,海量在线求购!
知嘟嘟
我要发布
联系电话:13336804447
知嘟嘟经纪人
收藏
专利号: 2018105671640
申请人: 宁波大学
专利类型:发明专利
专利状态:已下证
专利领域: 测量;测试
更新日期:2026-11-16
缴费截止日期: 暂无
价格&联系人
年费信息
委托购买

摘要:

权利要求书:

1.一种基于距离测量的静止刚体定位方法,其特征在于包括以下步骤:

步骤一:设定无线传感器网络中存在M个用于接收测量信号的锚节点和一个刚体,并设定刚体的内部放置有N个用于发射测量信号的未知节点;在无线传感器网络中建立一个空间坐标系作为全局参考坐标系,并在刚体的内部设置一个空间坐标系作为局部参考坐标系;将M个锚节点在全局参考坐标系中的坐标位置对应记为a1,...,am,...,aM,将刚体运动前N个未知节点在局部参考坐标系中的坐标位置对应记为c1,...,ci,...,cN;其中,M和N均为正整数,M≥4,N≥3,a1表示第1个锚节点在全局参考坐标系中的坐标位置,m为正整数,1≤m≤M,am表示第m个锚节点在全局参考坐标系中的坐标位置,aM表示第M个锚节点在全局参考坐标系中的坐标位置,c1表示刚体运动前第1个未知节点在局部参考坐标系中的坐标位置,i为正整数,1≤i≤N,ci表示刚体运动前第i个未知节点在局部参考坐标系中的坐标位置,cN表示刚体运动前第N个未知节点在局部参考坐标系中的坐标位置;

步骤二:使刚体运动,将刚体运动后N个未知节点在全局参考坐标系中的坐标位置对应记为s1,...,si,...,sN;然后获取每个未知节点到各个锚节点的测量距离,将第i个未知节点到第m个锚节点的测量距离记为rmi;其中,s1表示刚体运动后第1个未知节点在全局参考坐标系中的坐标位置,si表示刚体运动后第i个未知节点在全局参考坐标系中的坐标位置,sN表示刚体运动后第N个未知节点在全局参考坐标系中的坐标位置;

步骤三:对刚体运动后每个未知节点在全局参考坐标系中的坐标位置以模型方式进行描述,将si的模型描述为:si=Qci+t;然后对每个未知节点到各个锚节点的测量距离以模型方式进行描述,将rmi的模型描述为:rmi=||am-si||+vmi=||am-Qci-t||+vmi;接着对每个未知节点到各个锚节点的测量距离的模型描述进行形式整理,对于rmi=||am-si||+vmi=||am-Qci-t||+vmi,将等式rmi=||am-Qci-t||+vmi两边同时平方,忽略 同时将||am-Qci-t||替换为rmi,整理得到 再将

堆砌成向量的形式,描述为: 最后令 成立,并确

定刚体定位问题的约束最小二乘表述形式,描述为: 其中,Q

表示旋转矩阵,Q的维数为3×3,t表示位置矢量,t代表刚体运动后局部参考坐标系的原点在全局参考坐标系中的坐标位置,t的维数为3×1,符号“|| ||”为求欧几里德范数符号,vmi表示rmi中存在的测量噪声,vmi服从零均值的高斯分布 表示vmi的功率, 为ci的转置, 为am的转置,符号 为克罗内克积运算符号,vec(Q)表示对Q进行矩阵矢量化,QT为Q的转置,d=[p11,...,pM1,p12,…,pM2,…,p1N,…,pMN]T,符号“[ ]”为矢量表示符号,[p11,...,pM1,p12,…,pM2,…,p1N,…,pMN]T为[p11,...,pM1,p12,…,pM2,…,p1N,…,pMN]的转置, r11表示第1个未知节点到第1个锚节点的测量距离,rM1表示第1个未知节点到第M个锚节点的测量距离,

r12表示第2个未知节点到第1个锚节点的测量距离,c2表示刚体运动

前第2个未知节点在局部参考坐标系中的坐标位置, rM2表示第2个

未知节点到第M个锚节点的测量距离, r1N表示第N个未知节点到第1

个锚节点的测量距离, rMN表示第N个未知节点到第M个锚节点的测

T

量距离,H=[h11,…,hM1,h12,…,hM2,…,h1N,…,hMN] ,[h11,…,hM1,h12,…,hM2,…,h1N,…,hMN]T为[h11,...,hM1,h12,…,hM2,…,h1N,…,hMN]的转置,为 的转置, 为c1的转置, 为a1的转

置, 为

的转置, 为aM的转置,

为 的 转置 , 为 c2的 转置 ,

为

的转置,

为 的转置 , 为cN的转置,

为

的转置,f=[(vec(Q))T,tT,(QTt)T,||t|||2]T,[(vec(Q))T,tT,(QTt)T,||t||2]T为[(vec(Q))T,tT,(QTt)T,||t||2]的转置,(vec(Q))T为vec(Q)的转置,tT为t的转置,(QTt)T为QTt的转置,[2r11v11,...,2rM1vM1,

2r12v12,...,2rM2vM2,...,2r1Nv1N,...,2rMNvMN]T为[2r11v11,…,2rM1vM1,2r12v12,…,

2rM2vM2,…,2r1Nv1N,…,2rMNvMN]的转置,v11表示r11中存在的测量噪声,vM1表示rM1中存在的测量噪声,v12表示r12中存在的测量噪声,vM2表示rM2中存在的测量噪声,v1N表示r1N中存在的测量噪声,vMN表示rMN中存在的测量噪声,min()为取最小值函数,(d-Hf)T为(d-Hf)的转置,为 的逆, [r11,…,rM1,r12,…,rM2,…,r1N,...,rMN]T为[r11,...,rM1,r12,…,rM2,…,r1N,…,rMN]的转置,diag()为对角线矩阵表示形式, 表示v11的功率, 表示vM1的功率, 表示v12的功率, 表示vM2的功率, 表示v1N的功率, 表示vMN的功率,I为单位矩阵,I的维数为3×3,det(Q)表示求Q的行列式,QTQ=I和det(Q)=1为Q需要满足的条件,“s.t.”表示“受约束于……”;

步骤四:令F=ffT,使刚体定位问题的约束最小二乘表述形式中的约束条件QTQ=I等价于 并使f中的QTt形成约束条件 根据(QTt)TQTt=tTt和||t||2=tTt,得到约束条件 然

后舍掉刚体定位问题的约束最小二乘表述形式中的约束条件det(Q)=1,将刚体定位问题的约束最小二乘表述形式转化为: 再根据FT

=ff 等价于 去掉非凸的关于矩阵F的约束rank(F)=1,将

结合到刚体定位问题的约束最小二乘表述形式的转化形式中,得到刚体定位问

题的半正定规划形式,描述为: 最后对刚体定

位问题的半正定规划形式进行求解,得到Q和t各自的初步值,对应记为Qsdp和tsdp;其中,HT为H的转置,dT为d的转置,F为引入的矩阵,F的维数为16×16,fT为f的转置,tr()表示求一个矩阵中的所有对角元素的值的和,F(1:3,1:3)表示由F的第1行至第3行、第1列至第3列所有元素形成的矩阵,F(4:6,4:6)表示由F的第4行至第6行、第4列至第6列所有元素形成的矩阵,F(7:9,7:9)表示由F的第7行至第9行、第7列至第9列所有元素形成的矩阵,F(1,4)表示F的第1行第4列元素的值,F(2,5)表示F的第2行第5列元素的值,F(3,6)表示F的第3行第6列元素的值,F(1,7)表示F的第1行第7列元素的值,F(2,8)表示F的第2行第8列元素的值,F(3,

9)表示F的第3行第9列元素的值,F(4,7)表示F的第4行第7列元素的值,F(5,8)表示F的第5行第8列元素的值,F(6,9)表示F的第6行第9列元素的值,f(13)表示f中的第13个元素的值,f(14)表示f中的第14个元素的值,f(15)表示f中的第15个元素的值,F(1:3,10:12)表示由F的第1行至第3行、第10列至第12列所有元素形成的矩阵,F(4:6,10:12)表示由F的第4行至第6行、第10列至第12列所有元素形成的矩阵,F(7:9,10:12)表示由F的第7行至第9行、第10列至第12列所有元素形成的矩阵,F(10:12,10:12)表示由F的第10行至第12行、第10列至第

12列所有元素形成的矩阵,F(13:15,13:15)表示由F的第13行至第15行、第13列至第15列所有元素形成的矩阵,f(16)表示f中的第16个元素的值,符号 表示一个矩阵是半正定的,rank()表示求一个矩阵的秩;

步骤五:对Qsdp进行正交化,将正交化后得到的值记为Qort,Qort满足 且det(Qort)=1;然后将Qort作为Q的估计值,将tsdp作为t的估计值;其中, 为Qort的转置,det(Qort)表示求Qort的行列式。

2.根据权利要求1所述的一种基于距离测量的静止刚体定位方法,其特征在于所述的步骤五执行完毕后,继续执行以下步骤六,具体如下:步骤六:对Qort和tsdp进行优化,得到Qort和tsdp各自的优化值,对应记为Qfin和tfin;将Qfin作为Q的最优估计值,将tfin作为t的最优估计值。