CN106526537A - 一种三维空间定位方法及系统 - Google Patents
一种三维空间定位方法及系统 Download PDFInfo
- Publication number
- CN106526537A CN106526537A CN201610917518.0A CN201610917518A CN106526537A CN 106526537 A CN106526537 A CN 106526537A CN 201610917518 A CN201610917518 A CN 201610917518A CN 106526537 A CN106526537 A CN 106526537A
- Authority
- CN
- China
- Prior art keywords
- moment
- signal
- laser
- receiving device
- rotation
- 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
- 238000000034 method Methods 0.000 title claims description 66
- 238000005259 measurement Methods 0.000 claims description 30
- 230000005540 biological transmission Effects 0.000 claims description 27
- 230000001360 synchronised effect Effects 0.000 claims description 21
- 230000004927 fusion Effects 0.000 claims description 15
- 238000005267 amalgamation Methods 0.000 claims description 14
- 230000008569 process Effects 0.000 claims description 9
- 238000002604 ultrasonography Methods 0.000 claims description 9
- 238000004891 communication Methods 0.000 description 16
- XUIMIQQOPSSXEZ-UHFFFAOYSA-N Silicon Chemical compound [Si] XUIMIQQOPSSXEZ-UHFFFAOYSA-N 0.000 description 14
- 229910052710 silicon Inorganic materials 0.000 description 14
- 239000010703 silicon Substances 0.000 description 14
- 230000003287 optical effect Effects 0.000 description 12
- 238000007689 inspection Methods 0.000 description 8
- 238000001514 detection method Methods 0.000 description 7
- 238000005516 engineering process Methods 0.000 description 7
- 238000002372 labelling Methods 0.000 description 4
- 238000013398 bayesian method Methods 0.000 description 3
- 238000001914 filtration Methods 0.000 description 3
- 230000003993 interaction Effects 0.000 description 3
- 239000000203 mixture Substances 0.000 description 3
- 230000008901 benefit Effects 0.000 description 2
- 238000004364 calculation method Methods 0.000 description 2
- 241000208340 Araliaceae Species 0.000 description 1
- 235000005035 Panax pseudoginseng ssp. pseudoginseng Nutrition 0.000 description 1
- 235000003140 Panax quinquefolius Nutrition 0.000 description 1
- 230000003190 augmentative effect Effects 0.000 description 1
- 230000008859 change Effects 0.000 description 1
- 239000012141 concentrate Substances 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 230000005611 electricity Effects 0.000 description 1
- 235000008434 ginseng Nutrition 0.000 description 1
- 230000010354 integration Effects 0.000 description 1
- 230000004807 localization Effects 0.000 description 1
- 239000000155 melt Substances 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000007500 overflow downdraw method Methods 0.000 description 1
- 230000005622 photoelectricity Effects 0.000 description 1
- 238000012545 processing Methods 0.000 description 1
- 230000001960 triggered effect Effects 0.000 description 1
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
- G01S11/00—Systems for determining distance or velocity not using reflection or reradiation
- G01S11/14—Systems for determining distance or velocity not using reflection or reradiation using ultrasonic, sonic, or infrasonic waves
-
- 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
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/20—Instruments for performing navigational calculations
- G01C21/206—Instruments for performing navigational calculations specially adapted for indoor navigation
-
- 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
- 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
- G01S11/00—Systems for determining distance or velocity not using reflection or reradiation
- G01S11/16—Systems for determining distance or velocity not using reflection or reradiation using difference in transit time between electrical and acoustic signals
-
- 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
- G01S15/00—Systems using the reflection or reradiation of acoustic waves, e.g. sonar systems
- G01S15/02—Systems using the reflection or reradiation of acoustic waves, e.g. sonar systems using reflection of acoustic waves
- G01S15/06—Systems determining the position data of a target
- G01S15/08—Systems for measuring distance only
-
- 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/16—Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations using electromagnetic waves other than radio waves
-
- 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/18—Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations using ultrasonic, sonic, or infrasonic waves
-
- 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/18—Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations using ultrasonic, sonic, or infrasonic waves
- G01S5/26—Position of receiver fixed by co-ordinating a plurality of position lines defined by path-difference measurements
Landscapes
- Physics & Mathematics (AREA)
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- General Physics & Mathematics (AREA)
- Electromagnetism (AREA)
- Acoustics & Sound (AREA)
- Computer Networks & Wireless Communication (AREA)
- Automation & Control Theory (AREA)
- Optical Radar Systems And Details Thereof (AREA)
- Measurement Of Velocity Or Position Using Acoustic Or Ultrasonic Waves (AREA)
- Position Fixing By Use Of Radio Waves (AREA)
- Length Measuring Devices By Optical Means (AREA)
Abstract
一种三维空间定位方法,包括:当信号接收装置检测到信号发送装置绕着第一旋转轴旋转发送的第一激光平面信号以及绕着第二旋转轴旋转发送的第二激光平面信号时,根据信号发送装置发送第一激光平面信号的第一参考时刻、发送第二激光平面信号的第二参考时刻、信号接收装置检测到第一激光平面信号的第一时刻以及检测到第二激光平面信号的第二时刻,确定第一旋转角度以及第二旋转角度;根据信号发送装置发送测距信号的第三参考时刻以及信号接收装置检测到测距信号的第三时刻,确定两者之间的距离;根据第一旋转角度、第二旋转角度以及所述距离,确定信号接收装置在三维测量坐标系中的三维坐标。
Description
技术领域
本发明涉及定位技术,尤指一种三维空间定位方法及系统。
背景技术
随着移动设备和网络技术的发展,位置服务在人们的生活中越来越重要。目前的定位根据定位区域的不同可以分为室外定位以及室内定位。其中,室外定位主要通过卫星定位系统实现,目前的室外定位技术能够很好地满足室外定位的需求。然而,在室内进行定位时,由于受定位时间、定位精度以及室内复杂环境等条件的限制,室外定位技术应用于室内定位时无法满足用户的需求。
为了实现室内定位,相关方案例如通过室内全球定位系统(GPS,GlobalPositioning System)、红外线、蓝牙定位、WIFI定位、RFID(Radio FrequencyIdentification,射频识别)定位、双目定位等技术进行定位感知。然而,相关室内定位方案的成本较高、设备配置复杂且定位精度不足,无法满足人们在虚拟现实交互、增强现实交互、室内机器人导航等方面的需求。
发明内容
以下是对本文详细描述的主题的概述。本概述并非是为了限制权利要求的保护范围。
本发明实施例提供了一种三维空间定位方法及系统,能够实现室内精确定位。
本发明实施例提供了一种三维空间定位方法,包括:
当信号接收装置检测到信号发送装置绕着第一旋转轴旋转发送的第一激光平面信号以及绕着第二旋转轴旋转发送的第二激光平面信号时,根据信号发送装置发送第一激光平面信号的第一参考时刻、发送第二激光平面信号的第二参考时刻、信号接收装置检测到第一激光平面信号的第一时刻、检测到第二激光平面信号的第二时刻,确定第一旋转角度以及第二旋转角度;
其中,所述第一旋转角度为所述第一时刻所述第一激光平面信号相对于第一旋转轴与第二旋转轴所确定平面的角度,所述第二旋转角度为所述第二时刻所述第二激光平面信号相对于第一旋转轴与第二旋转轴所确定平面的角度;
根据信号发送装置发送测距信号的第三参考时刻以及信号接收装置检测到测距信号的第三时刻,确定信号接收装置与信号发送装置之间的距离;
根据所述第一旋转角度、所述第二旋转角度以及所述距离,确定信号接收装置在三维测量坐标系中的三维坐标。
其中,在第一参考时刻,信号发送装置发送的第一激光平面信号相对于第一旋转轴与第二旋转轴所确定平面的角度为第一参考角度;在第二参考时刻,信号发送装置发送的第二激光平面信号相对于第一旋转轴与第二旋转轴所确定平面的角度为第二参考角度。
其中,所述根据信号发送装置发送第一激光平面信号的第一参考时刻、发送第二激光平面信号的第二参考时刻、信号接收装置检测到第一激光平面信号的第一时刻、检测到第二激光平面信号的第二时刻,确定第一旋转角度以及第二旋转角度,包括:
根据信号发送装置和信号接收装置同步基准时刻之后的第一参考时刻、第二参考时刻、第一时刻以及第二时刻,确定第一旋转角度以及第二旋转角度。
其中,所述根据所述第一旋转角度、所述第二旋转角度以及所述距离,确定信号接收装置在三维测量坐标系中的三维坐标,包括:
当所述三维测量坐标系为笛卡尔坐标系,以所述第一旋转轴为X轴,以所述第二旋转轴为Y轴时,根据下式求解得到信号接收装置在该三维测量坐标系中的三维坐标:
其中,(X0,Y0,Z0)表示信号接收装置在三维测量坐标系中的三维坐标,L为信号接收装置与信号发送装置之间的距离,α为第一旋转角度,β为第二旋转角度。
其中,所述根据信号发送装置发送第一激光平面信号的第一参考时刻、发送第二激光平面信号的第二参考时刻、信号接收装置检测到第一激光平面信号的第一时刻、检测到第二激光平面信号的第二时刻,确定第一旋转角度以及第二旋转角度,包括:
根据信号发送装置发送第一激光平面信号的第一参考时刻以及信号接收装置检测到第一激光平面信号的第一时刻,确定所述第一时刻与所述第一参考时刻之间的关系,根据所述第一时刻与第一参考时刻之间的关系以及所述第一参考时刻对应的第一参考角度,确定所述第一旋转角度;
根据信号发送装置发送第二激光平面信号的第二参考时刻以及信号接收装置检测到第二激光平面信号的第二时刻,确定所述第二时刻与所述第二参考时刻之间的关系,根据所述第二时刻与第二参考时刻之间的关系以及所述第二参考时刻对应的第二参考角度,确定所述第二旋转角度。
其中,所述根据信号发送装置发送测距信号的第三参考时刻以及信号接收装置检测到测距信号的第三时刻,确定信号接收装置与信号发送装置之间的距离,包括:
根据信号发送装置发送测距信号的第三参考时刻以及信号接收装置检测到测距信号的第三时刻,确定所述测距信号从信号发送装置到信号接收装置的传输时长,根据所述传输时长以及测距信号在空气中的传输速度,确定信号接收装置与信号发送装置之间的距离。
其中,所述测距信号为超声波信号。
其中,当信号接收装置检测到的第一激光平面信号、第二激光平面信号均为多路时,所述三维空间定位方法还包括:
确定信号接收装置检测到每路第一激光平面信号的第一激光时刻,采用第一预设融合方式处理多个第一激光时刻,得到第一时刻;
确定信号接收装置检测到每路第二激光平面信号的第二激光时刻,采用第二预设融合方式处理多个第二激光时刻,得到第二时刻。
其中,当信号接收装置检测到的测距信号为多路时,所述三维空间定位方法还包括:确定信号接收装置检测到每路测距信号的测距时刻,采用第三预设融合方式处理多个测距时刻,得到第三时刻。
其中,所述第一旋转轴与所述第二旋转轴相互垂直。
本发明实施例还提供一种三维空间定位系统,包括:信号发送装置以及信号接收装置;所述信号发送装置,用于向信号接收装置发送测距信号、绕着第一旋转轴旋转发送第一激光平面信号以及绕着第二旋转轴旋转发送第二激光平面信号;所述信号接收装置,用于检测所述测距信号、所述第一激光平面信号以及所述第二激光平面信号。
其中,所述测距信号为超声波信号。
本发明实施例还提供一种计算机可读存储介质,存储有计算机可执行指令,所述计算机可执行指令被执行时实现上述的三维空间定位方法。
与相关技术相比,本发明实施例提供的三维空间定位方法包括:当信号接收装置检测到信号发送装置绕着第一旋转轴旋转发送的第一激光平面信号以及绕着第二旋转轴旋转发送的第二激光平面信号时,根据信号发送装置发送第一激光平面信号的第一参考时刻、发送第二激光平面信号的第二参考时刻、信号接收装置检测到第一激光平面信号的第一时刻、检测到第二激光平面信号的第二时刻,确定第一旋转角度以及第二旋转角度;根据信号发送装置发送测距信号的第三参考时刻以及信号接收装置检测到测距信号的第三时刻,确定信号接收装置与信号发送装置之间的距离;根据所述第一旋转角度、所述第二旋转角度以及所述距离,确定信号接收装置在三维测量坐标系中的三维坐标;其中,所述第一旋转角度为所述第一时刻所述第一激光平面信号相对于第一旋转轴与第二旋转轴所确定平面的角度,所述第二旋转角度为所述第二时刻所述第二激光平面信号相对于第一旋转轴与第二旋转轴所确定平面的角度。如此,本发明实施例能够基于测距信号、第一激光平面信号以及第二激光平面信号进行室内定位,且定位精度较高,从而满足人们在虚拟现实交互、增强现实交互、室内机器人导航等方面的需求。
进一步地,本发明实施例中,在信号接收装置检测到的第一激光平面信号、第二激光平面信号均为多路时,对检测到每路第一激光平面信号的时刻进行融合处理,得到第一时刻,对检测到每路第二激光平面信号的时刻进行融合处理,得到第二时刻;在信号接收装置检测到的测距信号为多路时,对检测到每路测距信号的时刻进行融合处理,得到第三时刻。如此,针对每种信号,通过对检测到多路信号的时刻进行融合处理后,再进行定位计算,实现信号的全向接收,达到稳定有效的室内全向定位,避免定位丢失。
本申请的其它特征和优点将在随后的说明书中阐述,并且,部分地从说明书中变得显而易见,或者通过实施本申请而了解。本申请的目的和其他优点可通过在说明书、权利要求书以及附图中所特别指出的结构来实现和获得。
附图说明
附图用来提供对本申请技术方案的进一步理解,并且构成说明书的一部分,与本申请的实施例一起用于解释本申请的技术方案,并不构成对本申请技术方案的限制。
图1为本发明实施例一的三维空间定位方法的流程图;
图2为应用本发明实施例一的三维空间定位方法的系统示意图;
图3为本发明实施例的三维坐标计算的原理图;
图4为本发明实施例二的三维空间定位方法的流程图;
图5为应用本发明实施例二的三维空间定位方法的系统示意图。
具体实施方式
下文中将结合附图对本申请的实施例进行详细说明,应当理解,以下所说明的实施例仅用于说明和解释本申请,并不用于限定本申请。需要说明的是,在不冲突的情况下,本申请中的实施例及实施例中的特征可以相互任意组合。
在附图的流程图示出的步骤可以在诸如一组计算机可执行指令的计算机系统中执行。并且,虽然在流程图中示出了逻辑顺序,但是在某些情况下,可以以不同于此处的顺序执行所示出或描述的步骤。
实施例一
如图1所示,本实施例提供一种三维空间定位方法,包括以下步骤:
步骤101:当信号接收装置检测到信号发送装置绕着第一旋转轴旋转发送的第一激光平面信号以及绕着第二旋转轴旋转发送的第二激光平面信号时,根据信号发送装置发送第一激光平面信号的第一参考信号、发送第二激光平面信号的第二参考时刻、信号接收装置检测到第一激光平面信号的第一时刻、检测到第二激光平面信号的第二时刻,确定第一旋转角度以及第二旋转角度;
其中,第一旋转角度为所述第一时刻第一激光平面信号相对于第一旋转轴和第二旋转轴所确定平面的角度,第二旋转角度为所述第二时刻第二激光平面信号相对于第一旋转轴和第二旋转轴所确定平面的角度。
其中,第一参考时刻为信号发送装置发送第一激光平面信号的时刻,在第一参考时刻,第一激光平面信号相对于第一旋转轴与第二旋转轴所确定平面的角度为第一参考角度;第二参考时刻为信号发送装置发送第二激光平面信号的时刻,在第二参考时刻,第二激光平面信号相对于第一旋转轴与第二旋转轴所确定平面的角度为第二参考角度。
在一些实现方式中,本步骤可以包括:根据信号发送装置和信号接收装置同步基准时刻之后的第一参考时刻、第二参考时刻、第一时刻以及第二时刻,确定第一旋转角度以及第二旋转角度。
其中,通过同步信号发送装置和信号接收装置的基准时刻,确保信号发送装置和信号接收装置的时钟同步,以确保后续进行的计算基于相同的基准,从而提高三维坐标计算的准确性。在一些实现方式中,信号发送装置可以向信号接收装置发送时间同步信号,信号接收装置可以将接收到时间同步信号的时刻作为基准时刻。
在一些实现方式中,本步骤可以包括:
根据信号发送装置发送第一激光平面信号的第一参考时刻以及信号接收装置检测到第一激光平面信号的第一时刻,确定所述第一时刻与所述第一参考时刻之间的关系,根据所述第一时刻与第一参考时刻之间的关系以及所述第一参考时刻对应的第一参考角度,确定所述第一旋转角度;
根据信号发送装置发送第二激光平面信号的第二参考时刻以及信号接收装置检测到第二激光平面信号的第二时刻,确定所述第二时刻与所述第二参考时刻之间的关系,根据所述第二时刻与第二参考时刻之间的关系以及所述第二参考时刻对应的第二参考角度,确定所述第二旋转角度。
在一些实现方式中,第一参考角度可以等于第二参考角度。然而,本实施例对此并不限定。
于本实施例中,需要说明的是,第一旋转轴与第二旋转轴所确定的平面包括以下情况:当第一旋转轴与第二旋转轴能够在一个平面内相交时,第一旋转轴与第二旋转轴所确定的平面即为第一旋转轴与第二旋转轴唯一确定的平面;当第一旋转轴与第二旋转轴不能在一个平面内相交时,第一旋转轴与第二旋转轴所确定的平面指第一旋转轴与第二旋转轴确定的一对平行平面。
其中,在第一旋转轴与第二旋转轴所确定的唯一平面或一对平行平面中,第一旋转轴与第二旋转轴之间的夹角为预设角度。预设角度可以由使用者预先设置。较佳地,第一旋转轴与第二旋转轴相互垂直。
步骤102:根据信号发送装置发送测距信号的第三参考时刻以及信号接收装置检测到测距信号的第三时刻,确定信号接收装置与信号发送装置之间的距离。
其中,步骤102可以包括:根据信号发送装置发送测距信号的第三参考时刻以及信号接收装置检测到测距信号的第三时刻,确定所述测距信号从信号发送装置到信号接收装置的传输时长,根据所述传输时长以及测距信号在空气中的传输速度,确定信号接收装置与信号发送装置之间的距离。
在一些实现方式中,测距信号可以为超声波信号。然而,本申请对此并不限定。于其他实现方式中,测距信号例如可以为激光束信号或者红外信号。
步骤103:根据第一旋转角度、第二旋转角度以及信号发送装置与信号接收装置之间的距离,确定信号接收装置在三维测量坐标系中的三维坐标。
其中,当所述三维测量坐标系为笛卡尔坐标系,以所述第一旋转轴为X轴,以所述第二旋转轴为Y轴时,可以根据下式求解得到信号接收装置在该三维测量坐标系中的三维坐标:
其中,(X0,Y0,Z0)表示信号接收装置在三维测量坐标系中的三维坐标,L为信号接收装置与信号发送装置之间的距离,α为第一旋转角度,β为第二旋转角度。
如图2所示,应用本实施例的三维空间定位方法的系统可以包括:信号接收装置以及信号发送装置。信号发送装置作为三维空间定位的参考坐标基点,信号接收装置作为待定位点。
其中,信号发送装置用于向信号接收装置发送测距信号、绕着第一旋转轴旋转发送第一激光平面信号以及绕着第二旋转轴旋转发送第二激光平面信号;信号接收装置用于检测测距信号、第一激光平面信号以及第二激光平面信号。较佳地,信号发送装置还用于向信号接收装置发送时间同步信号,信号接收装置还用于从信号发送装置接收时间同步信号,从而实现在信号发送装置和信号接收装置之间同步基准时刻。较佳地,第一旋转轴与第二旋转轴相互垂直。
下面以信号发送装置为定位基站,信号接收装置为待定位标记设备为例进行说明。其中,待定位标记设备的数目为至少一个,即一个定位基站可以向至少一个待定位标记设备提供定位数据。
如图2所示,定位基站(信号发送装置)包括:第一同步装置、控制器、两个旋转激光平面发射器(旋转激光平面发射器A及B)以及测距信号发射器(例如,超声波发射器)。其中,第一同步装置用于实现和待定位标记设备之间的信息通信,例如可以向待定位标记设备(信号接收装置)发送时间同步信号,以使得待定位标记设备可以同步基准时刻;旋转激光平面发射器A用于绕着第一旋转轴旋转发送第一激光平面信号;旋转激光平面发射器B用于绕着垂直于第一旋转轴的第二旋转轴旋转发送第二激光平面信号;测距信号发射器用于发送测距信号;控制器用于控制时间同步信号、测距信号、第一激光平面信号以及第二激光平面信号的发射时刻。下面测距信号发射器以超声波发射器为例进行说明。
可选地,第一旋转轴与第二旋转轴能够相交。然而,本实施例对此并不限定。于实际应用中,第一旋转轴与第二旋转轴可不相交,例如,第一旋转轴与第二旋转轴确定的一对平行平面之间的垂直距离在相应的预定范围内。
可选地,超声波发射器位于第一旋转轴与第二旋转轴的交点处。然而,本实施例对此并不限定。于实际应用中,超声波发射器可位于第一旋转轴与第二旋转轴的交点附近(例如,以该交点为球心的预定范围内)。此外,当第一旋转轴与第二旋转轴不相交时,超声波发射器可位于第一交点处或附近(例如,以该第一交点为球心的预定范围内),该第一交点为垂直于第一旋转轴且平行于第二旋转轴的直线与第一旋转轴的交点;或者,超声波发射器可位于第二交点处或附近(例如,以该第二交点为球心的预定范围内),该第二交点为垂直于第二旋转轴且平行于第一旋转轴的直线与第二旋转轴的交点。
可选地,第一同步装置例如为无线电通信电路。然而,本实施例对此并不限定。于其他实施例中,第一同步装置例如为发光二极管(LED,Light Emitting Diode),通过发送光信号,用于时间同步。或者,第一同步装置也可以是一个IC(Integrated Circuit,集成电路)芯片和天线组成的通信模块。
可选地,每个旋转激光平面发射器(例如,旋转激光平面发射器A或B)可以包括一个激光发射器、一个透镜以及一个电动机(例如,直流电动机)。例如,激光发射器可以设置在电动机上,激光发射器可以沿着电动机的转轴将一束激光发射到电动机转轴上的透镜,该束激光通过透镜形成一个激光平面,电动机带动透镜旋转,从而形成旋转激光平面。或者,激光发射器可以不设置在电动机上,激光发射器可以将一束激光发射到电动机转轴的镜面上,镜面可以将激光反射并通过透镜使激光束成为一个跟随电动机转动的激光面。然而,本实施例对此并不限定。于其他实现方式中,可以不采用透镜,而使用光栅等其他可以形成平面信号的光学元件。
在电动机转动的时候,控制器(例如,单片机控制器)可以控制电动机的转速和激光发射器的启停,使激光面以一定的频率扫过整个室内空间。两个旋转激光平面发射器中的两个激光发射器相互垂直安装,两个形成散射激光面的电动机也相互垂直安装,且两个电动机的转轴可以分别记为X轴(如前述的第一旋转轴)和Y轴(如前述的第二旋转轴),X轴垂直于Y轴。X轴上的电动机使激光面沿着X轴方向扫过空间,Y轴上的电动机使激光面沿着Y轴方向扫过空间。需要说明的是,在信号接收装置中用于接收激光平面信号的激光平面信号接收器(例如,包括硅光电池)在同一时刻只能接收一束激光信号时,X轴上的激光面与Y轴上的激光面要时分(TD,Time Division)发送,以使得激光平面信号接收器可以交替接收X轴上的激光面和Y轴上的激光面。
其中,关于电动机的转速控制和激光发射器的启停可以由单片机控制器(即前述的控制器)完成。可以通过PID(比例、积分、微分,Proportion、Integral、Derivative)算法对电动机进行调速,例如可采用增量式PID算法,该算法的公式如下:
Δuk=A×ek-B×ek-1+C×ek-2;
其中,ek、ek-1、ek-2为连续三次的误差项,A、B、C为加权系数,Δuk为当前增量。
经过PID控制,电动机可以使得激光面按照固定的频率扫过室内空间。
此外,可以通过在电机转子上设置标识点的方式实现对激光发射器的启停控制。例如,当识别到X轴的电动机上的标识点后,启动X轴上的激光发射器并关闭Y轴上的激光发射器,当识别到Y轴的电动机上的标识点后,启动Y轴上的激光发射器并关闭X轴上的激光发射器。可以采用位置式PID算法对电机进行控制,使得标识点在所要求时刻到达指定位置。位置式PID算法公式如下:
其中,e()为误差项,Kp、Ki、Kd为PID系数,u(k)为当前位置。
在对电动机和激光发射器进行控制的同时,单片机控制器可以控制第一同步装置发送时间同步信号(用于同步基准时刻)和启动超声波发射器发送超声波信号。例如,单片机控制器可以控制第一同步装置在t1时刻发送时间同步信号,控制超声波发射器在t2时刻(即前述的第三参考时刻)发送超声波信号,控制X轴上的旋转激光平面发射器A在t3时刻(如前述的第一参考时刻)发送X轴激光面信号(如前述的第一激光平面信号),控制Y轴上的旋转激光平面发射器B在t4时刻(如前述的第二参考时刻)发送Y轴激光面信号(如前述的第二激光平面信号),其中,t1时刻可以早于t2时刻,t2时刻可以早于t3时刻,t3时刻可以早于t4时刻。然而,本申请对此并不限定。例如,上述信号的发射时刻可以根据以下条件进行设置:在一个发射周期中,时间同步信号的发射时刻早于超声波信号以及激光面信号的发射时刻,X轴激光面信号的发射时刻不同于Y轴激光面信号的发射时刻。较佳地,第一同步装置、旋转激光平面发射器A、超声波发射器在同一时刻发送信号,旋转激光平面发射器B发送信号的时刻迟于前述时刻。若超声波发射器发送信号的时刻迟于旋转激光平面发射器A发送信号的时刻,则该延迟时长应小于激光平面旋转一周的时长。
如图2所示,待定位标记设备(信号接收装置)可以包括:第二同步装置、激光平面信号接收器(例如,光电感应电路)以及测距信号接收器(例如,超声波接收器)。其中,第二同步装置用于实现和定位基站之间的信息通信,例如可以从定位基站的第一同步装置接收时间同步信号,用于同步基准时刻;激光平面信号接收器用于检测定位基站发送的第一激光平面信号以及第二激光平面信号;测距信号接收器用于检测定位基站发送的测距信号。下面测距信号接收器以超声波接收器(例如,超声换能器)为例进行说明。
可选地,第二同步装置例如为无线电通信电路,或者,也可以是一个IC芯片和天线组成的通信模块。然而,本实施例对此并不限定。于其他实施例中,第二同步装置还可以接收光信号进行时间同步。需要说明的是,第一同步装置与第二同步装置需要对应,例如,当第一同步装置为无线电通信电路时,第二同步装置亦为无线电通信电路。换言之,第一同步装置与第二同步装置采用对应的信号发射与信号检测技术,以实现定位基站与待定位标记设备之间的时间同步。
可选地,激光平面信号接收器包括硅光电池,用于检测激光平面信号。
于本实施例中,定位基站的第一同步装置向待定位标记设备的第二同步装置发送时间同步信号,用于同步基准时刻;定位基站的旋转激光平面发射器的激光点亮,且定位基站内部的电机支架带动激光面旋转,不断向周围空间旋转发射激光平面信号;定位基站的超声波发射器向周围空间不断发送超声波信号,例如以10Hz的脉冲频率,40KHz的调制频率发送超声波。如此,定位基站可以为待定位标记设备提供高精度、高频率、低延迟的定位数据。同时,待定位标记设备的第二同步装置会检测时间同步信号,以同步基准时刻;激光平面信号接收器在被激光平面信号扫到时,会记录被扫到的时刻;超声波接收器在检测到超声波信号时,会记录检测到超声波信号的时刻。
可选地,待定位标记设备还可以包括:处理器,用于根据本实施例的三维空间定位方法计算待定位标记设备在三维测量坐标系内的三维坐标。此时,待定位标记设备还可以接收定位基站发送的第一参考时刻、第二参考时刻以及第三参考时刻,以便于待定位标记设备的处理器进行三维坐标的计算。然而,本申请对此并不限定。于其他实施例中,还可以由定位基站(例如,其中的控制器)根据本实施例的三维空间定位方法计算待定位标记设备在三维测量坐标系内的三维坐标。此时,定位基站可以接收待定位标记设备发送的第一时刻、第二时刻以及第三时刻,以便于定位基站进行三维坐标的计算。而且,定位基站可以将计算得到的三维坐标信息发送给待定位标记设备。于其他实施例中,还可以单独设置三维空间定位装置,三维空间定位装置可以与定位基站和待定位标记设备实现通信,用于根据本实施例的三维空间定位方法计算待定位标记设备在三维测量坐标系内的三维坐标。此时,三维空间定位装置可以接收定位基站发送的基准时刻、第一参考时刻、第二参考时刻以及第三参考时刻,还可以接收待定位标记设备发送的第一时刻、第二时刻以及第三时刻,以便于三维空间定位装置进行三维坐标的计算。而且,三维空间定位装置还可以将计算得到的三维坐标信息发送给待定位标记设备。
下面参照图3,以待定位标记设备执行图1所示的三维空间定位方法为例进行详细说明。
如图3所示,以三维测量坐标系为笛卡尔坐标系为例进行说明。其中,以第一旋转轴为X轴,以第二旋转轴为Y轴,定位基站的超声波发射器所在位置为三维测量坐标系的原点O。然而,本实施例对此并不限定。于实际应用中,定位基站所在位置例如为原点O(此时,超声波发射器的所在位置可能位于原点O附近)。定位基站的旋转激光平面发射器A绕着X轴旋转发送第一激光平面信号,转速例如为w1;定位基站的旋转激光平面发射器B绕着Y轴旋转发送第二激光平面信号,转速例如为w2。X轴和Y轴所确定的平面为XOY平面。然而,本实施例对此并不限定。于实际应用中,定位基站的旋转激光平面发射器A例如绕着平行于X轴的第一旋转轴旋转发送第一激光平面信号,定位基站的旋转激光平面发射器B绕着Y轴(第二旋转轴)旋转发送第二激光平面信号,且第一旋转轴与Y轴垂直且不相交,此时,第一旋转轴与Y轴能够确定一对平行平面(包括XOY平面以及与XOY平面平行的平面);或者,定位基站的旋转激光平面发射器A绕着X轴(第一旋转轴)旋转发送第一激光平面信号,定位基站的旋转激光平面发射器B例如绕着平行于Y轴的第二旋转轴旋转发送第二激光平面信号,且第二旋转轴与X轴垂直且不相交,此时,第二旋转轴与X轴能够确定一对平行平面(包括XOY平面以及与XOY平面平行的平面)。其中,该对平行平面之间的垂直距离例如在预定范围内。
其中,定位基站通过第一同步装置(如无线电通信电路)向待定位标记设备同步基准时刻。其中,通过基准时刻的同步,确保定位基站与待定位标记设备能够保持时钟同步,以确保后续涉及的时刻信息基于同一基准。然而,本实施例对此并不限定。定位基站还可以通过产生光信号向待定位标记设备同步基准时刻。
其中,定位基站还会通过第一同步装置(如无线电通信电路)向待定位标记设备传输发送第一激光平面信号以及第二激光平面信号的参考时刻。于此,将定位基站的旋转激光平面发射器A在第一参考角度发射第一激光平面信号的时刻称为第一参考时刻,将定位基站的旋转激光平面发射器B在第二参考角度发射第二激光平面信号的时刻称为第二参考时刻。其中,第一参考时刻以及第二参考时刻为不同时刻。第一参考角度与第二参考角度可相同或不同。
例一:
第一参考角度和第二参考角度例如均为0,即在第一参考时刻(或第二参考时刻),旋转激光平面发射器A(或B)发送的激光平面信号相对于XOY平面的第一参考角度α'为0。其中,旋转激光平面发射器A和B的转速可以相同。
其中,当定位基站的旋转激光平面发射器A(或B)每次旋转至第一参考角度(或第二参考角度)发送激光平面信号时,定位基站会通过第一同步装置(如无线电通信电路)向待定位标记设备发送第一参考时刻(或第二参考时刻)。
于此,参照图3,当第一参考角度为0(即旋转平面S1与XOY平面的夹角为0)时,以第一激光平面信号为例进行说明,第一旋转角度α为旋转平面S1与XOY平面的夹角。
当定位基站的旋转激光平面发射器A绕着X轴顺时针旋转发送第一激光平面信号时,360-α=(T1-T0)w1;
当定位基站的旋转激光平面发射器A绕着X轴逆时针旋转发送第一激光平面信号时,α=(T1-T0)w1;
其中:α为第一旋转角度,T1为待定位标记设备检测到第一激光平面信号的时刻,T0为待定位标记设备最近一次从定位基站接收到的第一参考时刻;w1为定位基站的旋转激光平面发射器A的转速。
在一个具体实施例中,当定位基站的旋转激光平面发射器A绕着X轴顺时针每旋转一周360°发射一次参考时刻,也可以根据下式确定第一旋转角度:
当定位基站的旋转激光平面发射器A绕着X轴逆时针每旋转一周360°发射一次参考时刻,可以根据下式确定第一旋转角度:
其中,α为第一旋转角度,T1为待定位标记设备检测到第一激光平面信号的时刻,T0(N)为待定位标记设备最近一次从定位基站接收到的第一参考时刻(如第N个第一参考时刻),T0(N-1)为待定位标记设备前一次从定位基站接收到的第一参考时刻(如第N-1个第一参考时刻);w1为定位基站的旋转激光平面发射器A的转速。
例二:
当第一参考角度α'不为0时,以第一激光平面信号为例进行说明。
当定位基站的旋转激光平面发射器A绕着X轴顺时针旋转发送第一激光平面信号时,360-γ=(T1-T0)w1,α=α'-γ;
当定位基站的旋转激光平面发射器A绕着X轴逆时针旋转发送第一激光平面信号时,γ=(T1-T0)w1,α=α'+γ;
其中:α为第一旋转角度,γ为从第一参考时刻到收到第一激光平面信号的时刻,第一激光平面旋转的角度;α'为第一参考角度;T1为待定位标记设备检测到第一激光平面信号的时刻,T0为待定位标记设备最近一次从定位基站接收到的第一参考时刻;w1为定位基站的旋转激光平面发射器A的转速。
在一个具体实施例中,当定位基站的旋转激光平面发射器A绕着X轴顺时针每旋转一周360°发射一次参考时刻,也可以根据下式确定第一旋转角度:
当定位基站的旋转激光平面发射器A绕着X轴逆时针每旋转一周360°发射一次参考时刻,可以根据下式确定第一旋转角度:
其中,α为第一旋转角度,γ为从第一参考时刻到收到第一激光平面信号的时刻,第一激光平面旋转的角度;α'为第一参考角度;T1为待定位标记设备检测到第一激光平面信号的时刻,T0(N)为待定位标记设备最近一次从定位基站接收到的第一参考时刻(如第N个第一参考时刻),T0(N-1)为待定位标记设备前一次从定位基站接收到的第一参考时刻(如第N-1个第一参考时刻);w1为定位基站的旋转激光平面发射器A的转速。
同理,第二旋转角度β为旋转平面S2与XOY平面的夹角,其确定方式类似于第一旋转角度,故于此不再赘述。
需要说明的是:定位基站需要将第一参考时刻以及第二参考时刻分别发送给待定位标记设备。
另外,可以根据下式确定待定位标记设备与定位基站之间的距离:
L=(T3-T0')×v,
其中,L为待定位标记设备与定位基站之间的距离,T3为待定位标记设备检测到超声波信号的时刻(即前述的第三时刻),T0’为定位基站发送超声波信号的发送时刻(即前述的第三参考时刻),v为声音在空气中的传播速度。其中,v在1个标准大气压和15℃的条件下约为340米/秒。
需要说明的是,第一个第一参考时刻或者第一个第二参考时刻可以和超声波信号的发送时刻(即前述的第三参考时刻)相同(例如为基准时刻)或不同。本实施例对此并不限定。但是超声波信号的发送时刻和信号发送装置发送激光平面信号的时刻之间的时长(即第三参考时刻和第一参考时刻或第二参考时刻之间的时间间隔)应小于激光平面旋转一周的时长,例如,激光平面的旋转速度为90转/秒,则时间间隔应小于1/90秒。
在得到第一旋转角度、第二旋转角度以及待定位标记设备与定位基站之间的距离之后,可以根据下式求解得到待定位标记设备在三维测量坐标系中的三维坐标:
其中,(X0,Y0,Z0)表示待定位标记设备在三维测量坐标系中的三维坐标,L为所述待定位标记设备与定位基站之间的距离,α为第一旋转角度,β为第二旋转角度。
可见,本实施例基于测距信号(例如超声波信号)和两个旋转激光平面信号能够实现室内精确定位。本实施例通过同步装置(如无线电通信电路)进行定位基站与待定位标记设备的基准时刻同步以及时刻信息传输,能够支持定位基站与待定位标记设备的配对使用,进而可以支持多基站的扩展应用;而且,本实施例提供的待定位标记设备成本较低、易于实现小型化,扩大了应用场景。
实施例二
本实施例与实施例一的区别在于:在本实施例中,在信号接收装置检测到的第一激光平面信号、第二激光平面信号均为多路时,对检测到每路信号的时刻进行融合处理,得到第一时刻和第二时刻。
如图4所示,本实施例提供一种三维空间定位方法,包括以下步骤:
步骤401:当信号接收装置检测到的第一激光平面信号、第二激光平面信号均为多路时,确定信号接收装置检测到每路第一激光平面信号的第一激光时刻,采用第一预设融合方式处理多个第一激光时刻,得到第一时刻,确定信号接收装置检测到每路第二激光平面信号的第二激光时刻,采用第二预设融合方式处理多个第二激光时刻,得到第二时刻。
在一些实现方式中,本步骤可以包括:根据信号发送装置和信号接收装置同步基准时刻之后确定的第一激光时刻以及第二激光时刻,采用第一预设融合方式处理多个第一激光时刻,得到第一时刻,采用第二预设融合方式处理多个第二激光时刻,得到第二时刻。
其中,通过同步信号发送装置和信号接收装置的基准时刻,确保信号发送装置和信号接收装置的时钟同步,以确保后续进行的计算基于相同的基准。在一些实现方式中,信号发送装置可以向信号接收装置发送时间同步信号,信号接收装置可以将接收到时间同步信号的时刻作为基准时刻。
其中,信号发送装置绕着第一旋转轴旋转发送第一激光平面信号以及绕着第二旋转轴旋转发送第二激光平面信号。
其中,第一预设融合方式与第二预设融合方式可以相同或不同。第一预设融合方式以及第二预设融合方式可以分别包括但不限于以下之一:最近邻域法、广义相关法、高斯和法、最优贝叶斯法、概率数据互联法、对称测量方程滤波、加权平均、几何平均、算术平均、平方平均、调和平均。
步骤402:根据信号发送装置发送第一激光平面信号的第一参考信号、信号发送装置发送第二激光平面信号的第二参考时刻、第一时刻以及第二时刻,确定第一旋转角度以及第二旋转角度;
其中,第一旋转角度为所述第一时刻第一激光平面信号相对于第一旋转轴和第二旋转轴所确定平面的角度,第二旋转角度为所述第二时刻第二激光平面信号相对于第一旋转轴和第二旋转轴所确定平面的角度;
第一参考时刻为信号发送装置发送第一激光平面信号的时刻,在第一参考时刻,第一激光平面信号相对于第一旋转轴与第二旋转轴所确定平面的角度为第一参考角度;第二参考时刻为信号发送装置发送第二激光平面信号的时刻,在第二参考时刻,第二激光平面信号相对于第一旋转轴与第二旋转轴所确定平面的角度为第二参考角度。
需要说明的是,第一旋转轴与第二旋转轴所确定的平面包括以下情况:当第一旋转轴与第二旋转轴能够在一个平面内相交时,第一旋转轴与第二旋转轴所确定的平面即为第一旋转轴与第二旋转轴唯一确定的平面;当第一旋转轴与第二旋转轴不能在一个平面内相交时,第一旋转轴与第二旋转轴所确定的平面指第一旋转轴与第二旋转轴确定的一对平行平面。
其中,在第一旋转轴与第二旋转轴所确定的唯一平面或一对平行平面中,第一旋转轴与第二旋转轴之间的夹角为预设角度。预设角度可以由使用者预先设置。较佳地,第一旋转轴与第二旋转轴相互垂直。
在一些实现方式中,本步骤可以包括:
根据信号发送装置发送第一激光平面信号的第一参考时刻以及信号接收装置检测到第一激光平面信号的第一时刻,确定所述第一时刻与所述第一参考时刻之间的关系,根据所述第一时刻与第一参考时刻之间的关系以及所述第一参考时刻对应的第一参考角度,确定所述第一旋转角度;
根据信号发送装置发送第二激光平面信号的第二参考时刻以及信号接收装置检测到第二激光平面信号的第二时刻,确定所述第二时刻与所述第二参考时刻之间的关系,根据所述第二时刻与第二参考时刻之间的关系以及所述第二参考时刻对应的第二参考角度,确定所述第二旋转角度。
在一些实现方式中,第一参考角度可以等于第二参考角度。然而,本实施例对此并不限定。
其中,关于根据第一时刻以及第二时刻,确定第一旋转角度和第二旋转角度的原理以及具体处理过程可以参照实施例一所述,故于此不再赘述。
步骤403:根据信号发送装置发送测距信号的第三参考时刻以及信号接收装置检测到测距信号的第三时刻,确定信号接收装置与信号发送装置之间的距离。
在一些实现方式中,当信号接收装置检测到的测距信号为多路时,所述三维空间定位方法还包括:确定信号接收装置检测到每路测距信号的测距时刻,采用第三预设融合方式处理多个测距时刻,得到第三时刻。
其中,第三预设融合方式与第一预设融合方式或第二预设融合方式可以相同或不同。第三预设融合方式可以包括但不限于以下之一:最近邻域法、广义相关法、高斯和法、最优贝叶斯法、概率数据互联法、对称测量方程滤波、加权平均、几何平均、算术平均、平方平均、调和平均。
步骤404:根据第一旋转角度、第二旋转角度以及信号发送装置与信号接收装置之间的距离,确定信号接收装置在三维测量坐标系中的三维坐标。
关于步骤403和步骤404的说明可以参照实施例一的步骤102以及103,故于此不再赘述。
如图5所示,应用本实施例的三维空间定位方法的系统可以包括:信号接收装置以及信号发送装置。其中,信号发送装置作为三维空间定位的参考坐标基点,信号接收装置作为待定位点。
应用本实施例的三维空间定位方法的系统和应用实施例一的三维空间定位方法的系统的区别在于:在本实施例中,信号接收装置包括多路测距信号接收阵列,用于检测多路测距信号,以及多路激光平面信号接收阵列,用于检测多路第一激光平面信号以及多路第二激光平面信号。
本实施例的信号发送装置可以参照实施例一所述的信号发送装置,故于此不再赘述。
于本实施例中,信号接收装置包括第二同步装置、多路测距信号接收阵列以及多路激光平面信号接收阵列。其中,多路测距信号接收阵列例如为多路超声波接收阵列,多路超声波接收阵列可以包括多个超声换能器,多路激光平面信号接收阵列可以包括多个硅光电池。
可选地,第二同步装置例如为无线电通信电路,或者,也可以是一个IC芯片和天线组成的通信模块。然而,本实施例对此并不限定。于其他实施例中,第二同步装置还可以接收光信号进行时间同步。需要说明的是,第一同步装置与第二同步装置需要对应,例如,当第一同步装置为无线电通信电路时,第二同步装置亦为无线电通信电路。换言之,第一同步装置与第二同步装置采用对应的信号发射与信号检测技术,以实现信号发送装置与信号接收装置之间的时间同步。
可选地,信号接收装置还可以包括:处理器,用于根据本实施例的三维空间定位方法计算信号接收装置在三维测量坐标系内的三维坐标。然而,本申请对此并不限定。于其他实施例中,还可以由信号发送装置(例如,其中的控制器)根据本实施例的三维空间定位方法计算信号接收装置在三维测量坐标系内的三维坐标。此时,信号发送装置可以接收信号接收装置发送的第一时刻、第二时刻以及第三时刻,以便于进行三维坐标的计算。而且,信号发送装置可以将计算得到的三维坐标信息发送给信号接收装置。或者,于其他实施例中,还可以单独设置三维空间定位装置,三维空间定位装置可以与信号发送装置和信号接收装置实现通信,用于根据本实施例的三维空间定位方法计算信号接收装置在三维测量坐标系内的三维坐标。此时,三维空间定位装置可以接收信号发送装置发送的基准时刻、第一参考时刻、第二参考时刻以及第三参考时刻,还可以接收信号接收装置发送的第一时刻、第二时刻以及第三时刻,以便于三维空间定位装置进行三维坐标的计算。而且,三维空间定位装置还可以将计算得到的三维坐标信息发送给信号接收装置。
下面以信号接收装置执行图4所示的三维空间定位方法为例进行详细说明,其中,测距信号以超声波信号为例。
每当信号接收装置的第二同步装置接收到信号发送装置发来的时间同步信号时,就会给处理器(例如单片机控制器)一个外部中断触发信号,信号接收装置的单片机控制器以此为时间基准对其时间进行调节,确定基准时刻,从而保持与信号发送装置的时间同步。
在一些实现方式中,考虑到信号接收装置所在的待定位物体可能以任意姿态移动翻转,这些超声换能器和硅光电池需要按照一定的位置角度来摆放,以确保可以从不同的角度接收到超声波和激光平面信号。例如可采用球形结构来安装这些超声换能器和硅光电池。这种阵列排布方式便于超声换能器与硅光电池在待定位物体以任意姿态移动时都能够接收到超声波和激光平面信号。
超声换能器接收到超声波并将其转换为电压信号,硅光电池接收到激光并将其转换为电流信号。由于这些电信号都很微弱,每一个超声换能器的电压信号都经过一个放大器放大后经滤波电路滤波再经过电压比较器比较后,输出一个可触发单片机控制器产生外部中断的电平信号。每一个硅光电池的电流信号同超声换能器的电压信号一样经过放大滤波比较后,输出一个可触发单片机控制器产生外部中断的电平信号。当超声换能器接收到超声波或硅光电池接收到激光信号时,单片机控制器产生外部中断记录此刻定时器时间。每个定时周期,单片机控制器都会将记录下来的超声换能器触发中断的时间数据(即前述的测距时刻)和硅光电池触发中断的时间数据(即前述的第一激光时刻和第二激光时刻)进行融合和解算,从而得到信号接收装置所在的待定位物体的三维坐标。
其中,三维测量坐标系可以为笛卡尔坐标系。信号接收装置可以根据以下式子确定第一时刻、第二时刻以及第三时刻:
Tx=Φx(T0,[Tx0,Tx1,...,Txm-1]);
Ty=Φy(T0,[Ty0,Ty1,...,Tyk-1]);
T3=F(T0,[Tu0,Tu1,...,Tun-1])。
其中,T0为信号接收装置接收到时间同步信号的时刻(即前述的基准时刻);[Tx0,Tx1,...,Txm-1]为每个硅光电池接收到X轴上激光面信号(如前述的第一激光平面信号)的时刻(如前述的第一激光时刻),m为接收到X轴上的激光面信号的硅光电池的个数;[Ty0,Ty1,...,Tyk-1]为每个硅光电池接收到Y轴上的激光面信号(如前述的第二激光平面信号)的时刻(如前述的第二激光时刻),k为接收到Y轴上的激光面信号的硅光电池的个数;[Tu0,Tu1,...,Tun-1]为每个超声换能器接收到超声波信号的时刻(如前述的测距时刻),n为接收到超声波信号的超声换能器的个数。
其中,Φx()、Φy()和F()为数据融合函数,所述数据融合函数采用的融合方法可以包括但不限于:最近邻域法、广义相关法、高斯和法、最优贝叶斯法、概率数据互联法、对称测量方程滤波、加权平均、几何平均、算术平均、平方平均、调和平均等。
其中,Tx为融合后得到的接收到X轴上激光面信号(如前述的第一激光平面信号)的时刻(如前述的第一时刻),Ty为融合后得到的接收到Y轴上激光面信号(如前述的第二激光平面信号)的时刻(如前述的第二时刻),T3为融合后得到的对超声波信号的接收时刻(如前述的第三时刻)。
后续关于根据第一时刻、第二时刻以及第三时刻计算三维坐标的过程可以参照实施例一所述,故于此不再赘述。
此外,本发明实施例还提供一种计算机可读存储介质,存储有计算机可执行指令,所述计算机可执行指令被执行时实现上述的三维空间定位方法。
通过以上的实施方式的描述,本领域的技术人员可以清楚地了解到根据上述实施例的方法可借助软件加必需的通用硬件平台的方式来实现,当然也可以通过硬件,但很多情况下前者是更佳的实施方式。基于这样的理解,本申请的技术方案本质上或者说对相关技术做出贡献的部分可以以软件产品的形式体现出来,该计算机软件产品存储在一个存储介质(如ROM/RAM、磁碟、光盘)中,包括若干指令用以使得一台终端设备(可以是手机,计算机,服务器,或者网络设备等)执行本申请各个实施例所述的方法。
本领域的技术人员应该明白,上述的本申请的各模块或各步骤可以用通用的计算装置来实现,它们可以集中在单个的计算装置上,或者分布在多个计算装置所组成的网络上,可选地,它们可以用计算装置可执行的程序代码来实现,从而,可以将它们存储在存储装置中由计算装置来执行,并且在某些情况下,可以以不同于此处的顺序执行所示出或描述的步骤,或者将它们分别制作成各个集成电路模块,或者将它们中的多个模块或步骤制作成单个集成电路模块来实现。这样,本申请不限制于任何特定的硬件和软件结合。
虽然本申请所揭露的实施方式如上,但所述的内容仅为便于理解本申请而采用的实施方式,并非用以限定本申请。任何本申请所属领域内的技术人员,在不脱离本申请所揭露的精神和范围的前提下,可以在实施的形式及细节上进行任何的修改与变化,但本申请的专利保护范围,仍须以所附的权利要求书所界定的范围为准。
Claims (12)
1.一种三维空间定位方法,其特征在于,包括:
当信号接收装置检测到信号发送装置绕着第一旋转轴旋转发送的第一激光平面信号以及绕着第二旋转轴旋转发送的第二激光平面信号时,根据信号发送装置发送第一激光平面信号的第一参考时刻、发送第二激光平面信号的第二参考时刻、信号接收装置检测到第一激光平面信号的第一时刻、检测到第二激光平面信号的第二时刻,确定第一旋转角度以及第二旋转角度;
其中,所述第一旋转角度为所述第一时刻所述第一激光平面信号相对于第一旋转轴与第二旋转轴所确定平面的角度,所述第二旋转角度为所述第二时刻所述第二激光平面信号相对于第一旋转轴与第二旋转轴所确定平面的角度;
根据信号发送装置发送测距信号的第三参考时刻以及信号接收装置检测到测距信号的第三时刻,确定信号接收装置与信号发送装置之间的距离;
根据所述第一旋转角度、所述第二旋转角度以及所述距离,确定信号接收装置在三维测量坐标系中的三维坐标。
2.根据权利要求1所述的三维空间定位方法,其特征在于,在第一参考时刻,信号发送装置发送的第一激光平面信号相对于第一旋转轴与第二旋转轴所确定平面的角度为第一参考角度;在第二参考时刻,信号发送装置发送的第二激光平面信号相对于第一旋转轴与第二旋转轴所确定平面的角度为第二参考角度。
3.根据权利要求1所述的三维空间定位方法,其特征在于,所述根据信号发送装置发送第一激光平面信号的第一参考时刻、发送第二激光平面信号的第二参考时刻、信号接收装置检测到第一激光平面信号的第一时刻、检测到第二激光平面信号的第二时刻,确定第一旋转角度以及第二旋转角度,包括:
根据信号发送装置和信号接收装置同步基准时刻之后的第一参考时刻、第二参考时刻、第一时刻以及第二时刻,确定第一旋转角度以及第二旋转角度。
4.根据权利要求1所述的三维空间定位方法,其特征在于,所述根据所述第一旋转角度、所述第二旋转角度以及所述距离,确定信号接收装置在三维测量坐标系中的三维坐标,包括:
当所述三维测量坐标系为笛卡尔坐标系,以所述第一旋转轴为X轴,以所述第二旋转轴为Y轴时,根据下式求解得到信号接收装置在该三维测量坐标系中的三维坐标:
X0 2+Y0 2+Z0 2=L2
Y0×tanα=X0×tanβ=Z0;
其中,(X0,Y0,Z0)表示信号接收装置在三维测量坐标系中的三维坐标,L为信号接收装置与信号发送装置之间的距离,α为第一旋转角度,β为第二旋转角度。
5.根据权利要求2所述的三维空间定位方法,其特征在于,所述根据信号发送装置发送第一激光平面信号的第一参考时刻、发送第二激光平面信号的第二参考时刻、信号接收装置检测到第一激光平面信号的第一时刻、检测到第二激光平面信号的第二时刻,确定第一旋转角度以及第二旋转角度,包括:
根据信号发送装置发送第一激光平面信号的第一参考时刻以及信号接收装置检测到第一激光平面信号的第一时刻,确定所述第一时刻与所述第一参考时刻之间的关系,根据所述第一时刻与第一参考时刻之间的关系以及所述第一参考时刻对应的第一参考角度,确定所述第一旋转角度;
根据信号发送装置发送第二激光平面信号的第二参考时刻以及信号接收装置检测到第二激光平面信号的第二时刻,确定所述第二时刻与所述第二参考时刻之间的关系,根据所述第二时刻与第二参考时刻之间的关系以及所述第二参考时刻对应的第二参考角度,确定所述第二旋转角度。
6.根据权利要求1所述的三维空间定位方法,其特征在于,所述根据信号发送装置发送测距信号的第三参考时刻以及信号接收装置检测到测距信号的第三时刻,确定信号接收装置与信号发送装置之间的距离,包括:
根据信号发送装置发送测距信号的第三参考时刻以及信号接收装置检测到测距信号的第三时刻,确定所述测距信号从信号发送装置到信号接收装置的传输时长,根据所述传输时长以及测距信号在空气中的传输速度,确定信号接收装置与信号发送装置之间的距离。
7.根据权利要求1或6所述的三维空间定位方法,其特征在于,所述测距信号为超声波信号。
8.根据权利要求1所述的三维空间定位方法,其特征在于,当信号接收装置检测到的第一激光平面信号、第二激光平面信号均为多路时,所述三维空间定位方法还包括:
确定信号接收装置检测到每路第一激光平面信号的第一激光时刻,采用第一预设融合方式处理多个第一激光时刻,得到第一时刻;
确定信号接收装置检测到每路第二激光平面信号的第二激光时刻,采用第二预设融合方式处理多个第二激光时刻,得到第二时刻。
9.根据权利要求1或8所述的三维空间定位方法,其特征在于,当信号接收装置检测到的测距信号为多路时,所述三维空间定位方法还包括:确定信号接收装置检测到每路测距信号的测距时刻,采用第三预设融合方式处理多个测距时刻,得到第三时刻。
10.根据权利要求1所述的三维空间定位方法,其特征在于,所述第一旋转轴与所述第二旋转轴相互垂直。
11.一种三维空间定位系统,其特征在于,包括:信号发送装置以及信号接收装置;所述信号发送装置,用于向信号接收装置发送测距信号、绕着第一旋转轴旋转发送第一激光平面信号以及绕着第二旋转轴旋转发送第二激光平面信号;所述信号接收装置,用于检测所述测距信号、所述第一激光平面信号以及所述第二激光平面信号。
12.根据权利要求11所述的三维空间定位系统,其特征在于,所述测距信号为超声波信号。
Applications Claiming Priority (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN2015109779523 | 2015-12-23 | ||
CN201510977952.3A CN105607034A (zh) | 2015-12-23 | 2015-12-23 | 一种三维空间检测系统、定位方法及系统 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN106526537A true CN106526537A (zh) | 2017-03-22 |
CN106526537B CN106526537B (zh) | 2022-01-11 |
Family
ID=55987112
Family Applications (6)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201510977952.3A Pending CN105607034A (zh) | 2015-12-23 | 2015-12-23 | 一种三维空间检测系统、定位方法及系统 |
CN201610916371.3A Active CN106483497B (zh) | 2015-12-23 | 2016-10-20 | 一种信号接收装置及三维空间定位系统 |
CN201610917518.0A Active CN106526537B (zh) | 2015-12-23 | 2016-10-20 | 一种三维空间定位方法及系统 |
CN201610916353.5A Active CN106646355B (zh) | 2015-12-23 | 2016-10-20 | 一种信号发送装置以及三维空间定位系统 |
CN201610916373.2A Active CN106525045B (zh) | 2015-12-23 | 2016-10-20 | 一种三维空间定位装置及系统 |
CN201621144136.0U Active CN206400088U (zh) | 2015-12-23 | 2016-10-20 | 一种信号发送装置 |
Family Applications Before (2)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201510977952.3A Pending CN105607034A (zh) | 2015-12-23 | 2015-12-23 | 一种三维空间检测系统、定位方法及系统 |
CN201610916371.3A Active CN106483497B (zh) | 2015-12-23 | 2016-10-20 | 一种信号接收装置及三维空间定位系统 |
Family Applications After (3)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201610916353.5A Active CN106646355B (zh) | 2015-12-23 | 2016-10-20 | 一种信号发送装置以及三维空间定位系统 |
CN201610916373.2A Active CN106525045B (zh) | 2015-12-23 | 2016-10-20 | 一种三维空间定位装置及系统 |
CN201621144136.0U Active CN206400088U (zh) | 2015-12-23 | 2016-10-20 | 一种信号发送装置 |
Country Status (7)
Country | Link |
---|---|
US (1) | US10962633B2 (zh) |
EP (1) | EP3333586B1 (zh) |
JP (1) | JP6855473B2 (zh) |
KR (1) | KR102133105B1 (zh) |
CN (6) | CN105607034A (zh) |
HK (1) | HK1251787A1 (zh) |
WO (1) | WO2017107263A1 (zh) |
Cited By (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108037827A (zh) * | 2017-12-08 | 2018-05-15 | 北京凌宇智控科技有限公司 | 面向虚拟现实环境的虚拟物品抛掷仿真方法及其系统 |
CN108663680A (zh) * | 2018-04-10 | 2018-10-16 | 北京凌宇智控科技有限公司 | 一种用于减少时间同步的三维空间定位方法、装置及系统 |
CN108828520A (zh) * | 2018-06-15 | 2018-11-16 | 深圳草莓创新技术有限公司 | 无人机的室内飞行方法及相关产品 |
CN110573917A (zh) * | 2017-04-24 | 2019-12-13 | 奇跃公司 | 跟踪反向散射的激光斑点图案的光流 |
CN111409108A (zh) * | 2020-04-01 | 2020-07-14 | 伯朗特机器人股份有限公司 | 工业机器人测量坐标系与机器人的指令坐标系转换方法 |
Families Citing this family (56)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105607034A (zh) | 2015-12-23 | 2016-05-25 | 北京凌宇智控科技有限公司 | 一种三维空间检测系统、定位方法及系统 |
CN105898864A (zh) * | 2016-05-30 | 2016-08-24 | 成都理想境界科技有限公司 | 一种定位基站、定位终端及空间定位系统 |
CN106093863B (zh) * | 2016-05-31 | 2018-08-14 | 上海乐相科技有限公司 | 一种采用激光扫描的目标定位方法及激光接收装置 |
CN106980108A (zh) * | 2016-06-02 | 2017-07-25 | 上海拆名晃信息科技有限公司 | 基于光场扫描的虚拟现实设备空间定位方法 |
CN106199517A (zh) * | 2016-06-30 | 2016-12-07 | 成都理想境界科技有限公司 | 一种定位设备、定位基站、空间定位系统和方法 |
CN106546950A (zh) * | 2016-06-30 | 2017-03-29 | 成都理想境界科技有限公司 | 一种定位基站 |
US11134864B2 (en) * | 2016-07-13 | 2021-10-05 | Alexei L. Vyssotski | Tracking method and system for small animal research |
CN106383336B (zh) * | 2016-08-10 | 2019-08-20 | 成都理想境界科技有限公司 | 一种定位基站和空间定位系统 |
CN106443584A (zh) * | 2016-08-31 | 2017-02-22 | 青岛海信宽带多媒体技术有限公司 | 一种位置确定的方法及装置 |
US10593116B2 (en) | 2016-10-24 | 2020-03-17 | Snap Inc. | Augmented reality object manipulation |
CN106383337A (zh) * | 2016-10-28 | 2017-02-08 | 成都理想境界科技有限公司 | 一种定位基站、定位系统和定位方法 |
CN106526538B (zh) * | 2016-11-25 | 2024-02-20 | 北京凌宇智控科技有限公司 | 一种定位基站、定位系统及定位方法 |
CN106526539B (zh) * | 2016-11-25 | 2023-12-08 | 北京凌宇智控科技有限公司 | 一种定位基站、定位系统及定位方法 |
CN106714297B (zh) * | 2016-11-30 | 2020-03-24 | 成都理想境界科技有限公司 | 一种基站网络定位装置和定位系统 |
CN106680772B (zh) * | 2016-12-08 | 2019-06-25 | 成都理想境界科技有限公司 | 一种信号识别系统、定位系统、定位基站及信号识别方法 |
CN106646380B (zh) * | 2016-12-28 | 2020-04-21 | 北京凌宇智控科技有限公司 | 一种多基站空间定位方法和系统 |
CN106646342A (zh) * | 2016-12-29 | 2017-05-10 | 成都理想境界科技有限公司 | 一种定位基站和定位系统 |
US10242503B2 (en) | 2017-01-09 | 2019-03-26 | Snap Inc. | Surface aware lens |
CN106802412B (zh) * | 2017-01-23 | 2020-08-04 | 南京大学 | 一种基于激光及无线技术的近距离移动定位系统及其方法 |
CN106950541A (zh) * | 2017-02-23 | 2017-07-14 | 成都理想境界科技有限公司 | 一种定位系统、定位基站、定位基站网络和定位终端 |
CN106772402B (zh) * | 2017-03-16 | 2019-06-04 | 小派科技(上海)有限责任公司 | 一种空间定位系统以及区域级联空间定位方法 |
CN107181500B (zh) * | 2017-04-27 | 2019-05-28 | 北京凌宇智控科技有限公司 | 一种信号接收装置 |
CN107390878B (zh) * | 2017-08-07 | 2021-02-19 | 北京凌宇智控科技有限公司 | 一种空间定位方法、装置、定位器 |
CN109751992B (zh) * | 2017-11-03 | 2021-07-20 | 北京凌宇智控科技有限公司 | 面向室内三维空间的定位校正方法、定位方法及其设备 |
WO2019085526A1 (zh) * | 2017-11-03 | 2019-05-09 | 北京凌宇智控科技有限公司 | 面向三维空间的定位校正方法、组合定位方法及其设备 |
CN108226867B (zh) * | 2017-12-25 | 2020-11-20 | 上海昂丰装备科技有限公司 | 一种抓斗超声波定位方法 |
CN108398083B (zh) * | 2018-01-29 | 2021-03-16 | 湖南三德科技股份有限公司 | 一种车厢定位方法及定位装置 |
CN108333579A (zh) * | 2018-02-08 | 2018-07-27 | 高强 | 一种基于Vive Lighthouse的光感设备密集部署的系统及方法 |
CN108446023B (zh) * | 2018-03-20 | 2021-02-02 | 京东方科技集团股份有限公司 | 虚拟现实反馈装置及其定位方法、反馈方法和定位系统 |
CN108196225B (zh) * | 2018-03-27 | 2021-07-20 | 北京凌宇智控科技有限公司 | 一种融合编码信息的三维空间定位方法及系统 |
CN110376549A (zh) * | 2018-04-12 | 2019-10-25 | 北京凌宇智控科技有限公司 | 一种三维空间定位方法及系统 |
CN110376550B (zh) * | 2018-04-12 | 2024-04-12 | 北京凌宇智控科技有限公司 | 一种基于位置补偿的三维空间定位方法及系统 |
CN110376543A (zh) * | 2018-04-12 | 2019-10-25 | 北京凌宇智控科技有限公司 | 一种三维空间定位方法和系统 |
CN109031189B (zh) * | 2018-06-22 | 2024-05-28 | 凌宇科技(北京)有限公司 | 一种定位基站、定位系统、游戏系统及其方法、存储介质 |
CN109031199B (zh) * | 2018-06-22 | 2021-04-16 | 凌宇科技(北京)有限公司 | 一种三维定位方法、系统及其装置 |
CN109189226B (zh) * | 2018-08-23 | 2022-03-04 | 凌宇科技(北京)有限公司 | 一种标定高度的方法及系统 |
US11030813B2 (en) | 2018-08-30 | 2021-06-08 | Snap Inc. | Video clip object tracking |
CN109269483B (zh) * | 2018-09-20 | 2020-12-15 | 国家体育总局体育科学研究所 | 一种动作捕捉节点的标定方法、标定系统及标定基站 |
CN109298393A (zh) * | 2018-10-26 | 2019-02-01 | 中交第航务工程局有限公司 | 一种基于bim模型的建筑物内定位系统及其定位方法 |
CN109471070B (zh) * | 2018-10-30 | 2022-04-08 | 合肥京东方视讯科技有限公司 | 一种麦克风定位方法及装置 |
US11176737B2 (en) | 2018-11-27 | 2021-11-16 | Snap Inc. | Textured mesh building |
US11501499B2 (en) | 2018-12-20 | 2022-11-15 | Snap Inc. | Virtual surface modification |
CN110007275B (zh) * | 2019-01-25 | 2024-08-23 | 广州市慧建科技有限公司 | 一种多目标平面位置坐标定位方法及系统 |
CN110109057B (zh) * | 2019-04-24 | 2021-04-20 | 广州市慧建科技有限公司 | 一种激光定位系统 |
CN110095756B (zh) * | 2019-05-21 | 2023-01-03 | 中国科学院深海科学与工程研究所 | 一种基于水声定位系统的水下目标速度计算方法 |
US11189098B2 (en) | 2019-06-28 | 2021-11-30 | Snap Inc. | 3D object camera customization system |
US11592293B2 (en) * | 2019-12-11 | 2023-02-28 | Topcon Positioning Systems, Inc. | Laser measuring system with multiple synchronous bases |
US11263817B1 (en) | 2019-12-19 | 2022-03-01 | Snap Inc. | 3D captions with face tracking |
US11227442B1 (en) | 2019-12-19 | 2022-01-18 | Snap Inc. | 3D captions with semantic graphical elements |
KR102293561B1 (ko) * | 2019-12-31 | 2021-08-24 | 재단법인대구경북과학기술원 | 이동형 측위 장치 및 위치 측정 방법 |
CN113514794B (zh) * | 2021-04-21 | 2023-11-14 | 北京交通大学 | 基于aoa和tdoa的室内三维定位方法 |
CN113944494B (zh) * | 2021-10-15 | 2024-01-12 | 太原理工大学 | 一种基于超声无线测距的液压支架自动调直方法及系统 |
CN114236585B (zh) * | 2021-12-09 | 2023-04-14 | 国网思极位置服务有限公司 | 基于北斗导航卫星系统的目标运动监测方法及存储介质 |
CN114279450B (zh) * | 2022-01-05 | 2023-09-15 | 山东科技大学 | 一种激光定位导航系统及其定位方法 |
CN114518114A (zh) * | 2022-02-14 | 2022-05-20 | 上海埃威航空电子有限公司 | 一种室内空间协同作业安全保障方法及系统 |
CN115314997A (zh) * | 2022-08-10 | 2022-11-08 | 航天新通科技有限公司 | 一种基于TwIST算法的室内三维定位方法 |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN1082741A (zh) * | 1992-08-12 | 1994-02-23 | 菲利浦电子有限公司 | 对于表面进行光学扫描用的装置 |
US6381006B1 (en) * | 2000-07-12 | 2002-04-30 | Spectra Precision Ab | Spatial positioning |
CN102384717A (zh) * | 2011-08-17 | 2012-03-21 | 天津大学 | 采用标准杆的工作空间测量定位系统快速定向方法 |
CN102425990A (zh) * | 2011-09-14 | 2012-04-25 | 天津大学 | 工作空间测量定位系统网络状态监测方法 |
CN102636774A (zh) * | 2012-04-26 | 2012-08-15 | 天津大学 | 一种基于光电扫描与超声测距的全站式空间测量定位方法 |
CN103760517A (zh) * | 2014-01-14 | 2014-04-30 | 中国矿业大学 | 地下扫描卫星高精度跟踪定位方法及装置 |
Family Cites Families (39)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US2548590A (en) * | 1950-04-01 | 1951-04-10 | Gen Electric | Noncontacting width gauge |
FR1570931A (zh) * | 1967-06-20 | 1969-06-13 | ||
US3897637A (en) * | 1974-03-18 | 1975-08-05 | Robert Genho | Laser level and square |
US5182863A (en) * | 1990-10-22 | 1993-02-02 | Spectra-Physics Laserplane, Inc. | Automatic plumb and level tool with acoustic measuring capability |
US5113377A (en) * | 1991-05-08 | 1992-05-12 | Atlantic Richfield Company | Receiver array system for marine seismic surveying |
US5493786A (en) * | 1995-01-09 | 1996-02-27 | Thomson; Christopher S. | Real estate electro tape |
US6199292B1 (en) * | 1998-11-04 | 2001-03-13 | Agilent Technologies | Electromechanical dimensioning device |
US6545751B2 (en) | 2000-02-28 | 2003-04-08 | Arc Second, Inc. | Low cost 2D position measurement system and method |
US6560560B1 (en) * | 2000-04-24 | 2003-05-06 | Eric Joshua Tachner | Apparatus and method for determining the distance between two points |
US7073268B1 (en) * | 2002-04-18 | 2006-07-11 | Black & Decker Inc. | Level apparatus |
EP1467225A1 (de) * | 2003-04-10 | 2004-10-13 | IEE International Electronics & Engineering S.A.R.L. | Einparkhilfe für ein Fahrzeug |
US7294822B2 (en) * | 2004-03-19 | 2007-11-13 | Mitch Randall | Method and apparatus to communicate with and individually locate multiple remote devices on a two-dimensional surface |
KR100697986B1 (ko) * | 2004-06-15 | 2007-03-23 | 박인규 | 레이저와 초음파를 이용한 전자 거리 측정장치 |
EP1632785A1 (de) * | 2004-08-25 | 2006-03-08 | Prüftechnik Dieter Busch Ag | Positionsmessgerät auf Laserbasis |
US7086162B2 (en) * | 2004-12-23 | 2006-08-08 | Dan Tyroler | Method and apparatus for distance measurement |
US7127821B1 (en) * | 2005-05-20 | 2006-10-31 | Dan Tyroler | Automated method and apparatus for distance measurement |
CN100437028C (zh) * | 2005-08-17 | 2008-11-26 | 曲兆松 | 测量三维空间的超声波和激光系统 |
FR2899692B1 (fr) * | 2006-04-06 | 2008-10-17 | Hitpool Systems Entpr Uniperso | Systeme de localisation et positionnement pour le guidage d'une entite mobile par rapport a un ou plusieurs autres objets |
US7325328B1 (en) * | 2006-09-28 | 2008-02-05 | Morton Paul E | Methods and apparatus to determine vessel draft and amount of cargo loaded in a vessel |
KR101118673B1 (ko) * | 2009-01-14 | 2012-03-06 | 주식회사 아이디폰 | 실내 항법시스템 |
US8422034B2 (en) * | 2010-04-21 | 2013-04-16 | Faro Technologies, Inc. | Method and apparatus for using gestures to control a laser tracker |
US8199977B2 (en) * | 2010-05-07 | 2012-06-12 | Honeywell International Inc. | System and method for extraction of features from a 3-D point cloud |
CN102121827B (zh) * | 2010-11-29 | 2013-12-18 | 浙江亚特电器有限公司 | 一种移动机器人定位系统及其定位方法 |
US20130080111A1 (en) * | 2011-09-23 | 2013-03-28 | Honeywell International Inc. | Systems and methods for evaluating plane similarity |
CN102589476B (zh) * | 2012-02-13 | 2014-04-02 | 天津大学 | 高速扫描整体成像三维测量方法 |
CN103542847A (zh) * | 2012-07-16 | 2014-01-29 | 苏州科瓴精密机械科技有限公司 | 一种移动机器人的定位系统及其定位方法 |
CN103033183B (zh) * | 2012-12-14 | 2015-07-01 | 中国航空工业集团公司北京长城航空测控技术研究所 | 工业机器人室内精确定位系统及方法 |
CN103278132B (zh) * | 2013-04-20 | 2015-04-08 | 北京工业大学 | 自行走式地下掘进机器人姿态测量装置及其测量方法 |
US9113154B2 (en) * | 2013-07-10 | 2015-08-18 | Faro Technologies, Inc. | Three-dimensional measurement device having three-dimensional overview camera |
EP3060938A2 (en) * | 2013-10-22 | 2016-08-31 | Flir Systems, Inc. | System and method for detecting an object or recess on a surface |
CN104689674B (zh) * | 2013-12-05 | 2017-09-05 | 浙江大学 | 基于广义量子超声陷阱的颗粒物聚集方法、聚集处理方法和聚集处理系统 |
CN103728589B (zh) * | 2014-01-09 | 2016-05-11 | 上海京颐科技股份有限公司 | 一种室内定位方法 |
CN104079916A (zh) * | 2014-06-16 | 2014-10-01 | 深圳市德赛微电子技术有限公司 | 一种全景三维视觉传感器及使用方法 |
CN104181544A (zh) * | 2014-08-20 | 2014-12-03 | 国家电网公司 | 基于脉冲计数和时间拓展的激光测距方法及系统 |
CN105157697B (zh) * | 2015-07-31 | 2017-05-17 | 天津大学 | 基于光电扫描的室内移动机器人位姿测量系统及测量方法 |
CN105607034A (zh) | 2015-12-23 | 2016-05-25 | 北京凌宇智控科技有限公司 | 一种三维空间检测系统、定位方法及系统 |
CN106546950A (zh) * | 2016-06-30 | 2017-03-29 | 成都理想境界科技有限公司 | 一种定位基站 |
CN206258572U (zh) * | 2016-10-20 | 2017-06-16 | 北京凌宇智控科技有限公司 | 一种信号接收装置 |
CN106802412B (zh) * | 2017-01-23 | 2020-08-04 | 南京大学 | 一种基于激光及无线技术的近距离移动定位系统及其方法 |
-
2015
- 2015-12-23 CN CN201510977952.3A patent/CN105607034A/zh active Pending
-
2016
- 2016-01-14 JP JP2018521120A patent/JP6855473B2/ja active Active
- 2016-01-14 WO PCT/CN2016/070885 patent/WO2017107263A1/zh active Application Filing
- 2016-01-14 KR KR1020187012731A patent/KR102133105B1/ko active Active
- 2016-01-14 EP EP16877077.4A patent/EP3333586B1/en active Active
- 2016-10-20 CN CN201610916371.3A patent/CN106483497B/zh active Active
- 2016-10-20 CN CN201610917518.0A patent/CN106526537B/zh active Active
- 2016-10-20 CN CN201610916353.5A patent/CN106646355B/zh active Active
- 2016-10-20 CN CN201610916373.2A patent/CN106525045B/zh active Active
- 2016-10-20 CN CN201621144136.0U patent/CN206400088U/zh active Active
-
2018
- 2018-03-14 US US15/921,331 patent/US10962633B2/en active Active
- 2018-09-26 HK HK18112336.8A patent/HK1251787A1/zh unknown
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN1082741A (zh) * | 1992-08-12 | 1994-02-23 | 菲利浦电子有限公司 | 对于表面进行光学扫描用的装置 |
US6381006B1 (en) * | 2000-07-12 | 2002-04-30 | Spectra Precision Ab | Spatial positioning |
CN102384717A (zh) * | 2011-08-17 | 2012-03-21 | 天津大学 | 采用标准杆的工作空间测量定位系统快速定向方法 |
CN102425990A (zh) * | 2011-09-14 | 2012-04-25 | 天津大学 | 工作空间测量定位系统网络状态监测方法 |
CN102636774A (zh) * | 2012-04-26 | 2012-08-15 | 天津大学 | 一种基于光电扫描与超声测距的全站式空间测量定位方法 |
CN103760517A (zh) * | 2014-01-14 | 2014-04-30 | 中国矿业大学 | 地下扫描卫星高精度跟踪定位方法及装置 |
Non-Patent Citations (1)
Title |
---|
杨凌辉: "基于光电扫描的大尺度空间坐标测量定位技术研究", 《中国博士学位论文全文库 工程科技Ⅰ辑》 * |
Cited By (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110573917A (zh) * | 2017-04-24 | 2019-12-13 | 奇跃公司 | 跟踪反向散射的激光斑点图案的光流 |
US11150725B2 (en) | 2017-04-24 | 2021-10-19 | Magic Leap, Inc. | System for detecting six degrees of freedom of movement by tracking optical flow of backscattered laser speckle patterns |
CN110573917B (zh) * | 2017-04-24 | 2022-08-23 | 奇跃公司 | 跟踪反向散射的激光斑点图案的光流 |
US11762455B2 (en) | 2017-04-24 | 2023-09-19 | Magic Leap, Inc. | System for detecting six degrees of freedom of movement by tracking optical flow of backscattered laser speckle patterns |
CN108037827A (zh) * | 2017-12-08 | 2018-05-15 | 北京凌宇智控科技有限公司 | 面向虚拟现实环境的虚拟物品抛掷仿真方法及其系统 |
CN108663680A (zh) * | 2018-04-10 | 2018-10-16 | 北京凌宇智控科技有限公司 | 一种用于减少时间同步的三维空间定位方法、装置及系统 |
CN108663680B (zh) * | 2018-04-10 | 2021-02-09 | 北京凌宇智控科技有限公司 | 一种用于减少时间同步的三维空间定位方法、装置及系统 |
CN108828520A (zh) * | 2018-06-15 | 2018-11-16 | 深圳草莓创新技术有限公司 | 无人机的室内飞行方法及相关产品 |
CN111409108A (zh) * | 2020-04-01 | 2020-07-14 | 伯朗特机器人股份有限公司 | 工业机器人测量坐标系与机器人的指令坐标系转换方法 |
CN111409108B (zh) * | 2020-04-01 | 2022-11-04 | 伯朗特机器人股份有限公司 | 工业机器人测量坐标系与机器人的指令坐标系转换方法 |
Also Published As
Publication number | Publication date |
---|---|
CN206400088U (zh) | 2017-08-11 |
CN106525045B (zh) | 2020-07-24 |
WO2017107263A1 (zh) | 2017-06-29 |
CN106525045A (zh) | 2017-03-22 |
EP3333586A1 (en) | 2018-06-13 |
US20180217246A1 (en) | 2018-08-02 |
US10962633B2 (en) | 2021-03-30 |
CN106646355B (zh) | 2020-04-21 |
CN106483497A (zh) | 2017-03-08 |
CN106526537B (zh) | 2022-01-11 |
CN106646355A (zh) | 2017-05-10 |
KR20180063263A (ko) | 2018-06-11 |
CN105607034A (zh) | 2016-05-25 |
EP3333586B1 (en) | 2021-12-08 |
KR102133105B1 (ko) | 2020-07-21 |
JP2018535410A (ja) | 2018-11-29 |
EP3333586A4 (en) | 2018-11-07 |
CN106483497B (zh) | 2020-02-07 |
JP6855473B2 (ja) | 2021-04-07 |
HK1251787A1 (zh) | 2019-03-15 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN106526537A (zh) | 一种三维空间定位方法及系统 | |
CN105974359B (zh) | 一种定位设备、定位基站、空间定位系统及方法 | |
US11507714B2 (en) | Methods and apparatus for secure persistent location based digital content | |
CN106646380B (zh) | 一种多基站空间定位方法和系统 | |
JP2017537309A (ja) | 向き付けおよび位置付けのための装置および方法 | |
CN204989490U (zh) | 一种基于gps与超声波的小型无人机室内外无缝集成定位系统 | |
CN106199517A (zh) | 一种定位设备、定位基站、空间定位系统和方法 | |
CN103543434A (zh) | 室内定位系统、手机及定位方法 | |
AU2018204522B2 (en) | Three-dimensional space detection system, positioning method and system | |
CN106792537A (zh) | 一种定位系统 | |
Petrellis et al. | Target localization utilizing the success rate in infrared pattern recognition | |
CN110376550B (zh) | 一种基于位置补偿的三维空间定位方法及系统 | |
CN106878944A (zh) | 一种校准定位基站坐标系的方法和定位校准装置 | |
CN206258572U (zh) | 一种信号接收装置 | |
CN107229055B (zh) | 移动设备定位方法和移动设备定位装置 | |
CN106383336B (zh) | 一种定位基站和空间定位系统 | |
CN205826857U (zh) | 一种定位设备、定位基站、空间定位系统 | |
CN110376543A (zh) | 一种三维空间定位方法和系统 | |
CN206223965U (zh) | 一种定位设备、定位基站和空间定位系统 | |
US20240370596A1 (en) | Methods and apparatus for secure persistent location based digital content associated with a three-dimensional reference | |
CN110376549A (zh) | 一种三维空间定位方法及系统 | |
TW201805589A (zh) | 座標感測裝置 | |
WO2018157103A1 (en) | Sensing and communication system for rotorcraft | |
CN106441364A (zh) | 姿态测量装置自动校正的方法及系统 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | 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 | ||
PE01 | Entry into force of the registration of the contract for pledge of patent right | ||
PE01 | Entry into force of the registration of the contract for pledge of patent right |
Denomination of invention: A three-dimensional spatial positioning method and system Effective date of registration: 20230914 Granted publication date: 20220111 Pledgee: Beijing first financing Company limited by guarantee Pledgor: NOLO Co.,Ltd. Registration number: Y2023110000393 |