AU2018204522B2 - Three-dimensional space detection system, positioning method and system - Google Patents
Three-dimensional space detection system, positioning method and system Download PDFInfo
- Publication number
- AU2018204522B2 AU2018204522B2 AU2018204522A AU2018204522A AU2018204522B2 AU 2018204522 B2 AU2018204522 B2 AU 2018204522B2 AU 2018204522 A AU2018204522 A AU 2018204522A AU 2018204522 A AU2018204522 A AU 2018204522A AU 2018204522 B2 AU2018204522 B2 AU 2018204522B2
- Authority
- AU
- Australia
- Prior art keywords
- time point
- base station
- label device
- 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.)
- Active
Links
Landscapes
- Measurement Of Velocity Or Position Using Acoustic Or Ultrasonic Waves (AREA)
- Length Measuring Devices Characterised By Use Of Acoustic Means (AREA)
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 second 121 irstsynchromizauion synchronization apparatus apparatus rotation laser photoelectnc plan transmitter A sensing circuit rotation laser plan ultrasonic transmitter B receiver ultrasonic transminer Fig.1 after the locating base station and the label device to be located synchronize the reference 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 201 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 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 I 202 and a 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 203 angle, and the distance between the label device tobe located and the locating base station 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
2018204522 08 Aug 2019 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 cannot locate the indoor geographical coordinates of the terminal. The 3D laser radar SLAM needs the map of s 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.
Object of the Invention io It is an object of the invention to overcome one or more of the above disadvantages, or at least to provide a useful alternative.
Summary
In a first aspect, the present invention provides a three-dimensional space locating system, comprising a locating base station, a label device to be located and a computing device, is 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 first rotation axis and the second rotation axis are perpendicular to each other;
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;
3o 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
2018204522 08 Aug 2019 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 io locating base station wherein the locating base station comprises:
a first synchronization apparatus, configured to synchronize a base time point to the label device to be located;
a first rotating laser plane transmitter configured to rotationally send the first is 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, wherein the ultrasonic transmitter is located at the origin of the three-dimensional 20 coordinate system.
In a second aspect, the present invention provides 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 so second laser plane signal, wherein the second laser plane signal rotates around a second rotation axis, the first rotation axis and the second rotation axis are perpendicular to each other;
3a
2018204522 08 Aug 2019 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;
s 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 io 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, via an is ultrasound transmitter, 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 threedimensional 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, wherein the ultrasonic transmitter is located at the origin of the threedimensional coordinate system.
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 so 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.
3b
2018204522 08 Aug 2019
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
- 4 2018204522 22 Jun 2018 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:
x0 2+y02+z02=£2
YQ x tan a — Xo x tan β — Ζϋ
- 5 2018204522 22 Jun 2018 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
- 6 2018204522 22 Jun 2018 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
- 7 2018204522 22 Jun 2018 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:
x0 2+y02+z02=£2
YQ x tan a - Xo x tan β~Ζ(} 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.
- 8 2018204522 22 Jun 2018
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
- 9 2018204522 22 Jun 2018 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
- ίο 2018204522 22 Jun 2018 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;
2018204522 22 Jun 2018
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
2018204522 22 Jun 2018 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.
- 13 2018204522 22 Jun 2018
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
2018204522 22 Jun 2018 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
- 15 2018204522 22 Jun 2018 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
- 16 2018204522 22 Jun 2018 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:
- 17 x0 2+y02+z02 =z2
YQ x tan a-Xox tan β ~ZQ
2018204522 22 Jun 2018 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
- 18 2018204522 22 Jun 2018 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:
YQ x tan a — Xo x tan β — ZQ 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.
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
- 19 2018204522 22 Jun 2018 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
- 20 2018204522 22 Jun 2018 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
- 21 2018204522 22 Jun 2018 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
- 22 2018204522 22 Jun 2018 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
- 23 2018204522 22 Jun 2018 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
- 24 2018204522 22 Jun 2018 sends the first laser plane signal clockwise about the X axis to send :
(— ^Q(N))wi _ 360 — Ci (^O(N) ~^0(N-l))Wl360
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:
f7] — T0(N)w1~ a (Tq(N) ~Tq(N-1))W1360’ 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
- 25 2018204522 22 Jun 2018 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:
L = (f-T0’)xv, 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:
X2+Y2+Z2=L2
Yo x tan a = Xo x tan β = ZQ 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
- 26 2018204522 22 Jun 2018 β 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
- 27 2018204522 22 Jun 2018 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
- 28 2018204522 22 Jun 2018 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:
xtana = JV0 x - Zo 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
- 29 2018204522 22 Jun 2018 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
- 30 2018204522 22 Jun 2018 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
- 31 2018204522 22 Jun 2018 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
- 32 2018204522 22 Jun 2018 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
- 33 2018204522 22 Jun 2018 (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 (11)
- 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 first rotation axis and the second rotation axis are perpendicular to each other;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;wherein the locating base station comprises:a first synchronization apparatus, configured to synchronize a base time point to the label device to be located;2018204522 08 Aug 2019 a first rotating laser plane transmitter configured to rotationally send 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, wherein the ultrasonic transmitter is located at the origin of the three-dimensional coordinate system.
- 2. The system according to claim 1, 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.
- 3. The system according to either one of claim 1 or 2, 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 the2018204522 08 Aug 2019 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.
- 4. The system according to any one of claims 1 or 3, wherein the determining threedimensional 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 threedimensional measurement coordinate system according to the following formula:x0 2+y02+z02 =l2Fo x tan a = XQx tan β = Zb 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.
- 5. The system according to claim 1, 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.
- 6. 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;2018204522 08 Aug 2019 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, the first rotation axis and the second rotation axis are perpendicular to each other;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, via an ultrasound transmitter, 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 threedimensional 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, wherein the ultrasonic transmitter is located at the origin of the threedimensional coordinate system.
- 7. The method according to claim 6, wherein the determining the first rotation angle according to the first reference time point and the first time point comprises:2018204522 08 Aug 2019 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.
- 8. The method according to claim 6, 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.
- 9. The method according to claim 6, 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,2018204522 08 Aug 2019 determining the three-dimensional coordinates of the label device to be located in the threedimensional measurement coordinate system according to the following formula:x0 2 + y02 + z02 =l2Yo x tan a-XQ« tan β~Χ(} 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.
- 10. The method according to any of claims 6 to 9, further comprising: synchronizing a base time point between the locating base station and the label device to be located.
- 11. 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 6 to 10.
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 AU2018204522A1 (en) | 2018-07-19 |
AU2018204522B2 true 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) |
Families Citing this family (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112799011B (en) * | 2019-12-10 | 2024-07-30 | 国网内蒙古东部电力有限公司呼伦贝尔供电公司 | Three-dimensional space positioning method and system |
CN114916058A (en) * | 2022-02-25 | 2022-08-16 | 山西天地煤机装备有限公司 | Radio positioning method, system and related device, equipment and storage medium |
CN117231201B (en) * | 2023-10-12 | 2024-03-29 | 广东省建设工程质量安全检测总站有限公司 | Error elimination method and related device for pile foundation drill hole inclination measurement |
Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2005089488A2 (en) * | 2004-03-19 | 2005-09-29 | Mitch Randall | Method and apparatus to communicate with and individually locate multiple remote devices on a two-dimensional surface |
CN102636774A (en) * | 2012-04-26 | 2012-08-15 | 天津大学 | Total-station spatial measuring and positioning method based on optoelectronic scanning and ultrasound distance measurement |
-
2018
- 2018-06-22 AU AU2018204522A patent/AU2018204522B2/en active Active
Patent Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2005089488A2 (en) * | 2004-03-19 | 2005-09-29 | Mitch Randall | Method and apparatus to communicate with and individually locate multiple remote devices on a two-dimensional surface |
CN102636774A (en) * | 2012-04-26 | 2012-08-15 | 天津大学 | Total-station spatial measuring and positioning method based on optoelectronic scanning and ultrasound distance measurement |
Also Published As
Publication number | Publication date |
---|---|
AU2018204522A1 (en) | 2018-07-19 |
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 | |
AU2018204522B2 (en) | Three-dimensional space detection system, positioning method and system | |
US8867313B1 (en) | Audio based localization | |
US20090190441A1 (en) | Autonomous ultrasonic indoor tracking system | |
CN104811497B (en) | A kind of exchange method and system based on ultrasonic wave positioning | |
EP3759508B1 (en) | Acoustic positioning transmitter and receiver system and method | |
US11567195B2 (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 | |
CN106199517A (en) | A kind of location equipment, locating base station, space positioning system and method | |
Nawaz et al. | A novel power efficient asynchronous time difference of arrival indoor localization system using CC1101 radio transceivers | |
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 | |
EP3729131A1 (en) | Methods and systems for localization | |
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) |