本发明涉及定位和导航技术领域,尤其涉及一种利用矩形分布基站的缩方定位方法。
背景技术:
位置信息在人们的生活中扮演着重要的角色,其中室外定位技术已经成熟并广泛的应用到各个领域,而室内精确定位还未大规模的商业化,因其在安防、医疗、商业推广等领域有着广阔的应用前景,已成为时下研究的热点领域。定位精度和定位速度是定位系统的两个重要指标,其与定位采用的数学方法有密切的关系,随着人们对这两项指标要求的提高,对定位方法有更高的要求。
近年来的研究结果表明,由于对定位目标与基站间无严格时间同步的要求,tdoa定位方法具有适用各种类型网络、应用成本低、定位精度较高等优点。
目前比较成熟的基于tdoa(到达时间差)的定位方法主要有以下几种:taylor级数展开方法、chan算法、分类征服方法dac等,其特点各不相同。其中taylor级数展开算法为保证算法收敛,需要有先验条件,即初始估计坐标,且该算法不能事先判断结果的收敛情况。chan算法在tdoa误差服从理想高斯分布时性能良好,但由于在实际信道中,tdoa测量值误差较大,该算法的性能将会显著下降。分类征服算法dac,只有当tdoa噪声较小时,该算法才能达到满足crlb的最优性能。
技术实现要素:
本发明的目的是提供一种利用矩形分布基站的缩方定位方法,具备定位精度高、稳定性好、速度快的优点。
本发明的目的是通过以下技术方案实现的:
一种利用矩形分布基站的缩方定位方法,包括:
将四个基站所围成的矩形区域等分成四个象限,根据tdoa信息计算目标点距基站i和基站i+1间的距离差ri,i+1,通过比较ri,i+1与0的大小,初步判断目标点所在的象限;
对初步判断的象限再次进行四等分,通过不断缩小目标点所在的矩形区域,最终估计出目标点的位置。
所述初步判断目标点所在的象限的步骤包括:
四个基站所围成的矩形区域中,左下角、右下角、右上角与左上角的基站依次记为基站1、基站2、基站3与基站4;通过连接矩形区域对边中点,从而将矩形区域等分成四个小矩形,即四个象限,以右上方象限为第一象限并按逆时针方向依次编号;
比较ri,i+1与0的大小,初步判定目标点所在的象限:其中,ri,i+1=ri-r,i+1,ri为目标点与基站i的距离,其中i=1,2,3;
当r1,2>0且r2,3>0时,则初步判断目标点位于第一象限;
当r1,2<0且r2,3>0时,则初步判断目标点位于第二象限;
当r1,2<0且r2,3<0时,则初步判断目标点位于第三象限;
当r1,2>0且r2,3<0时,则初步判断目标点位于第四象限。
所述通过不断缩小目标点所在的矩形区域,最终估计出目标点的位置包括:
若r1,2×r2,3>0,则表示目标点位于第一象限或者第三象限内,此时使用基站1~基站3定位;步骤如下:
步骤a1、确定新的待划分区域s1,若是第一次确定s1,则令象限围成的区域为s1,否则令步骤a2中的s2为s1;再将s1进行四等分,以右上方区域为起始区域并按逆时针方向依次编号为s11,s12,s13,s14,中心记为o点;
步骤a2、比较ri,i+1与di的大小,排除不可能的区域,逐步缩小目标位置所在区域,其中di=do,i-do,i+1,do,i为o点与基站i的距离,其中i=1,2;具体如下:
若目标点位于第一象限内,则:
当r1,2>d1,则目标点所在区域排除s12;当r1,2<d1,则目标点所在区域排除s14;
当r2,3>d2,则目标点所在区域排除s13;当r2,3<d2,则目标点所在区域排除s11;
结合r1,2和r2,3来确定区域缩小后的区域s2;
若目标点位于第三象限内,则:
当r1,2>d1,则目标点所在区域排除s13;当r1,2<d1,则目标点所在区域排除s11;
当r2,3>d2,则目标点所在区域排除s14;当r2,3<d2,则目标点所在区域排除s12;
同样结合r1,2和r2,3确定区域缩小后的区域s2;
步骤a3、重复步骤a1与步骤a2,直至目标所处区域s2的面积小于设定值,则此时区域s2的几何中心即为所估计的目标点的位置。
所述通过不断缩小目标点所在的矩形区域,最终估计出目标点的位置包括:
若r1,2×r2,3<0,则表示目标点位于第二象限或者第四象限内,此时使用基站2~基站4定位;步骤如下:
步骤b1、确定新的待划分区域s1,若是第一次确定s1,则令象限围成的区域为s1,否则令步骤b2中的s2为s1;再将s1进行四等分,以右上方区域为起始区域并按逆时针方向依次编号为s11,s12,s13,s14,中心记为o点;
步骤b2、比较ri,i+1与di的大小,排除不可能的区域,逐步缩小目标位置所在区域,其中di=do,i-do,i+1,do,i为o点与基站i的距离,其中i=2,3;具体如下:
若目标点位于第二象限内,则:
当r2,3>d2,则目标点所在区域排除s13;当r2,3<d2,则目标点所在区域排除s11;
当r3,4>d3,则目标点所在区域排除s14;当r3,4<d3,则目标点所在区域排除s12;
结合r2,3和r3,4来确定区域缩小后的区域s2;
若目标点位于第四象限内,则:
当r2,3>d2,则目标点所在区域排除s14;当r2,3<d2,则目标点所在区域排除s12;
当r3,4>d3,则目标点所在区域排除s11;当r3,4<d3,则目标点所在区域排除s13;
同样结合r2,3和r3,4确定区域缩小后的区域s2;
步骤b3、重复步骤b1与步骤b2,直至目标所处区域s2的面积小于设定值,则此时区域s2的几何中心即为所估计的目标点的位置。
所述通过不断缩小目标点所在的矩形区域,最终估计出目标点的位置包括:
若目标点位于象限的边沿上,则r1,2×r2,3=0;若r1,2=r2,3=0,则矩形区域的中心点即为目标点的位置;
若r1,2与r2,3中仅有一个为零,假设r1,2=0,r2,3<0,则估计目标点位置的步骤如下:
步骤c1、确定新的待划分区域s1,若是第一次确定s1,则令以目标点位置所在边为公共边的两相邻象限围成的区域为s1,此处为第三象限和第四象限,否则令步骤c2中的s2为s1;再将s1进行四等分,以右上方区域为起始区域并按逆时针方向依次编号为s11,s12,s13,s14,中心记为o点;
步骤c2、比较r2,3与d2的大小,排除两个矩形模块,剩下的两个矩形模块即为目标所处区域s2,其中d2=do,2-do,3,do,i为o点与基站i的距离;如果,r2,3>d2,则区域s2由s11和s12构成;
步骤c3、重复步骤c1与步骤c2,直至目标所处区域s2的面积小于设定值,则此时区域s2的几何中心即为所估计的目标点的位置。
由上述本发明提供的技术方案可以看出,针对位置呈矩形分布的基站节点,利用tdoa信息不断缩小估计位置所在的方形区域,最终确定目标位置,具有定位速度快、精度高、稳定性好的优点,可用于基于tdoa的高精度定位系统中。
附图说明
为了更清楚地说明本发明实施例的技术方案,下面将对实施例描述中所需要使用的附图作简单地介绍,显而易见地,下面描述中的附图仅仅是本发明的一些实施例,对于本领域的普通技术人员来讲,在不付出创造性劳动的前提下,还可以根据这些附图获得其他附图。
图1为本发明实施例提供的一种利用矩形分布基站的缩方定位方法的流程图;
图2为本发明实施例提供的目标点位于第一象限时缩方定位方法的示意图;
图3为本发明实施例提供的目标点位于象限边沿上时的缩方定位方法示意图。
具体实施方式
下面结合本发明实施例中的附图,对本发明实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例仅仅是本发明一部分实施例,而不是全部的实施例。基于本发明的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都属于本发明的保护范围。
图1为本发明实施例提供的一种利用矩形分布基站的缩方定位方法的流程图。如图1所示,其主要包括如下步骤:
步骤11、将四个基站所围成的矩形区域等分成四个象限,根据tdoa信息计算目标点距基站i和基站i+1间的距离差ri,i+1,通过比较ri,i+1与0的大小,初步判断目标点所在的象限。其中ri,i+1=ri-r,i+1,ri为目标点与基站i的距离,其中i=1,2,3。
如图2所示,四个基站所围成的矩形区域中,左下角、右下角、右上角与左上角的基站依次记为基站1、基站2、基站3与基站4(也即图2中的1~4);通过连接矩形区域对边中点,从而将矩形区域等分成四个小矩形,即四个象限,以右上方象限为第一象限并按逆时针方向依次编号;目标点记为p。
比较ri,i+1与0的大小,初步判定目标点所在的象限:
当r1,2>0且r2,3>0时,则初步判断目标点位于第一象限;
当r1,2<0且r2,3>0时,则初步判断目标点位于第二象限;
当r1,2<0且r2,3<0时,则初步判断目标点位于第三象限;
当r1,2>0且r2,3<0时,则初步判断目标点位于第四象限。
如图2所示,目标点位于第一象限。
步骤12、对初步判断的象限再次进行四等分,通过不断缩小目标点所在的矩形区域,最终估计出目标点的位置。
如图2所示,为目标点位于第一象限时缩方定位方法的示意图,具体的执行过程将在后文做详细说明。
本发明实施例中,根据步骤11的判断结果,不断缩小目标点所在的矩形区域,可以分为如下三种情况来处理。
情况一:
若r1,2×r2,3>0,则表示目标点位于第一象限或者第三象限内,此时使用基站1~基站3定位;步骤如下:
步骤a1、确定新的待划分区域s1,若是第一次确定s1,则令象限围成的区域为s1,否则令步骤a2中的s2为s1;再将s1进行四等分,以右上方区域为起始区域并按逆时针方向依次编号为s11,s12,s13,s14,中心记为o点;
步骤a2、比较ri,i+1与di的大小,排除不可能的区域,逐步缩小目标位置所在区域,其中di=do,i-do,i+1,do,i为o点与基站i的距离,其中i=1,2;具体如下:
若目标点位于第一象限内,则:
当r1,2>d1,则目标点所在区域排除s12;当r1,2<d1,则目标点所在区域排除s14;
当r2,3>d2,则目标点所在区域排除s13;当r2,3<d2,则目标点所在区域排除s11;
结合r1,2和r2,3来确定区域缩小后的区域s2;如图2中,区域s2即为s12~s13构成的区域。
若目标点位于第三象限内,则:
当r1,2>d1,则目标点所在区域排除s13;当r1,2<d1,则目标点所在区域排除s11;
当r2,3>d2,则目标点所在区域排除s14;当r2,3<d2,则目标点所在区域排除s12;
同样结合r1,2和r2,3确定区域缩小后的区域s2;
步骤a3、重复步骤a1与步骤a2,直至目标所处区域s2的面积小于设定值(可根据实际情况来设定),则此时区域s2的几何中心即为所估计的目标点的位置。
情况二:
若r1,2×r2,3<0,则表示目标点位于第二象限或者第四象限内,此时使用基站2~基站4定位;步骤如下:
步骤b1、确定新的待划分区域s1,若是第一次确定s1,则令象限围成的区域为s1,否则令步骤b2中的s2为s1;再将s1进行四等分,以右上方区域为起始区域并按逆时针方向依次编号为s11,s12,s13,s14,中心记为o点;
步骤b2、比较ri,i+1与di的大小,排除不可能的区域,逐步缩小目标位置所在区域,其中di=do,i-do,i+1,do,i为o点与基站i的距离,其中i=2,3;具体如下:
若目标点位于第二象限内,则:
当r2,3>d2,则目标点所在区域排除s13;当r2,3<d2,则目标点所在区域排除s11;
当r3,4>d3,则目标点所在区域排除s14;当r3,4<d3,则目标点所在区域排除s12;
结合r2,3和r3,4来确定区域缩小后的区域s2;
若目标点位于第四象限内,则:
当r2,3>d2,则目标点所在区域排除s14;当r2,3<d2,则目标点所在区域排除s12;
当r3,4>d3,则目标点所在区域排除s11;当r3,4<d3,则目标点所在区域排除s13;
同样结合r2,3和r3,4确定区域缩小后的区域s2;
步骤b3、重复步骤b1与步骤b2,直至目标所处区域s2的面积小于设定值,则此时区域s2的几何中心即为所估计的目标点的位置。
情况三:
若目标点位于象限的边沿上,则r1,2×r2,3=0;若r1,2=r2,3=0,则矩形区域的中心点即为目标点的位置;
若r1,2与r2,3中仅有一个为零,假设r1,2=0,r2,3<0,则估计目标点位置的步骤如图3所示,具体如下:
步骤c1、确定新的待划分区域s1,若是第一次确定s1,则令以目标点位置所在边为公共边的两相邻象限围成的区域为s1,此处为第三象限和第四象限,否则令步骤c2中的s2为s1;再将s1进行四等分,以右上方区域为起始区域并按逆时针方向依次编号为s11,s12,s13,s14,中心记为o点;
步骤c2、比较r2,3与d2的大小,排除两个矩形模块,剩下的两个矩形模块即为目标所处区域s2,其中d2=do,2-do,3,do,i为o点与基站i的距离;如图3所示,假如,r2,3>d2,则区域s2由s11和s12构成;
步骤c3、重复步骤c1与步骤c2,直至目标所处区域s2的面积小于设定值,则此时区域s2的几何中心即为所估计的目标点的位置。
本发明实施例上述方案中,针对位置呈矩形分布的基站节点,利用tdoa信息不断缩小估计位置所在的方形区域,最终确定目标位置,具有定位速度快、精度高、稳定性好的优点,可用于基于tdoa的高精度定位系统。
通过以上的实施方式的描述,本领域的技术人员可以清楚地了解到上述实施例可以通过软件实现,也可以借助软件加必要的通用硬件平台的方式来实现。基于这样的理解,上述实施例的技术方案可以以软件产品的形式体现出来,该软件产品可以存储在一个非易失性存储介质(可以是cd-rom,u盘,移动硬盘等)中,包括若干指令用以使得一台计算机设备(可以是个人计算机,服务器,或者网络设备等)执行本发明各个实施例所述的方法。
以上所述,仅为本发明较佳的具体实施方式,但本发明的保护范围并不局限于此,任何熟悉本技术领域的技术人员在本发明披露的技术范围内,可轻易想到的变化或替换,都应涵盖在本发明的保护范围之内。因此,本发明的保护范围应该以权利要求书的保护范围为准。