CN112180319A - 一种基于左、右手性空间定位系统及其定位方法 - Google Patents
一种基于左、右手性空间定位系统及其定位方法 Download PDFInfo
- Publication number
- CN112180319A CN112180319A CN202010846316.8A CN202010846316A CN112180319A CN 112180319 A CN112180319 A CN 112180319A CN 202010846316 A CN202010846316 A CN 202010846316A CN 112180319 A CN112180319 A CN 112180319A
- Authority
- CN
- China
- Prior art keywords
- coordinate system
- handed
- base station
- base stations
- beacon
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Granted
Links
Images
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S5/00—Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations
- G01S5/0009—Transmission of position information to remote stations
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S5/00—Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations
- G01S5/02—Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations using radio waves
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06F—ELECTRIC DIGITAL DATA PROCESSING
- G06F17/00—Digital computing or data processing equipment or methods, specially adapted for specific functions
- G06F17/10—Complex mathematical operations
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06F—ELECTRIC DIGITAL DATA PROCESSING
- G06F17/00—Digital computing or data processing equipment or methods, specially adapted for specific functions
- G06F17/10—Complex mathematical operations
- G06F17/16—Matrix or vector computation, e.g. matrix-matrix or matrix-vector multiplication, matrix factorization
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Mathematical Physics (AREA)
- Theoretical Computer Science (AREA)
- Data Mining & Analysis (AREA)
- Mathematical Optimization (AREA)
- Mathematical Analysis (AREA)
- Computational Mathematics (AREA)
- Pure & Applied Mathematics (AREA)
- Algebra (AREA)
- Remote Sensing (AREA)
- Databases & Information Systems (AREA)
- Software Systems (AREA)
- General Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Computing Systems (AREA)
- Mobile Radio Communication Systems (AREA)
Abstract
Description
技术领域
本发明涉及测距和定位技术领域,尤其涉及一种基于左、右手性空间定位系统及其定位方法。
背景技术
2016年,虞坤霖等人(申请公布号:CN 106211080A)申请的《一种UWB基站坐标自校准方法》专利中提出,采用标签来校准基站变动后的位置,但是专利中并没有实质性的说明怎样使用标签来自动标定基站的坐标。
2017年,朱晓章等人(申请公布号:CN 106990389A)申请的《定位系统中基站间建立坐标系的方法》专利中提出,利用基站间距离建立坐标系的方法解决了现有技术中采用借助全站仪、激光测距仪等测量仪器进行人工测量的方式建立坐标系,但是存在的问题是,该定位系统在建立坐标系时,首先需要明确各个基站的大致方位,对于非视距或者方位不清楚的情况下,仍然无法正常获取定位数据。
2018年,田世伟等人(申请公布号:CN 109218967A)申请的《U WB系统定位基站标定方法及其设备》专利中提出,采用人工测量的方式测量待标定基站在当前定位环境中的真实坐标值,进而建立参考坐标系,此种方式建立的参考坐标系精度不高,具有人为误差影响。
2019年,许晟等人(申请公布号:CN 110290463A)申请的《基于最优化理论的UWB基站坐标自动标定方法和系统》专利中提出,首先将基站以及标签放置相应位置,构建最小UWB系统,并采用最优化理论,对所有理论距离和实际测量距离的残差和进行最优化处理,进而校准系统,在一定程度上,实现了自动化校准过程,但是对于最小UWB系统参考坐标系的建立,仍然采用人为规定基站以及标签放置位置的方式,人为决策多,不具有灵活性。
现有的建立坐标系以及测量基站位置的方法多采用借助全站仪、激光测距仪等测量仪器进行人工测量的方式。人工测量的方式耗费的人力成本巨大,且受限于基站的布设环境,此外,由于仪器的测量误差、人为误差等影响,此种方法测量基站位置的精度较差,甚至位置的准确度,会严重影响对目标的进行定位时的准确度。
因此,需要提供一种定位系统及方法来解决以上问题。
发明内容
本发明为了解决现有的基站需要人为设定同时测量不准确的问题,进而提供一种基于左、右手性空间定位系统及其定位方法。
为了实现上述目的,本发明采用了如下技术方案:
一种基于左、右手性空间定位系统,在满足分布式局部定位基站局部区域分布密度的情况下,随机安装四个基站,四个不共面的基站A、B、C、D组成一个基础定位系统;
右手性空间定位系统包括以下步骤:
左手性空间定位系统包括以下步骤:
进一步,四个基站所构成的三棱锥以各个顶点(A,B,C,D)对应的高(HA,HB,HC,HD)大于基站测距精度。
一种基于左、右手性空间定位方法,两两基站之间的距离通过基础定位系统内部基站互相测量得到,分别表示为
进一步,以右手性空间定位系为标准建立虚拟坐标系,其中基站A、B、C、D的坐标为A(0,0,0),B(XB,YB,0),C(b,0,0),D(XD,YD,ZD),
G=(c2+d2-e2)2
H=(b2+d2-f2)2
K=(b2+c2-a2)2
当d2-ZD 2-XD 2>0时,
d2-ZD 2-XD 2=0时,YD=0。
进一步,实际基站A’、B’、C’、D’在虚拟坐标系中的位置为两两基站之间长度的映射,即 其中A’、B’、C’、D’与A、B、C、D分别互为映射,按照这样的映射关系,虚拟坐标系统与实际基站对应的坐标系统存在镜像或一致。
进一步,当右手性坐标系中的点与虚拟映射点一一对应且位置一致时,在空间移动信标Q,按照y→x→z轨迹移动,在虚拟坐标系中,同样会出现一个Q′点沿着y′→x′→z′移动,这个移动轨迹所构成的矢量坐标系为右手性空间坐标系轨迹。
进一步,当左手性坐标系中的点与虚拟映射点镜像时,在空间移动信标Q,按照y→x→z轨迹移动,在虚拟坐标系中,同样会出现一个Q′点沿着y′→x′→z′移动,对应的y′→x′→z′移动轨迹为左手性空间坐标系轨迹。
进一步,初始时刻信标Q于点O处,通过在右手性坐标系测距系统中的测距值,即信标Q到A、B、C、D四点的距离分别为LA、LB、LC、LD,通过四点空间定位法计算信标Q在O处的坐标Q′,信标Q在X、Y、Z处得到相应坐标X′、Y′、Z′,由虚拟坐标系得出的运动的轨迹用向量表示为对矢量和做外积运算,即从而在上的投影的内积为正值,表示右手性坐标系与虚拟坐标系是一致的。
进一步,初始时刻信标Q于点O处,通过在左手性坐标系测距系统中的测距值,即信标Q到A、B、C、D四点的距离分别为LA、LB、LC、LD,通过四点空间定位法计算信标Q在O处的坐标Q′,信标Q在X、Y、Z处得到相应坐标X′、Y′、Z′,由虚拟坐标系得出的运动的轨迹用向量表示为对矢量和做外积运算,即从而在上的投影的内积为负值,表示左手性坐标系与虚拟坐标系是镜像的。
本发明对于现有技术具有以下有益效果:
本发明通过建立左手性坐标系和右手性坐标系,两两基站间的距离通过互相测量得到,从而计算出虚拟坐标系中基站的坐标值;通过判断左手性坐标系和右手性坐标系与虚拟坐标系的关系,得知D基站竖直坐标的值,最终确定实际基站在虚拟坐标系中的坐标。本发明定位基站的安装部署随机,且通过简单计算即能够得到基站的坐标,不仅节省了人工测量的成本,同时测量更准确。
附图说明
为了更清楚地说明本发明具体实施方式或现有技术中的技术方案,下面将对具体实施方式或现有技术描述中所需要使用的附图作简单地介绍,显而易见地,下面描述中的附图是本发明的一些实施方式,对于本领域普通技术人员来讲,在不付出创造性劳动的前提下,还可以根据这些附图获得其他的附图。
图1是本发明右手性空间坐标系示意图;
图2是本发明左手性空间坐标系示意图;
图3是本发明右手性坐标系中的点与虚拟映射点重合时示意图;
图4是本发明左手性坐标系中的点与虚拟映射点镜像时示意图。
具体实施方式
下面将结合附图对本发明的技术方案进行清楚、完整地描述,显然,所描述的实施例是本发明一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都属于本发明保护的范围。
在本发明的描述中,需要说明的是,术语“中心”、“上”、“下”、“左”、“右”、“竖直”、“水平”、“内”、“外”等指示的方位或位置关系为基于附图所示的方位或位置关系,仅是为了便于描述本发明和简化描述,而不是指示或暗示所指的装置或元件必须具有特定的方位、以特定的方位构造和操作,因此不能理解为对本发明的限制。此外,术语“第一”、“第二”、“第三”仅用于描述目的,而不能理解为指示或暗示相对重要性。
在本发明的描述中,需要说明的是,除非另有明确的规定和限定,术语“安装”、“相连”、“连接”应做广义理解,例如,可以是固定连接,也可以是可拆卸连接,或一体地连接;可以是机械连接,也可以是电连接;可以是直接相连,也可以通过中间媒介间接相连,可以是两个元件内部的连通。对于本领域的普通技术人员而言,可以具体情况理解上述术语在本发明中的具体含义。
实施例1
结合附图1至图4说明本实施例:一种基于左、右手性空间定位系统,在满足分布式局部定位基站局部区域分布密度的情况下,随机安装N个基站,N>3,优选的,安装四个基站,且四个不共面的基站A、B、C、D组成一个基础定位系统,并且这四个基站的信号覆盖范围有公共信号区域。
右手性空间定位系统包括以下步骤:
左手性空间定位系统包括以下步骤:
进一步优化,四个基站所构成的三棱锥以各个顶点(A,B,C,D)对应的高(HA,HB,HC,HD)大于基站测距精度,精度度量用多次测量误差的均值表示,单位为米。
如此设置,通过在空间内任意安装基站,由于基站的坐标方位不同,从而可以得到两个空间坐标系。
实施例2
结合实施例一说明本实施例,一种基于左、右手性空间定位方法,两两基站之间的距离通过基础定位系统内部基站互相测量得到,分别表示为
通过对各方位向量进行设定,方便后续计算。
进一步优化,以右手性空间定位系为标准建立虚拟坐标系,其中基站A、B、C、D的坐标为A(0,0,0),B(XB,YB,0),C(b,0,0),D(XD,YD,ZD),其中,
S表示△ABC的面积,
G=(c2+d2-e2)2
H=(b2+d2-f2)2
K=(b2+c2-a2)2
当d2-ZD 2-XD 2>0时,
d2-ZD 2-XD 2=0时,YD=0。
如此设置,可通过计算获得基站的具体坐标值,从而确定其位置。
实施例3
结合实施例一至二说明本实施方式,实际基站A’、B’、C’、D’在虚拟坐标系中的位置为两两基站之间长度的映射,即 其中A’、B’、C’、D’与A、B、C、D分别互为映射,按照这样的映射关系,虚拟坐标系统与实际基站对应的坐标系统存在镜像或一致。
作为优选的,当右手性坐标系中的点与虚拟映射点一一对应且位置一致时,在空间移动信标Q,按照y→x→z轨迹移动,在虚拟坐标系中,同样会出现一个Q′点沿着y′→x′→z′移动,这个移动轨迹所构成的矢量坐标系为右手性空间坐标系轨迹;
进一步,当左手性坐标系中的点与虚拟映射点镜像时,在空间移动信标Q,按照y→x→z轨迹移动,在虚拟坐标系中,同样会出现一个Q′点沿着y′→x′→z′移动,对应的y′→x′→z′移动轨迹为左手性空间坐标系轨迹;
如此设置,通过运动轨迹的不同从而区分了左、右手性空间坐标系,手性的不同决定着算法的不同。
实施例4
结合实施例一至三说明本实施方式,初始时刻信标Q于点O处,通过在右手性坐标系测距系统中的测距值,即信标Q到A、B、C、D四点的距离分别为LA、LB、LC、LD,通过四点空间定位法计算信标Q在O处的坐标Q′,信标Q在X、Y、Z处得到相应坐标X′、Y′、Z′,由虚拟坐标系得出的运动的轨迹用向量表示为根据右手螺旋定则,对矢量和做外积运算,即从而在上的投影的内积为正值,表示右手性坐标系与虚拟坐标系是一致的;
进一步,初始时刻信标Q于点O处,通过在左手性坐标系测距系统中的测距值,即信标Q到A、B、C、D四点的距离分别为LA、LB、LC、LD,通过四点空间定位法计算信标Q在O处的坐标Q′,信标Q在X、Y、Z处得到相应坐标X′、Y′、Z′,由虚拟坐标系得出的运动的轨迹用向量表示为根据右手螺旋定则,对矢量和做外积运算,即从而在上的投影的内积为负值,表示左手性坐标系与虚拟坐标系是镜像的;
如此设置,通过初始计算,得知D基站竖坐标为正值时,右手性坐标系与虚拟坐标系一致,当D基站竖坐标为负值时,左手性坐标系与虚拟坐标系镜像,由此可知,实际的基站A、B、C、D在虚拟坐标系中的坐标可被确定。
最后应说明的是:以上各实施例仅用以说明本发明的技术方案,而非对其限制;尽管参照前述各实施例对本发明进行了详细的说明,本领域的普通技术人员应当理解:其依然可以对前述各实施例所记载的技术方案进行修改,或者对其中部分或者全部技术特征进行等同替换;而这些修改或者替换,并不使相应技术方案的本质脱离本发明各实施例技术方案的范围。
Claims (10)
2.根据权利要求1所述一种基于左、右手性空间定位系统,其特征在于,四个基站所构成的三棱锥以各个顶点(A,B,C,D)对应的高(HA,HB,HC,HD)大于基站测距精度。
6.根据权利要求5所述一种基于左、右手性空间定位方法,其特征在于,当右手性坐标系中的点与虚拟映射点一一对应且位置一致时,在空间移动信标Q,按照y→x→z轨迹移动,在虚拟坐标系中,同样会出现一个Q′点沿着y′→x′→z′移动,这个移动轨迹所构成的矢量坐标系为右手性空间坐标系轨迹。
7.根据权利要求6所述一种基于左、右手性空间定位系统及其定位方法,其特征在于,当左手性坐标系中的点与虚拟映射点镜像时,在空间移动信标Q,按照y→x→z轨迹移动,在虚拟坐标系中,同样会出现一个Q′点沿着y′→x′→z′移动,对应的y′→x′→z′移动轨迹为左手性空间坐标系轨迹。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010846316.8A CN112180319B (zh) | 2020-08-21 | 2020-08-21 | 一种基于左、右手性空间定位系统及其定位方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010846316.8A CN112180319B (zh) | 2020-08-21 | 2020-08-21 | 一种基于左、右手性空间定位系统及其定位方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN112180319A true CN112180319A (zh) | 2021-01-05 |
CN112180319B CN112180319B (zh) | 2022-11-29 |
Family
ID=73925730
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202010846316.8A Active CN112180319B (zh) | 2020-08-21 | 2020-08-21 | 一种基于左、右手性空间定位系统及其定位方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN112180319B (zh) |
Citations (12)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20070257841A1 (en) * | 2004-07-26 | 2007-11-08 | Siemens Aktiengesellschaft | Method And Apparatus For Localizing A Mobile Transmitter Embodied As An Identification Device, Especially A Vehicle Key |
US20080234930A1 (en) * | 2007-03-21 | 2008-09-25 | Jadi Inc. | Navigation unit and base station |
CN102595594A (zh) * | 2012-02-22 | 2012-07-18 | 江苏大学 | 一种基于节点分布密度的无线传感网络节点定位方法 |
CN104091053A (zh) * | 2014-06-26 | 2014-10-08 | 李南君 | 用于自动检测行为模式的方法和设备 |
US20150261373A1 (en) * | 2014-03-17 | 2015-09-17 | Google Inc. | Determining User Handedness and Orientation Using a Touchscreen Device |
CN107121109A (zh) * | 2017-06-12 | 2017-09-01 | 北京航空航天大学 | 一种基于前镀膜平面镜的结构光参数标定装置及方法 |
CN108416812A (zh) * | 2018-03-20 | 2018-08-17 | 中国电子科技集团公司第五十四研究所 | 一种单摄像机镜像双目视觉系统的标定方法 |
CN108871346A (zh) * | 2018-08-14 | 2018-11-23 | 广东宝乐机器人股份有限公司 | 机器人定位坐标系的校正方法和装置 |
CN109239663A (zh) * | 2017-07-10 | 2019-01-18 | 东芝泰格有限公司 | 定位装置及控制方法、定位系统 |
CN109541529A (zh) * | 2018-10-23 | 2019-03-29 | 北京凯乐比兴科技有限公司 | 一种基于uwb的idc机房的外来人员定位系统及方法 |
CN111007459A (zh) * | 2019-12-19 | 2020-04-14 | 浙江工业大学之江学院 | 一种动态拓扑定位方法 |
CN111207742A (zh) * | 2020-01-17 | 2020-05-29 | 西安科技大学 | 一种附加外方位元素约束的采煤机定位定姿方法 |
-
2020
- 2020-08-21 CN CN202010846316.8A patent/CN112180319B/zh active Active
Patent Citations (12)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20070257841A1 (en) * | 2004-07-26 | 2007-11-08 | Siemens Aktiengesellschaft | Method And Apparatus For Localizing A Mobile Transmitter Embodied As An Identification Device, Especially A Vehicle Key |
US20080234930A1 (en) * | 2007-03-21 | 2008-09-25 | Jadi Inc. | Navigation unit and base station |
CN102595594A (zh) * | 2012-02-22 | 2012-07-18 | 江苏大学 | 一种基于节点分布密度的无线传感网络节点定位方法 |
US20150261373A1 (en) * | 2014-03-17 | 2015-09-17 | Google Inc. | Determining User Handedness and Orientation Using a Touchscreen Device |
CN104091053A (zh) * | 2014-06-26 | 2014-10-08 | 李南君 | 用于自动检测行为模式的方法和设备 |
CN107121109A (zh) * | 2017-06-12 | 2017-09-01 | 北京航空航天大学 | 一种基于前镀膜平面镜的结构光参数标定装置及方法 |
CN109239663A (zh) * | 2017-07-10 | 2019-01-18 | 东芝泰格有限公司 | 定位装置及控制方法、定位系统 |
CN108416812A (zh) * | 2018-03-20 | 2018-08-17 | 中国电子科技集团公司第五十四研究所 | 一种单摄像机镜像双目视觉系统的标定方法 |
CN108871346A (zh) * | 2018-08-14 | 2018-11-23 | 广东宝乐机器人股份有限公司 | 机器人定位坐标系的校正方法和装置 |
CN109541529A (zh) * | 2018-10-23 | 2019-03-29 | 北京凯乐比兴科技有限公司 | 一种基于uwb的idc机房的外来人员定位系统及方法 |
CN111007459A (zh) * | 2019-12-19 | 2020-04-14 | 浙江工业大学之江学院 | 一种动态拓扑定位方法 |
CN111207742A (zh) * | 2020-01-17 | 2020-05-29 | 西安科技大学 | 一种附加外方位元素约束的采煤机定位定姿方法 |
Non-Patent Citations (4)
Title |
---|
MAHDI GHAZIZADEH AHSAEE: "New Fault-Location Algorithm for Transmission Lines Including Unified Power-Flow Controller", 《 IEEE TRANSACTIONS ON POWER DELIVERY》 * |
张旭等: "基于镜面反射的手眼标定方法", 《中国机械工程》 * |
王益曼等: "拖拉机智能装配车间定位系统设计", 《机械》 * |
赵占国等: "RTK平面测绘基准及其应用变换", 《矿山测量》 * |
Also Published As
Publication number | Publication date |
---|---|
CN112180319B (zh) | 2022-11-29 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN107782240B (zh) | 一种二维激光扫描仪标定方法、系统及装置 | |
CN108413988B (zh) | 机器人末端经纬仪坐标系快速标定方法 | |
CN109031359B (zh) | 一种基于微波暗室的gnss接收天线绝对相位中心校正方法 | |
CN111044046B (zh) | 一种机器人定位精度的测试方法及装置 | |
CN104677280A (zh) | 摆臂式轮廓仪旋转轴空间状态标定方法 | |
CN110687508A (zh) | 微变雷达监测数据的校正方法 | |
CN110045340A (zh) | 平面相控阵天线中信标天线的坐标测算方法 | |
CN103278095B (zh) | 一维可伸缩式靶标装置及其标定特征点的产生方法 | |
CN112180322A (zh) | 一种空间定位系统建立基础坐标系方法 | |
CN110672031A (zh) | 一种同时以点与面特征约束的三维激光扫描的检校方法 | |
CN109883406A (zh) | 基于更少点的全站仪概略位姿的计算方法及系统 | |
CN116123998A (zh) | 多站点基于视频采集对空中炸点进行实时测量方法 | |
CN112180321A (zh) | 应用于3d定位系统操控坐标系相对位置的调整方法 | |
CN110779503B (zh) | 一种三维精密控制网测量方法 | |
CN112180319A (zh) | 一种基于左、右手性空间定位系统及其定位方法 | |
CN116412839A (zh) | 水陆一体化点云测距系统及校准方法 | |
CN104330077B (zh) | 一种基于两点对中模型的联合测量方法 | |
CN113777569B (zh) | 一种雷达联动光电的自动化动态标校方法及系统 | |
CN113446985B (zh) | 一种反射面天线电轴指向标定方法 | |
CN115289999A (zh) | 一种三维激光扫描系统的自校准方法 | |
CN115840186A (zh) | 基于云rtk无线电监测设备的测向测距示准方法及装置 | |
CN113063422B (zh) | 一种顾及钟差的5g终端室内定位方法 | |
CN112630751B (zh) | 一种激光雷达的标定方法 | |
CN110764165B (zh) | 一种基线测风的参数测量及仪器定向方法 | |
CN106646364B (zh) | 一种空间位置测量方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |