AU2018204522A1 - Three-dimensional space detection system, positioning method and system - Google Patents

Three-dimensional space detection system, positioning method and system Download PDF

Info

Publication number
AU2018204522A1
AU2018204522A1 AU2018204522A AU2018204522A AU2018204522A1 AU 2018204522 A1 AU2018204522 A1 AU 2018204522A1 AU 2018204522 A AU2018204522 A AU 2018204522A AU 2018204522 A AU2018204522 A AU 2018204522A AU 2018204522 A1 AU2018204522 A1 AU 2018204522A1
Authority
AU
Australia
Prior art keywords
time point
label device
base station
laser plane
locating base
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
Application number
AU2018204522A
Other versions
AU2018204522B2 (en
Inventor
Daoning ZHANG
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Nolo Co Ltd
Original Assignee
Nolo Co Ltd
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Priority claimed from PCT/CN2016/070885 external-priority patent/WO2017107263A1/en
Application filed by Nolo Co Ltd filed Critical Nolo Co Ltd
Priority to AU2018204522A priority Critical patent/AU2018204522B2/en
Publication of AU2018204522A1 publication Critical patent/AU2018204522A1/en
Application granted granted Critical
Publication of AU2018204522B2 publication Critical patent/AU2018204522B2/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Abstract

THREE-DIMENSIONAL SPACE DETECTION SYSTEM, POSITIONING METHOD AND SYSTEM This disclosure provides a three-dimensional space detection system, including: a locating base station, a label device to be located, and a computing device. The locating base station synchronizes a base time point to the label device to be located, sends an ultrasonic signal to the label device to be located, rotationally sends a first laser plane signal about a first rotation axis, and rotationally sends a second laser plane signal about a second rotation axis perpendicular to the first rotation axis. The label device to be located synchronizes a base time point from the locating base station, detects the ultrasonic signal, the first laser plane signal and the second laser plane signal. The computing device determines the three-dimensional space coordinates of the label device to be located according to the time point at which the label device to be located detects the ultrasonic signal, the time point at which the label device to be located detects the first laser plane signal and the time point at which the label device to be located detects the second laser plane signal. The locating system enables precise indoor locating based on ultrasound and laser signals. (Fig. 1) -1 /4 label device to Locating base station be located 111 ,,cnd12 fvitchronization synchronization api S apparatus rotation laser pbotoelectic plan transmitter A sensing circuit rotation aser plan ' iwsoni tramsnitter 13 receiver ultrasonic transmiter Fig.1 after the locating bas station and the label device to be located synchmnize the reference time paint, and the label device to be located detec the first laser plane signaI, The second laser plane signal and the ultrasonic signl,. determining a first rotation angle and a second rotation angle according to a first referece time point at which the loaring base station sends the first laser plane sigral, a second reference time point at which the locating base \y 201 station sends ihe second laser plane signal, a first time point at which the label device to be located deteos the first laser plane signal and a second time point at which the label device to be located detects the second laser pf ae signal determining a distance between the label device to be located and the locating base station according to a sending time poiI at which the locating base station scuds hV ultnsonic signl <\ 202 and a tire point at which the label device to be loaded detects the ultrasoriic signal deiennining ikreedimenional coordinates of the label device to] be located in a thre-dimensionl measuremeni cordinate system accord int inhe first rotation angle, the second rotation rv 203 angle, and the distance between the label device to be located and the locating base nation Fig.2

Description

THREE-DIMENSIONAL SPACE DETECTION SYSTEM,
POSITIONING METHOD AND SYSTEM
RELATED APPLICATIONS
This application is related to Chinese Patent Application No. 201510977952.3 filed 23 December 2015 and International Patent Application No. PCT/CN2016/070885, filed 14 January 2016 and titled “Three-dimensional space detection system, positioning method and system”, the entire content of each of which is incorporated by reference as if fully set forth herein.
TECHNICAL FIELD
This disclosure relates to, but is not limited to, locating technology, and more particularly to a three-dimensional space detection system, locating method and system.
BACKGROUND
With the development of mobile devices and network technologies, location services are becoming more and more important in people's lives. Current locating technology can be divided into outdoor locating and indoor locating according to different locating areas. Among them, outdoor locating is mainly achieved through the satellite locating system, and the related outdoor locating technology can well meet the needs of outdoor locating.
However, outdoor locating technology when used in indoor locating, due to locating time, locating accuracy and indoor complex environment and other conditions, cannot meet the needs of users. In order to improve accuracy of indoor locating, indoor locating systems such as the Vicon/Optitrack optical motion capture system and the 3D laser radar SLAM are brought about in the related art. The Vicon / Optitrack optical motion capture system needs to be applied to a field of view overlap of four or more than four infrared cameras. The required equipment configuration is complicated and the cost is very high, about RMB several hundred thousand yuan. And, the optical motion capture system can not locate the indoor geographical coordinates of the terminal. The 3D laser radar SLAM needs the map of the surrounding environment to be built up and the cost is also very high, about RMB tens of thousands yuan.
Thus, the existing indoor locating technology does not apply to locating of consumer electronics.
This section provides background information related to the present invention which is not necessarily prior art.
SUMMARY
The following is an overview of the subject matter described in detail in this disclosure. This summary is not intended to limit the scope of the claims.
The embodiments of the present disclosure provide a three-dimensional space detection system, locating method and system, which can provide higher indoor locating accuracy and achieve simple implementation.
An embodiment of the present disclosure provides a three-dimensional space detection system comprising: a locating base station and a label device to be located, wherein the locating base station is configured to synchronize a base time point to the label device to be located, send an ultrasonic signal to the label device to be located, rotationally send a first laser plane signal about a first rotation axis, and rotationally send a second laser plane signal about a second rotation axis to the label device to be located, wherein the first rotation axis and the second rotation axis are perpendicular to each other; the label device to be located is configured to synchronize a base time point from the locating base station, detect the ultrasonic signal, the first laser plane signal and the second laser plane signal.
In an embodiment, the locating base station comprises: a first synchronization apparatus, configured to synchronize the base time point to the label device to be located; a first rotating laser plane transmitter configured to rotationally sending the first laser plane signal about the first rotation axis; a second rotating laser plane transmitter configured to rotationally send the second laser plane signal about the second rotation axis; an ultrasound transmitter, configured to send the ultrasonic signal.
Optionally, the ultrasonic transmitter is located at the intersection of the first rotation axis and the second rotation axis.
In an embodiment, the label device to be located comprises: a second synchronization apparatus configured to synchronize the base time point from the locating base station; a photoelectric sensing circuit configured to detect the first laser plane signal and the second laser plane signal sent by the locating base station; an ultrasonic receiver configured to detect the ultrasonic signal sent by the locating base station.
An embodiment of this disclosure further provides a three-dimensional space locating method based on the above three-dimensional space detection system, comprising: after the locating base station and the label device to be located synchronize the base time point, and the label device to be located detects the first laser plane signal, the second laser plane signal and the ultrasonic signal, determining a first rotation angle and a second rotation angle according to a first reference time point at which the locating base station sends the first laser plane signal, a second reference time point at which the locating base station sends the second laser plane signal, a first time point at which the label device to be located detects the first laser plane signal, and a second time point at which the label device to be located detects the second laser plane signal, wherein the first rotation angle is an angle of the first laser plane signal with respect to a plane defined by the first rotation axis and the second rotation axis at the first time point, the second rotation angle is an angle of the second laser plane signal with respect to the plane defined by the first rotation axis and the second rotation axis at the second time point, the first reference time point is a time point when an angel of the first laser plane signal sent by the locating base station with respect to the plane defined by the first rotation axis and the second rotation axis is a first reference angle, and the second reference time point is a time point when an angle of the second laser plane signal sent by the locating base station with respect to the plane defined by the first rotation axis and the second rotation axis is a second reference angle; determining a distance between the label device to be located and the locating base station according to a sending time point at which the locating base station sends the ultrasonic signal and a time point at which the label device to be located detects the ultrasonic signal; and determining three-dimensional coordinates of the label device to be located in a three-dimensional measurement coordinate system according to the first rotation angle, the second rotation angle, and the distance.
Optionally, the determining the three-dimensional coordinates of the label device to be located in a three-dimensional measurement coordinate system according to the first rotation angle, the second rotation angle, and the distance includes: when the three-dimensional measurement coordinate system is a Cartesian coordinate system, the first rotation axis is the X-axis, and the second rotation axis is the Y-axis, determining three-dimensional coordinates of the label device to be located in a three-dimensional measurement coordinate system according to the following formula: x« +Yo2 +Z02 =L2 Y0 x tan a — X0 x tan β ~ Z0 wherein (Xo, Yo, Zo) represents the three-dimensional coordinates of the label device to be located in the three-dimensional measurement coordinate system, L is the distance between the label device to be located and the locating base station, a is the first rotation angle, and β is the second rotation angle.
Optionally, the determining the first rotation angle and the second rotation angle according to the first reference time point at which the locating base station sends the first laser plane signal, the second reference time point at which the locating base station sends the second laser plane signal, the first time point at which the label device to be located detects the first laser plane signal, and the second time point at which the label device to be located detects the second laser plane signal comprises: determining a relationship between the first time point and the first reference time point according to the first reference time point at which the locating base station sends the first laser plane signal and the first time point at which the label device to be located detects the first laser plane signal, and determining the first rotation angle according to the relationship between the first time point and the first reference time point and the first reference angle corresponding to the first reference time point; determining a relationship between the second time point and the second reference time point according to the second reference time point at which the locating base station sends the second laser plane signal and the second time point at which the label device to be located detects the second laser plane signal, and determining the second rotation angle according to the relationship between the second time point and the second reference time point and the second reference angle corresponding to the second reference time point.
Optionally, the determining the distance between the label device to be located and the locating base station according to the sending time point at which the locating base station sends the ultrasonic signal and the time point at which the label device to be located detects the ultrasonic signal comprises: determining transmission time length of the ultrasonic signal from the locating base station to the label device to be located according to a sending time point at which the locating base station sends the ultrasonic signal and a time point at which the label device to be located detects the ultrasonic signal, and determining the distance between the label device to be located and the locating base station according to the transmission time length and transmission speed of sound in air.
An embodiment of this disclosure further provides a three-dimensional space locating system, comprising: a computing device; and the above three-dimensional space detection system, wherein the computing device is configured to: after the locating base station and the label device to be located synchronize the base time point, and the label device to be located detects the first laser plane signal, the second laser plane signal and the ultrasonic signal, determine a first rotation angle and a second rotation angle according to a first reference time point at which the locating base station sends the first laser plane signal, a second reference time point at which the locating base station sends the second laser plane signal, a first time point at which the label device to be located detects the first laser plane signal, and a second time point at which the label device to be located detects the second laser plane signal, wherein the first rotation angle is an angle of the first laser plane signal with respect to a plane defined by the first rotation axis and the second rotation axis at the first time point, the second rotation angle is an angle of the second laser plane signal with respect to the plane defined by the first rotation axis and the second rotation axis at the second time point, the first reference time point is a time point when an angel of the first laser plane signal sent by the locating base station with respect to the plane defined by the first rotation axis and the second rotation axis is a first reference angle, and the second reference time point is a time point when an angle of the second laser plane signal sent by the locating base station with respect to the plane defined by the first rotation axis and the second rotation axis is a second reference angle; determine a distance between the label device to be located and the locating base station according to a sending time point at which the locating base station sends the ultrasonic signal and a time point at which the label device to be located detects the ultrasonic signal; and determine three-dimensional coordinates of the label device to be located in a three-dimensional measurement coordinate system according to the first rotation angle, the second rotation angle, and the distance.
Optically, the computing device is configured to determine the three-dimensional coordinates of the label device to be located in a three-dimensional measurement coordinate system according to the first rotation angle, the second rotation angle, and the distance in a manner of: when the three-dimensional measurement coordinate system is a Cartesian coordinate system, the first rotation axis is the X-axis, and the second rotation axis is the Y-axis, determining the three-dimensional coordinates of the label device to be located in a three-dimensional measurement coordinate system according to the following formula:
wherein (Xo, Yo, Zo) represents the three-dimensional coordinates of the label device to be located in the three-dimensional measurement coordinate system, L is the distance between the label device to be located and the locating base station, a is the first rotation angle, and β is the second rotation angle.
Optionally, the computing device is configured to determine the first rotation angle and the second rotation angle according to the first reference time point at which the locating base station sends the first laser plane signal, the second reference time point at which the locating base station sends the second laser plane signal, the first time point at which the label device to be located detects the first laser plane signal, and the second time point at which the label device to be located detects the second laser plane signal in a manner of: determining a relationship between the first time point and the first reference time point according to the first reference time point at which the locating base station sends the first laser plane signal and the first time point at which the label device to be located detects the first laser plane signal, and determining the first rotation angle according to the relationship between the first time point and the first reference time point and the first reference angle corresponding to the first reference time point; and determining a relationship between the second time point and the second reference time point according to the second reference time point at which the locating base station sends the second laser plane signal and the second time point at which the label device to be located detects the second laser plane signal, and determining the second rotation angle according to the relationship between the second time point and the second reference time point and the second reference angle corresponding to the second reference time point.
Optionally, the determining device is configured to determine the distance between the label device to be located and the locating base station according to the sending time point at which the locating base station sends the ultrasonic signal and the time point at which the label device to be located detects the ultrasonic signal in a manner of: determining transmission time length of the ultrasonic signal from the locating base station to the label device to be located according to a sending time point at which the locating base station sends the ultrasonic signal and a time point at which the label device to be located detects the ultrasonic signal, and determining the distance between the label device to be located and the locating base station according to the transmission time length and transmission speed of sound in air.
An embodiment of this disclosure further provides a computer storage medium having stored therein computer-executable instructions for performing the above mentioned method.
In an embodiment of the present disclosure, the locating base station synchronizes a base time point to the label device to be located, sends an ultrasonic signal to the label device to be located, rotationally sends a first laser plane signal about a first rotation axis, and rotationally sends a second laser plane signal about a second rotation axis perpendicular to the first rotation axis to the label device to be located, and the label device to be located synchronizes the base time point from the locating base station, detects the ultrasonic signal, the first laser plane signal, and the second laser plane signal, and determines three-dimensional coordinates of the label device to be located in a three-dimensional measurement coordinate system by computation process according to a first reference time point at which the locating base station sends the first laser plane signal, a second reference time point at which the locating base station sends the second laser plane signal, a sending time point at which the locating base station sends the ultrasonic signal, a first time point at which the label device to be located detects the first laser plane signal, a second time point at which the label device to be located detects the second laser plane signal, a time point at which the label device to be located detects the ultrasonic signal. In this way, in an embodiment of the present disclosure, indoor locating can be performed based on the ultrasonic wave and the laser signal, and the locating accuracy is high. Moreover, an embodiment of the present disclosure has lower cost, and are easy to be miniaturized in the design of the label device to be located, and advantageously used in scenarios that are sensitive to volume or weight, such in a small UAV.
This section provides a summary of various implementations or examples of the technology described in the invention, and is not a comprehensive invention of the full scope or all features of the disclosed technology.
Other aspects will become apparent upon reading and understanding the drawings and detailed description.
BRIEF DESCRIPTION OF THE DRAWINGS
Figure 1 is a schematic diagram of a three-dimensional space detection system according to an embodiment of the present disclosure;
Figure 2 is a flow chart of a three-dimensional space locating method according to an embodiment of the present disclosure;
Figure 3 is a schematic diagram of a three-dimensional space locating system according to an embodiment of the present disclosure;
Figure 4 is a schematic diagram of a three-dimensional space locating method according to an embodiment of the present disclosure;
Figure 5 is a structural schematic diagram of a three-dimensional space locating system according to an embodiment of the present disclosure;
Figure 6 is a flow chart of a three-dimensional space locating method according to an embodiment of the present disclosure;
DETAILED DESCRIPTION
The embodiments of the present disclosure are described in detail below with reference to the accompanying drawings. It should be understood that the embodiments described below are merely used for describing and explaining the present disclosure, and are not intended to limit the present disclosure.
An embodiment of the present disclosure provides a three-dimensional space detection system, including: a locating base station and a label device to be located, wherein the locating base station is configured to synchronize a base time point to the label device to be located, send an ultrasonic signal to the label device to be located, rotationally send a first laser plane signal about a first rotation axis, and rotationally send a second laser plane signal about a second rotation axis to the label device to be located, and the label device to be located is configured to synchronize a base time point from the locating base station, detect the ultrasonic signal, the first laser plane signal and the second laser plane signal, wherein the first rotation axis and the second rotation axis are perpendicular to each other. FIG. 1 is a schematic diagram of a three-dimensional space detection system according to an embodiment of the present disclosure. As shown in FIG. 1, the three-dimensional space detection system provided in this embodiment includes a locating base station 110 and a label device to be located 120. There may be at least one label devices to be located. That is, one locating base station can provide locating service to at least one label devices to be located.
As shown in FIG. 1, the locating base station 110 includes a first synchronization apparatus 111, two rotating laser plane transmitters 112, 113 (rotating laser plane transmitters A and B), and an ultrasonic transmitter 114, wherein the first synchronizing apparatus is configured to synchronize the base time point to the label device to be located; the rotating laser plane transmitter A is configured to rotationally send a first laser plane signal about a first rotation axis; the rotating laser plane transmitter B is configured to rotationally send a second laser plane signal about a second rotation axis perpendicular to the first rotation axis; and the ultrasonic transmitter is configured to send the ultrasonic signal.
Optionally, the first rotation axis and the second rotation axis can intersect. However, this embodiment is not limited thereto. In practical applications, the first rotation axis may not intersect with the second rotation axis. For example, a vertical distance between a pair of parallel planes defined by the first rotation axis and the second rotation axis is within a corresponding predetermined range.
Optionally, the ultrasound transmitter is located at the intersection of the first rotation axis and the second rotation axis. However, this embodiment is not limited thereto. In practical applications, the ultrasonic transmitter may be located near the intersection of the first rotation axis and the second rotation axis (for example, within a predetermined sphere whose center is the intersection). In addition, when the first rotation axis does not intersect the second rotation axis, the ultrasonic transmitter may be located at or near a first intersection (for example, within a predetermined sphere whose center is the intersection), wherein the first intersection is an intersection of a straight line perpendicular to the first rotation axis and parallel to the second rotation axis and the first rotation axis, or, the ultrasonic transmitter may be located at or near the second intersection (for example, within a predetermined sphere whose center is the intersection), wherein the second intersection is an intersection of a straight line perpendicular to the second rotation axis and parallel to the first rotation axis and the second rotation axis.
Optionally, the first synchronization apparatus is a radio communication circuit. However, this embodiment is not limited thereto. In other embodiments, the first synchronization apparatus may also be a light emitting diode (LED), which sends the optical signal to synchronize the time.
As shown in FIG. 1, the label device to be located 120 includes: a second synchronization apparatus 121, a photoelectric sensing circuit 122 and an ultrasonic receiver 123, wherein the second synchronization apparatus is configured to synchronize the base time point from the locating base station; the photoelectric sensing circuit is configured to detect the first laser plane signal and the second laser plane signal sent by the locating base station; and the ultrasonic receiver is configured to detect the ultrasonic signal sent by the locating base station.
Optionally, the second synchronization apparatus is a radio communication circuit. However, this embodiment of the present disclosure is not limited thereto. In other embodiments, the second synchronization apparatus may also receive the optical signal for time synchronization. It should be noted that, the first synchronizing apparatus needs to correspond to the second synchronizing apparatus. For example, when the first synchronizing apparatus is a radio communication circuit, the second synchronizing apparatus is also a radio communication circuit. In other words, the first synchronization apparatus and the second synchronization apparatus adopt a corresponding signal transmission and signal detection technology to achieve time synchronization between the locating base station and the label device to be located.
Optionally, when the 3D space detection system is in operation, the first synchronization apparatus of the locating base station synchronizes the base time point to the label device to be located. The laser of the rotating laser plane transmitter of the locating base station is turned on, and the motor bracket inside the locating base station drives a rotation head of the laser plane transmitter to rotate, continuously rotationally transmitting a laser plane signal to the surrounding space. The ultrasonic transmitter of the locating base station continuously transmits an ultrasonic signal to the surrounding space, e.g. with a pulse frequency of 10 Hz and a modulation frequency of 40 KHz. In this way, the locating base station can provide the label device to be located with locating data with high precision, high frequency and low delay.
At the same time, the second synchronizing apparatus of the label device to be located synchronizes the base time point from the first synchronizing device. When the photoelectric sensor circuit is swept by the laser plane signal, the photoelectric sensor circuit records the time point of being swept. When the ultrasonic receiver detects the ultrasonic signal, he ultrasonic receiver records the time point of detecting the ultrasonic signal.
In addition, an embodiment of the present disclosure further provides a three-dimensional space locating method. FIG. 2 is a flowchart of a three-dimensional space locating method according to an embodiment of the present disclosure. As shown in FIG. 2, the three-dimensional space locating method according to this embodiment includes the following steps:
Step 201: after the locating base station and the label device to be located synchronize the base time point, and the label device to be located detects the first laser plane signal, the second laser plane signal and the ultrasonic signal, determining a first rotation angle and a second rotation angle according to a first reference time point at which the locating base station sends the first laser plane signal, a second reference time point at which the locating base station sends the second laser plane signal, a first time point at which the label device to be located detects the first laser plane signal, and a second time point at which the label device to be located detects the second laser plane signal.
The first rotation angle is an angle of the first laser plane signal with respect to a plane defined by the first rotation axis and the second rotation axis at the first time point, the second rotation angle is an angle of the second laser plane signal with respect to the plane defined by the first rotation axis and the second rotation axis at the second time point, the first reference time point is a time point when an angel of the first laser plane signal sent by the locating base station with respect to the plane defined by the first rotation axis and the second rotation axis is a first reference angle, and the second reference time point is a time point when an angle of the second laser plane signal sent by the locating base station with respect to the plane defined by the first rotation axis and the second rotation axis is a second reference angle.
Optionally, by synchronizing the base time point between the locating base station and the label device to be located, the clock synchronization between the locating base station and the label device to be synchronized is assured to ensure that subsequent computation is based on the same base.
Optionally, relationship between the first time point and the first reference time point is determined according to the first reference time point at which the locating base station sends the first laser plane signal and the first time point at which the label device to be located detects the first laser plane signal, and the first rotation angle is determined according to the relationship between the first time point and the first reference time point and the first reference angle corresponding to the first reference time point;
Relationship between the second time point and the second reference time point is determined according to the second reference time point at which the locating base station sends the second laser plane signal and the second time point at which the label device to be located detects the second laser plane signal, and the second rotation angle is determined according to the relationship between the second time point and the second reference time point and the second reference angle corresponding to the second reference time point.
Optionally, the first reference time point is equal to a second reference time point, and the first reference angle is equal to the second reference angle. However, this embodiment is not limited thereto.
In this embodiment, it should be noted that the plane defined by the first rotation axis and the second rotation axis includes: when the first rotation axis and the second rotation axis can intersect, the plane uniquely defined by the first rotation axis and the second rotation axis; when the first rotation axis and the second rotation axis do not intersect, a pair of parallel planes defined by a first rotation axis and a second rotation axis.
Step 202: determining a distance between the label device to be located and the locating base station according to a sending time point at which the locating base station sends the ultrasonic signal and a time point at which the label device to be located detects the ultrasonic signal.
Optionally, the step includes determining transmission time length of the ultrasonic signal from the locating base station to the label device to be located according to a sending time point at which the locating base station sends the ultrasonic signal and a time point at which the label device to be located detects the ultrasonic signal, and determining the distance between the label device to be located and the locating base station according to the transmission time length and transmission speed of sound in air.
Step 203: determining three-dimensional coordinates of the label device to be located in a three-dimensional measurement coordinate system according to the first rotation angle, the second rotation angle, and the distance between the label device to be located and the locating base station.
In an embodiment, the step includes, when the three-dimensional measurement coordinate system is a Cartesian coordinate system, the first rotation axis is the X-axis, and the second rotation axis is the Y-axis, determining the three-dimensional coordinates of the label device to be located in a three-dimensional measurement coordinate system according to the following formula:
wherein (Xo, Yo, Zo) represents the three-dimensional coordinates of the label device to be located in the three-dimensional measurement coordinate system, L is the distance between the label device to be located and the locating base station, a is the first rotation angle, β is the second rotation angle.
Further, as shown in FIG. 3, an embodiment of this disclosure provides a three-dimensional space locating system, including: a computing device; and the above three-dimensional space detection system, wherein the computing device is configured to: after the locating base station and the label device to be located synchronize the base time point, and the label device to be located detects the first laser plane signal, the second laser plane signal and the ultrasonic signal, determine a first rotation angle and a second rotation angle according to a first reference time point at which the locating base station sends the first laser plane signal, a second reference time point at which the locating base station sends the second laser plane signal, a first time point at which the label device to be located detects the first laser plane signal, and a second time point at which the label device to be located detects the second laser plane signal, wherein the first rotation angle is an angle of the first laser plane signal with respect to a plane defined by the first rotation axis and the second rotation axis at the first time point, the second rotation angle is an angle of the second laser plane signal with respect to the plane defined by the first rotation axis and the second rotation axis at the second time point, the first reference time point is a time point when an angel of the first laser plane signal sent by the locating base station with respect to the plane defined by the first rotation axis and the second rotation axis is a first reference angle, and the second reference time point is a time point when an angle of the second laser plane signal sent by the locating base station with respect to the plane defined by the first rotation axis and the second rotation axis is a second reference angle; determine a distance between the label device to be located and the locating base station according to a sending time point at which the locating base station sends the ultrasonic signal and a time point at which the label device to be located detects the ultrasonic signal; and determine three-dimensional coordinates of the label device to be located in a three-dimensional measurement coordinate system according to the first rotation angle, the second rotation angle, and the distance.
In an embodiment, the computing device is configured to determine the three-dimensional coordinates of the label device to be located in a three-dimensional measurement coordinate system according to the first rotation angle, the second rotation angle, and the distance in a manner of: when the three-dimensional measurement coordinate system is a Cartesian coordinate system, the first rotation axis is the X-axis, and the second rotation axis is the Y-axis, determining the three-dimensional coordinates of the label device to be located in a three-dimensional measurement coordinate system according to the following formula:
wherein (Xo, Yo, Zo) represents the three-dimensional coordinates of the label device to be located in the three-dimensional measurement coordinate system, L is the distance between the label device to be located and the locating base station, a is the first rotation angle, J3 is the second rotation angle.
In an embodiment, the computing device is configured to determine the first rotation angle and the second rotation angle according to the first reference time point at which the locating base station sends the first laser plane signal, the second reference time point at which the locating base station sends the second laser plane signal, the first time point at which the label device to be located detects the first laser plane signal, and the second time point at which the label device to be located detects the second laser plane signal in a manner of: determining a relationship between the first time point and the first reference time point according to the first reference time point at which the locating base station sends the first laser plane signal and the first time point at which the label device to be located detects the first laser plane signal, and determining the first rotation angle according to the relationship between the first time point and the first reference time point and the first reference angle corresponding to the first reference time point; and determining a relationship between the second time point and the second reference time point according to the second reference time point at which the locating base station sends the second laser plane signal and the second time point at which the label device to be located detects the second laser plane signal, and determining the second rotation angle according to the relationship between the second time point and the second reference time point and the second reference angle corresponding to the second reference time point.
In an embodiment, the computing device is configured to determine the distance between the label device to be located and the locating base station according to the sending time point at which the locating base station sends the ultrasonic signal and the time point at which the label device to be located detects the ultrasonic signal in a manner of: determining transmission time length of the ultrasonic signal from the locating base station to the label device to be located according to a sending time point at which the locating base station sends the ultrasonic signal and a time point at which the label device to be located detects the ultrasonic signal, and determining the distance between the label device to be located and the locating base station according to the transmission time length and transmission speed of sound in air.
In an embodiment, the computing device is disposed in e.g. the label device to be located. In particular, when the label device to be located detects the first laser plane signal, the second laser plane signal, and the ultrasonic signal, the label device to be located records the time point at which each signal is detected. Accordingly, the computing device respectively calculates the first rotation angle, the second rotation angle and the distance between the locating base station and the label device to be located, and then calculates the three-dimensional coordinates of the label device to be located in the three-dimensional measurement coordinate system according to the first rotation angle, the second rotation angle and the distance between the locating base station and the label device to be located.
In an embodiment, the computing device is disposed in e.g. a locating base station. In particular, when the label device to be located detects the first laser plane signal, the second laser plane signal and the ultrasonic signal, the label device to be located records the time point at which each signal is detected, and sends the recorded time point at which each signal is detected to the locating base station. Then, the computing device calculates the first rotation angle, the second rotation angle, and the distance between the label device to be located and the locating base station according to the base time point and the time point at which each signal is detected by the label device to be located. Then, the computing device calculates, according to the first rotation angle, the second rotation angle, and the distance between the label device to be located and the locating base station, the three-dimensional coordinates of the label device to be located in the three-dimensional measurement coordinates. And then, the locating base station may send the calculated three-dimensional coordinates to the label device to be located.
However, the present disclosure is not limited hereto. In other embodiments, the computing device may also be disposed in other devices independent of the locating base station and the label device to be located. FIG. 3 is a schematic diagram of a three-dimensional locating system according to an embodiment of the present disclosure. As shown in FIG. 3, the computing device 124 is e.g. disposed in a label device to be located. FIG. 4 is a principle diagram of a three-dimensional locating method provided by an embodiment of the present disclosure.
Next, with reference to FIG. 3 and FIG. 4, the three-dimensional space locating method provided by an embodiment of the present disclosure is described in detail by taking the situation in which the computing device is disposed in the label device to be located as an example.
As shown in FIG. 4, description is given by taking the three-dimensional measurement coordinate system as a Cartesian coordinate system, wherein, the first rotation axis is the X axis, the second rotation axis is the Y axis, and the position of the ultrasonic transmitter of the locating base station is the origin O of the three-dimensional measurement coordinate system. However, this embodiment is not limited thereto. In practical applications, the location where the locating base station is located is, for example, the origin O (in this case, the location of the ultrasound transmitter may be located near the origin O). The rotating laser plane transmitter A of the locating base station rotationally sends a first laser plane signal about the X axis with rotation speed of e.g. wl.The rotating laser plane transmitter B of the locating base station rotationally sends a second laser plane signal about the Y axis with rotation speed of e.g. w2. The plane defined by the X and Y axes is the XOY plane. However, this embodiment is not limited thereto. In practice application, the rotating laser plane transmitter A of the locating base station rotationally transmits the first laser plane signal, for example, about a first rotation axis parallel to the X axis, and the rotation laser plane transmitter B of the locating base station rotationally sends the second laser plane signal about the Y axis (the second rotation axis), the first rotation axis is perpendicular to, and does not intersect the Y axis. In this case, the first rotation axis and the Y axis can define a pair of parallel planes (including an XOY plane and a plane parallel to the XOY plane). Or, the rotating laser plane transmitter A of the locating base station rotationally sends the first laser plane signal about the X axis (first rotation axis), and the rotating laser plane transmitter B of the locating base station rotationally sends the second laser plane signal about e.g. the second rotation axis which is parallel to the Y axis, wherein the second rotation axis is perpendicular to, and and does not intersect the X axis . In this case, the second rotation axis and the X axis can define a pair of parallel planes (including an XOY plane and a plane parallel to the XOY plane). The vertical distance between the pair of parallel planes is, for example, within a predetermined range.
Herein, the locating base station synchronizes the base time point to the label device to be located via the first synchronization apparatus (such as a radio communication circuit). Specifically, by synchronizing the base time point, it is ensured that the locating base station and the label device to be located keep clock synchronization so as to assure that subsequent time point information is based on the same base. However, this embodiment is not limited thereto. The locating base station can also synchronize the base time point to the label device to be located by generating an optical signal.
Herein, the locating base station further transmits a base time point at the first laser plane signal is sent and a base time point at which the second laser plane signal is sent to the label device to be located via the first synchronization apparatus (such as a radio communication circuit). Herein, the time point at which the rotating laser plane transmitter A of the locating base station transmits the first laser plane signal at the first reference angle is referred to as a first reference time point, and the time point at which the rotating laser plane transmitter B of the locating base station transmits the second laser plane signal at the second reference angle is referred to as a second reference time point. The first reference time point and the second reference time point are, for example, the same time point or different time, points, which is not limited in an embodiment of the present disclosure. The first reference angle and the second reference angle may be the same or different. For example, both the first reference angle and the second reference angle are 0, that is, the angle of the laser plane signal sent by the rotating laser plane transmitter A (or B) with respect to the XOY plane at the first reference time point (or the second reference time point) is 0. However, this embodiment of the present disclosure is not limited thereto. The first reference angle and the second reference angle can also other values. When the first reference angle is the same as the second reference angle and the rotational speeds of the rotary laser plane transmitters A and B are the same, the first reference time point and the second reference time point are the same time point. Herein, when there are a plurality of first reference time points and /or second reference time points, the first one among the plurality of first reference time points in time sequence and/or the first one among the plurality of second reference time points in time sequence is, for example, a base time point.
Specifically, each time the rotating laser plane transmitter A (or B) of the locating base station transmits a laser plane signal by rotating to a first reference angle (or a second reference angle), the locating base station transmits, via a first synchronization apparatus (such as a radio Communication circuit), the first reference time point (or the second reference time point) to the label device to be located. Herein, with reference to FIG.4, when the first reference angle is 0 (that is, the included angle between the rotation plane SI and the XOY plane is 0), the first laser plane signal is taken as an example for description. The first rotation angle a is the included angle between the rotation plane SI and the XOY plane. The computing device can determine the first rotation angle according to the following formula when the rotating laser plane transmitter A of the locating base station rotationally sends the first laser plane signal clockwise about the X axis to send :
When the rotating laser plane transmitter A of the locating base station rotationally sends the first laser plane signal counterclockwise about the X axis, the computing device may determine the first rotation angle according to the following formula:
where a is the first rotation angle, Ti is the time point at which the label device to be located detects the first laser plane signal, To(n> is the first reference time point received by the label device to be located from the locating base station last time (for example, in case of a plurality of first reference time points, the N-th first reference time point in time sequence), To (N-i) is the first reference time point received by the label device to be located from the locating base station the time previously before last time (for example, in case of a plurality of first reference time points, the (N-l)-th first reference time point in time sequence), wl is a the rotation speed of rotational laser plane transmitter A of a locating base station.
Similarly, the second rotation angle β is an included angle between the rotation plane S2 and the XOY plane, and determined in a manner similar to that for the first rotation angle, thus not described herein again. It should be noted that, when the rotation speeds wl and w2 are different or the first reference angle and the second reference angle corresponding to the rotating laser plane transmitters A and B are different from each other, thus rendering the first reference time point different from the second reference time point, the locating base station needs to send the first reference time point and the second reference time point to the label device to be located respectively.
In addition, the computing device may determine the distance between the label device to be located and the locating base station according to the following formula:
where L is the distance between the label device to be located and the locating base station, T3 is the time point at which the label device to be located detects the ultrasonic signal, To' is the sending time point at which the locating base station sends the ultrasonic signal, v is the propagation speed of sound in air, where v is about 340 m/s under 1 standard atmospheric pressure and temperature of 15 °C.
It should be noted that, in case where there are a plurality of first reference time points and second reference time points, the sending time point at which the first one of the plurality of first reference time points in time sequence is sent, the sending time point at which the first one of the plurality of second reference time points in time sequence is sent, and the sending time point at which the ultrasonic signal is sent may be same (e.g. as the base time point) or different. This embodiment is not limited thereto.
After obtaining the first rotation angle, the second rotation angle, and the distance between the label device to be located and the locating base station, the computing device can obtain the three-dimensional coordinates of the label device to be located in the three-dimensional measurement coordinate system according to the following formula:
where (Xo, Yo, Zo) represents the three-dimensional coordinates of the label device to be located in the three-dimensional measurement coordinate system, L is the distance between the label device to be located and the locating base station, a is the first rotation angle, and β is the second rotation angle.
To sum up, an embodiment of the present disclosure enables accurate indoor locating based on ultrasonic and laser signals. In an embodiment of the present disclosure, synchronization and timing information transmission between the locating base station and the label device to be located are performed by a synchronization apparatus (such as a radio communication circuit), enabling supporting paired use of the locating base station and the label device to be located in further support of extension application of multiple base stations. Moreover, the label device to be located provided in this embodiment has lower cost, is easy to be miniaturized, and has widened the application scenario.
To sum up, as shown in Fig. 5, an embodiment of this disclosure discloses s three-dimensional space locating system 5, comprising a locating base station 510, a label device to be located 520 and a computing device 530, wherein the locating base station 510 is configured for rotationally sending a first laser plane signal about a first rotation axis, rotationally sending a second laser plane signal about a second rotation axis, and sending an ultrasonic signal; the label device to be located 520 is configured for detecting the first laser plane signal, the second laser plane signal and the ultrasonic signal, recording a first time point at which the first laser plane signal is detected and a second time point at which the second laser plane signal is detected; and the computing device 530 is configured for: determining a first rotation angle according to a first reference time point at which the locating base station 510 sends the first laser plane signal, and the first time point, wherein the first rotation angle is an angle of the first laser plane signal with respect to a plane defined by the first rotation axis and the second rotation axis at the first time point; determining a second rotation angle according to a second reference time point at which the locating base station 510 sends the second laser plane signal, and the second time point, wherein the second rotation angle is an angle of the second laser plane signal with respect to the plane defined by the first rotation axis and the second rotation axis at the second time point; determining a distance between the label device to be located 520 and the locating base station 510 according to a sending time point at which the locating base station 510 sends the ultrasonic signal and a time point at which the label device to be located 520 detects the ultrasonic signal; and determining three-dimensional coordinates of the label device to be located 520 in a three-dimensional measurement coordinate system according to the first rotation angle, the second rotation angle, and the distance between the label device to be located 520 and the locating base station 510.
In an embodiment, the first rotation axis and the second rotation axis are perpendicular to each other.
In an embodiment, the determining a first rotation angle according to a first reference time point at which the locating base station 510 sends the first laser plane signal and the first time point comprises: determining a relationship between the first time point and the first reference time point according to the first reference time point and the first time point, and determining the first rotation angle according to the relationship between the first time point and the first reference time point and the first reference angle corresponding to the first reference time point, wherein the first rotation angle is an angle of the first laser plane signal with respect to a plane defined by the first rotation axis and the second rotation axis at the first reference time point. The determining a second rotation angle according to a second reference time point at which the locating base station 510 sends the second laser plane signal and the second time point comprises: determining a relationship between the second time point and the second reference time point according to the second reference time point and the second time point, and determining the second rotation angle according to the relationship between the second time point and the second reference time point and the second reference angle corresponding to the second reference time point, wherein the second rotation angle is an angle of the second laser plane signal with respect to a plane defined by the first rotation axis and the second rotation axis at the second time point.
In an embodiment, the determining a distance between the label device to be located 520 and the locating base station 510 comprises: determining transmission time length of the ultrasonic signal from the locating base station 510 to the label device to be located 520 according to a sending time point at which the locating base station 510 sends the ultrasonic signal and a time point at which the label device to be located 520 detects the ultrasonic signal; and determining the distance between the label device to be located 520 and the locating base station 510 according to the transmission time length and transmission speed of sound in air.
In an embodiment, the determining three-dimensional coordinates of the label device to be located 520 in a three-dimensional measurement coordinate system according to the first rotation angle, the second rotation angle, and the distance between the label device to be located 520 and the locating base station 510 comprises: when the three-dimensional measurement coordinate system is a Cartesian coordinate system, the first rotation axis is the X-axis, and the second rotation axis is the Y-axis, determining the three-dimensional coordinates of the label device to be located 520 in a three-dimensional measurement coordinate system according to the following formula:
wherein (Xo, Yo, Zo) represents the three-dimensional coordinates of the label device to be located 520 in the three-dimensional measurement coordinate system, L is the distance between the label device to be located 520 and the locating base station 510, a is the first rotation angle, β is the second rotation angle.
In an embodiment, the locating base station 510 comprises: a first synchronization apparatus 511, configured to synchronize the base time point to the label device to be located 520; a first rotating laser plane transmitter 512 configured to rotationally sending the first laser plane signal about the first rotation axis; a second rotating laser plane transmitter 513 configured to rotationally send the second laser plane signal about the second rotation axis; a ultrasound transmitter 514, configured to send the ultrasonic signal.
In an embodiment, the ultrasonic transmitter 514 is located at the intersection of the first rotation axis and the second rotation axis.
In an embodiment, the label device to be located 520 comprises: a second synchronization apparatus 521 configured to synchronize the base time point from the locating base station 510; a photoelectric sensing circuit 522 configured to detect the first laser plane signal and the second laser plane signal sent by the locating base station 510; an ultrasonic receiver 523 configured to detect the ultrasonic signal sent by the locating base station 510.
As shown in Fig. 6, an embodiment of this disclosure further provides a three-dimensional space locating method, comprising:
Step 601: determining a first reference time point at which a locating base station 510 sends a first laser plane signal;
Step 602: determining a first time point at which the label device to be located 520 detects the first laser plane signal, wherein the first laser plane signal rotates around a first rotation axis;
Step 603: determining a second reference time point at which the locating base station 510 sends a second laser plane signal;
Step 604: determining a second time point at which the label device to be located 520 detects the second laser plane signal 604, wherein the second laser plane signal rotates around a second rotation axis;
Step 605: determining a sending time point at which the locating base station 510 sends the ultrasonic signal;
Step 606: determining a time point at which the label device to be located 520 detects the ultrasonic signal;
Step 607: determining a first rotation angle according to the first reference time point and the first time point, wherein the first rotation angle is an angle of the first laser plane signal with respect to a plane defined by the first rotation axis and the second rotation axis at the first time point;
Step 608: determining a second rotation angle according to the second reference time point and the second time point, wherein the second rotation angle is an angle of the second laser plane signal with respect to a plane defined by the first rotation axis and the second rotation axis at the second time point;
Step 609: determining a distance between the label device to be located 520 and the locating base station 510 according to the sending time point at which the locating base station 510 sends the ultrasonic signal and the time point at which the label device to be located520 detects the ultrasonic signal;
Step 610: determining three-dimensional coordinates of the label device to be located 520 in a three-dimensional measurement coordinate system according to the first rotation angle, the second rotation angle and the distance between the label device to be located520 and the locating base station.
In an embodiment, the first rotation axis and the second rotation axis are perpendicular to each other.
In an embodiment, the determining the first rotation angle according to the first reference time point and the first time point comprises: determining, according to the first reference time and the first time, a relationship between the first reference time point and the first time point; determining, according to the relationship between the first reference time and the first time, and a first reference angle corresponding to the first reference time point, the first rotation angle, wherein the first reference angle is an angle of the first laser plane signal with respect to the plane defined by the first rotation axis and the second rotation axis at the first reference time point. Correspondingly, the determining the second rotation angle according to the second reference time point and the second time point comprises: determining, according to the second reference time point and the second time point, a relationship between the second reference time point and the second time point; determining the second rotation angel according to the relationship between the second reference time point and the second time point and a second reference angle corresponding to the second reference time point, wherein the second reference angle is an angle of the second laser plane signal with respect to the plane defined by the first rotation axis and the second rotation axis at the second reference time point.
In an embodiment, the determining the distance between the label device to be located520 and the locating base station 510 comprises: determining transmission time length of the ultrasonic signal from the locating base station 510 to the label device to be located 520 according to a sending time point at which the locating base station 510 sends the ultrasonic signal and a time point at which the label device to be located520 detects the ultrasonic signal; and determining the distance between the label device to be located520 and the locating base station 510 according to the transmission time length and transmission speed of sound in air.
In an embodiment, the determining the three-dimensional coordinates of the label device to be located520 in the three-dimensional measurement coordinate system according to the first rotation angle, the second rotation angle, and the distance between the label device to be located 520 and the locating base station 510 includes: when the three-dimensional measurement coordinate system is a Cartesian coordinate system, the first rotation axis is the X-axis, and the second rotation axis is the Y-axis, determining the three-dimensional coordinates of the label device to be located 520 in the three-dimensional measurement coordinate system according to the following formula:
wherein (Xo, Yo, Zo) represents the three-dimensional coordinates of the label device to be located 520 in the three-dimensional measurement coordinate system, L is the distance between the label device to be located 520 and the locating base station 510, a is the first rotation angle, and β is the second rotation angle.
In an embodiment, the method further comprises: synchronizing the base time point between the locating base station 510 and the label device to be located 520.
Further, an embodiment of this disclosure provides a computer readable storage medium, storing computer executable instructions to be loaded by a processor for performing the above method.
It should be understood to those ordinary skilled in the art that all or part of the steps in the foregoing methods may be implemented by a program instructing a relevant hardware (for example, a processor), wherein the program may be stored in a computer-readable storage medium, such as a read-only memory, a magnetic disk, a CD. Optionally, all or part of the steps of the above embodiments may also be implemented by using one or more integrated circuits. Correspondingly, each module/unit in the above embodiments can be implemented in the form of hardware such as an integrated circuit. Each module/unit in the above embodiments can be implemented in the form of a software function module. For example, the corresponding function is realized by a processor performing programs/instructions stored in the storage. The disclosure is not limited to any particular form of combination of hardware and software.
It should be understood to those ordinary skilled in the art that, modification or equivalence to the technical solution in the disclosure without departing from the spirit and scope of the technical solution of the present disclosure should all fall within the scope of the claims of the present disclosure.
Industrial practicability
The above technical solution can perform indoor locating and has high locating accuracy. Moreover, the above technical solution is less costly for locating, the design of the label device to be located can be easy to be miniaturized, and can thus be advantageously applied to scenarios that are sensitive to volume or weight, such as a small drone, a smart robot, avirtual reality interaction, action capture and so on.

Claims (15)

  1. The claims defining the invention are as follows:
    1. A three-dimensional space locating system, comprising a locating base station, a label device to be located and a computing device, wherein the locating base station is configured for rotationally sending a first laser plane signal about a first rotation axis, rotationally sending a second laser plane signal about a second rotation axis, and sending an ultrasonic signal; the label device to be located is configured for detecting the first laser plane signal, the second laser plane signal and the ultrasonic signal, recording a first time point at which the first laser plane signal is detected and a second time point at which the second laser plane signal is detected; and the computing device is configured for: determining a first rotation angle according to a first reference time point at which the locating base station sends the first laser plane signal, and the first time point, wherein the first rotation angle is an angle of the first laser plane signal with respect to a plane defined by the first rotation axis and the second rotation axis at the first time point; determining a second rotation angle according to a second reference time point at which the locating base station sends the second laser plane signal, and the second time point, wherein the second rotation angle is an angle of the second laser plane signal with respect to the plane defined by the first rotation axis and the second rotation axis at the second time point; determining a distance between the label device to be located and the locating base station according to a sending time point at which the locating base station sends the ultrasonic signal and a time point at which the label device to be located detects the ultrasonic signal; and determining three-dimensional coordinates of the label device to be located in a three-dimensional measurement coordinate system according to the first rotation angle, the second rotation angle, and the distance between the label device to be located and the locating base station.
  2. 2. The system according to claim 1, wherein the first rotation axis and the second rotation axis are perpendicular to each other.
  3. 3. The system according to either one of claim 1 or 2, wherein the determining a first rotation angle according to a first reference time point at which the locating base station sends the first laser plane signal and the first time point comprises: determining a relationship between the first time point and the first reference time point according to the first reference time point and the first time point, and determining the first rotation angle according to the relationship between the first time point and the first reference time point and the first reference angle corresponding to the first reference time point, wherein the first rotation angle is an angle of the first laser plane signal with respect to a plane defined by the first rotation axis and the second rotation axis at the first reference time point; and correspondingly, the determining a second rotation angle according to a second reference time point at which the locating base station sends the second laser plane signal and the second time point comprises: determining a relationship between the second time point and the second reference time point according to the second reference time point and the second time point, and determining the second rotation angle according to the relationship between the second time point and the second reference time point and the second reference angle corresponding to the second reference time point, wherein the second rotation angle is an angle of the second laser plane signal with respect to a plane defined by the first rotation axis and the second rotation axis at the second time point.
  4. 4. The system according to either one of claim 1 or 3, wherein the determining a distance between the label device to be located and the locating base station comprises: determining transmission time length of the ultrasonic signal from the locating base station to the label device to be located according to a sending time point at which the locating base station sends the ultrasonic signal and a time point at which the label device to be located detects the ultrasonic signal; and determining the distance between the label device to be located and the locating base station according to the transmission time length and transmission speed of sound in air.
  5. 5. The system according to claim 1 or 4, wherein the determining three-dimensional coordinates of the label device to be located in a three-dimensional measurement coordinate system according to the first rotation angle, the second rotation angle, and the distance between the label device to be located and the locating base station comprises: when the three-dimensional measurement coordinate system is a Cartesian coordinate system, the first rotation axis is the X-axis, and the second rotation axis is the Y-axis, determining the three-dimensional coordinates of the label device to be located in a three-dimensional measurement coordinate system according to the following formula:
    wherein (Xo, Yo, Zo) represents the three-dimensional coordinates of the label device to be located in the three-dimensional measurement coordinate system, L is the distance between the label device to be located and the locating base station, a is the first rotation angle, β is the second rotation angle.
  6. 6. The system according to either one of claim 1 or 2, wherein the locating base station comprises: a first synchronization apparatus, configured to synchronize the base time point to the label device to be located; a first rotating laser plane transmitter configured to rotationally sending the first laser plane signal about the first rotation axis; a second rotating laser plane transmitter configured to rotationally send the second laser plane signal about the second rotation axis; an ultrasound transmitter, configured to send the ultrasonic signal.
  7. 7. The system according to claim 6, wherein the ultrasonic transmitter is located at the intersection of the first rotation axis and the second rotation axis.
  8. 8. The system according to either one of claim 1 or 2, wherein the label device to be located comprises: a second synchronization apparatus configured to synchronize the base time point from the locating base station; a photoelectric sensing circuit configured to detect the first laser plane signal and the second laser plane signal sent by the locating base station; an ultrasonic receiver configured to detect the ultrasonic signal sent by the locating base station.
  9. 9. A three-dimensional space locating method, comprising: determining a first reference time point at which a locating base station sends a first laser plane signal; determining a first time point at which the label device to be located detects the first laser plane signal, wherein the first laser plane signal rotates around a first rotation axis; determining a second reference time point at which the locating base station sends a second laser plane signal; determining a second time point at which the label device to be located detects the second laser plane signal, wherein the second laser plane signal rotates around a second rotation axis; determining a sending time point at which the locating base station sends the ultrasonic signal; determining a time point at which the label device to be located detects the ultrasonic signal; determining a first rotation angle according to the first reference time point and the first time point, wherein the first rotation angle is an angle of the first laser plane signal with respect to a plane defined by the first rotation axis and the second rotation axis at the first time point; determining a second rotation angle according to the second reference time point and the second time point, wherein the second rotation angle is an angle of the second laser plane signal with respect to a plane defined by the first rotation axis and the second rotation axis at the second time point; determining a distance between the label device to be located and the locating base station according to the sending time point at which the locating base station sends the ultrasonic signal and the time point at which the label device to be located detects the ultrasonic signal; determining three-dimensional coordinates of the label device to be located in a three-dimensional measurement coordinate system according to the first rotation angle, the second rotation angle and the distance between the label device to be located and the locating base station.
  10. 10. The method according to claim 9, wherein the first rotation axis and the second rotation axis are perpendicular to each other.
  11. 11. The method according to either one of claim 9 or 10, wherein the determining the first rotation angle according to the first reference time point and the first time point comprises: determining, according to the first reference time and the first time, a relationship between the first reference time point and the first time point; determining, according to the relationship between the first reference time and the first time, and a first reference angle corresponding to the first reference time point, the first rotation angle, wherein the first reference angle is an angle of the first laser plane signal with respect to the plane defined by the first rotation axis and the second rotation axis at the first reference time point; and correspondingly, the determining the second rotation angle according to the second reference time point and the second time point comprises: determining, according to the second reference time point and the second time point, a relationship between the second reference time point and the second time point; determining the second rotation angel according to the relationship between the second reference time point and the second time point and a second reference angle corresponding to the second reference time point, wherein the second reference angle is an angle of the second laser plane signal with respect to the plane defined by the first rotation axis and the second rotation axis at the second reference time point.
  12. 12. The method according to claim 9, wherein the determining the distance between the label device to be located and the locating base station comprises: determining transmission time length of the ultrasonic signal from the locating base station to the label device to be located according to a sending time point at which the locating base station sends the ultrasonic signal and a time point at which the label device to be located detects the ultrasonic signal; and determining the distance between the label device to be located and the locating base station according to the transmission time length and transmission speed of sound in air.
  13. 13. The method according to claim 9, wherein the determining the three-dimensional coordinates of the label device to be located in the three-dimensional measurement coordinate system according to the first rotation angle, the second rotation angle, and the distance between the label device to be located and the locating base station includes: when the three-dimensional measurement coordinate system is a Cartesian coordinate system, the first rotation axis is the X-axis, and the second rotation axis is the Y-axis, determining the three-dimensional coordinates of the label device to be located in the three-dimensional measurement coordinate system according to the following formula:
    wherein (Xo, Yo, Zo) represents the three-dimensional coordinates of the label device to be located in the three-dimensional measurement coordinate system, L is the distance between the label device to be located and the locating base station, a is the first rotation angle, and β is the second rotation angle.
  14. 14. The method according to any of claims 9 to 13, characterized in further comprising: synchronizing the base time point between the locating base station and the label device to be located.
  15. 15. A computer readable storage medium, storing computer executable instructions to be loaded by a processor for performing a method according to any one of claims 9 to 14.
AU2018204522A 2015-12-23 2018-06-22 Three-dimensional space detection system, positioning method and system Active AU2018204522B2 (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
AU2018204522A AU2018204522B2 (en) 2015-12-23 2018-06-22 Three-dimensional space detection system, positioning method and system

Applications Claiming Priority (3)

Application Number Priority Date Filing Date Title
CN201510977952.3 2015-12-23
PCT/CN2016/070885 WO2017107263A1 (en) 2015-12-23 2016-01-14 Three-dimensional space detection system, positioning method and system
AU2018204522A AU2018204522B2 (en) 2015-12-23 2018-06-22 Three-dimensional space detection system, positioning method and system

Related Parent Applications (1)

Application Number Title Priority Date Filing Date
PCT/CN2016/070885 Division WO2017107263A1 (en) 2015-12-23 2016-01-14 Three-dimensional space detection system, positioning method and system

Publications (2)

Publication Number Publication Date
AU2018204522A1 true AU2018204522A1 (en) 2018-07-19
AU2018204522B2 AU2018204522B2 (en) 2019-08-29

Family

ID=62845396

Family Applications (1)

Application Number Title Priority Date Filing Date
AU2018204522A Active AU2018204522B2 (en) 2015-12-23 2018-06-22 Three-dimensional space detection system, positioning method and system

Country Status (1)

Country Link
AU (1) AU2018204522B2 (en)

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN112799011A (en) * 2019-12-10 2021-05-14 国网内蒙古东部电力有限公司呼伦贝尔供电公司 Three-dimensional space positioning method and system
CN117231201A (en) * 2023-10-12 2023-12-15 广东省建设工程质量安全检测总站有限公司 Error elimination method and related device for pile foundation drill hole inclination measurement

Family Cites Families (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
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
CN102636774B (en) * 2012-04-26 2013-06-05 天津大学 Total-station spatial measuring and positioning method based on optoelectronic scanning and ultrasound distance measurement

Cited By (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN112799011A (en) * 2019-12-10 2021-05-14 国网内蒙古东部电力有限公司呼伦贝尔供电公司 Three-dimensional space positioning method and system
CN117231201A (en) * 2023-10-12 2023-12-15 广东省建设工程质量安全检测总站有限公司 Error elimination method and related device for pile foundation drill hole inclination measurement
CN117231201B (en) * 2023-10-12 2024-03-29 广东省建设工程质量安全检测总站有限公司 Error elimination method and related device for pile foundation drill hole inclination measurement

Also Published As

Publication number Publication date
AU2018204522B2 (en) 2019-08-29

Similar Documents

Publication Publication Date Title
EP3333586B1 (en) Three-dimensional space detection system, positioning method and system
EP3356841B1 (en) Cloud-coordinated location system using ultrasonic pulses and radio signals
US8867313B1 (en) Audio based localization
US9939517B2 (en) Determining a location of a transmitter device
Ens et al. Acoustic Self-Calibrating System for Indoor Smart Phone Tracking.
CN104811497B (en) A kind of exchange method and system based on ultrasonic wave positioning
US20230314603A1 (en) Ad hoc positioning of mobile devices using near ultrasound signals
Wang et al. Prototyping and experimental comparison of IR-UWB based high precision localization technologies
US11864152B2 (en) Location determination using acoustic-contextual data
AU2018204522B2 (en) Three-dimensional space detection system, positioning method and system
KR20120071291A (en) Indoor position finding apparatus and method for measuring indoor positioning using wireless communication
Nawaz et al. A novel power efficient asynchronous time difference of arrival indoor localization system using CC1101 radio transceivers
CN105277936A (en) Range finding system based on mobile phone and method thereof
US10241192B1 (en) Object tracking using receivers
CN206258572U (en) A kind of signal receiving device
Piontek et al. Improving the accuracy of ultrasound–based localisation systems
Traub Acoustic self-calibrating system for indoor smart phone tracking
Wang et al. Prototyping and Experimental Comparison of IR-UWB based High Precision Localization Systems

Legal Events

Date Code Title Description
FGA Letters patent sealed or granted (standard patent)