1.一种室内地图匹配定位的方法,其特征在于:包括以下步骤:
S1:根据室内空间信息,得到行人可运动空间,构建室内空间图模型;所述室内空间图模型由节点集合与边集合构成;各节点中均存储了可运动空间的位置信息和室内空间语义信息,节点集合表示了行人的可运动空间;边中存储了节点间拓扑信息和几何信息,边集合用来表示限制行人的运动空间;
S2:根据所述室内空间图模型和其他定位技术首次得到的行人的估计位置,得到各个节点的初始概率分布πi,并选择初始概率最大的k个节点作为隐藏状态;k为大于0的正整数;初始概率分布πi为:πi=1/((Lex-nix)2+(Ley-niy)2+γe)
其中,ni表示室内空间图模型中的第i个节点,πi表示第i个节点的初始概率,ni.x表示该节点的横坐标,ni.y表示该节点的纵坐标,Le.x表示估计位置的横坐标,Le.y表示估计位置的纵坐标,γe的取值范围为(0,0.01];
S3:根据所述其他定位技术再次得到的估计位置和所述室内空间图模型中拓扑信息,提取与前一次隐藏状态相连的节点作为候选隐藏状态;根据所述室内空间图模型中的几何信息,剔除与行人朝向偏差大于90°的候选隐藏状态,得到剩余候选隐藏状态;将前一次的隐藏状态和剩余候选隐藏状态进行合并,结合所述室内空间图模型中的边集合,构建局部动态图模型;
S4:根据所述局部动态图模型的空间信息、采用其他定位技术得到的估计位置和行人朝向,构建状态转移概率p(ni|nj,θt,G),状态转移概率p(ni|nj,θt,G)为:p(ni|nj,θt,G)=ω(ni,nj)p(ni|nj,θt),t≠j
其中,ω(ni,nj)和p(ni|nj,θt)分别为室内空间图模型中的拓扑约束和几何约束;ni和nj分别表示不同的节点;θt为行人朝向;G为室内空间图模型;
S5:根据所述局部动态图模型中的空间信息,结合估计位置和行人朝向,构建发散概率P(Lt|ni),发散概率P(Lt|ni)为:P(Lt|ni)=1/((Lt.x-ni.x)2+(Lt.y-ni.y)2+γt)其中,Lt为行人在t时刻的估计位置,Lt.x为估计位置的横坐标,Lt.y为估计位置的纵坐标,ni表示室内空间图模型中的节点,即隐藏状态,ni.x为节点ni的横坐标,ni.为节点ni的纵坐标,γt的取值范围为(0,0.01];
S6:通过状态转移概率和发散概率分别约束隐藏状态的转移和更新隐藏状态的概率,计算出当前的维特比路径T(t,i):T(t,i)=argmaxj(p(nj,t-1)p(ni|nj,θt,G)P(Lt|ni));其中,p(nj,t-1)为t-1时刻隐藏状态状态nj的概率,p(ni|nj,θt,G)为隐藏状态nj到隐藏状态ni的转移概率,P(Lt|ni)为隐藏状态ni对估计位置Lt的发散概率,argmaxj表示选择使概率p(nj,t-1)p(ni|nj,θt,G)P(Lt|ni)最大的j的值,T(t,i)表示在t时刻隐藏状态ni的维特比路径;
S7:根据所述维特比路径,选择所述局部动态图模型中概率最大的k个节点作为存活节点,k为大于0的正整数,移除其他节点,并删除相应的边,所述存活节点将作为下一次迭代的隐藏状态;
S8:每接收一次所述其他定位技术得到的估计位置时,则运行一次步骤S3至S7,对隐藏状态和维特比路径进行更新;
S9:当不再接收所述其他定位技术得到的估计位置时,得到概率最大的一条维特比路径,该维特比路径即为最优匹配路径。
2.如权利要求1所述的一种室内地图匹配定位辅助方法,其特征在于:步骤S1中,在狭长区域所述室内空间图模型为路网模型,在开阔区域所述室内空间图模型为格网图;所述室内空间图模型G=
边edge=
3.如权利要求1所述的一种室内地图匹配定位辅助方法,其特征在于:步骤S4中,拓扑约束ω(ni,nj)为:其中,i≠j,当室内空间图模型G包含边edgej,i时,即当节点ni和nj之间存在连通关系时,ω(ni,nj)的值为1;否则ω(ni,nj)的值为0;几何约束p(ni|nj,θt)为:其中,hj,i为从节点nj到节点ni的方向信息,θt为行人的朝向, 是行人朝向变化测量值误差的方差;
隐藏状态自身转移概率为:
p(ni|nj,θt,G)=γs,i=j
γs为隐藏状态自身转移概率。
4.如权利要求1所述的一种室内地图匹配定位辅助方法,其特征在于:步骤S6中,约束隐藏状态之间的转移的方法如下:p(ni,t)=p(nj,t-1)p(ni|nj,θt,G)
其中,p(nj,t-1)表示上一时刻隐藏状态nj的概率,p(ni,t)为当前时刻隐藏状态ni的概率,p(ni|nj,θt,G)为由行人朝向和室内空间图模型约束的状态转移概率。
5.如权利要求1所述的一种室内地图匹配定位辅助方法,其特征在于:步骤S6中,对隐藏状态的概率进行更新的具体方法如下:其中p(ni)为隐藏状态ni在状态转移后的概率,P(Lt|ni)为隐藏状态ni对估计位置Lt的发散概率, 为隐藏状态ni经发散概率更新后的概率。
6.如权利要求1所述的一种室内地图匹配定位辅助方法,其特征在于:步骤S6中,计算当前的维特比路径的方法如下:T(t,i)=argmaxj(p(nj,t-1)p(ni|nj,θt,G)P(Lt|ni))其中,p(nj,t-1)为t-1时刻状态nj的概率,p(ni|nj,θt,G)为状态nj到状态ni的转移概率,P(Lt|ni)为隐藏状态ni对估计位置Lt的发散概率,argmaxj表示选择使概率p(nj,t-1)p(ni|nj,θt,G)P(Lt|ni)最大的j的值,T(t,i)表示在时刻t节点ni的维特比路径。