阅读说明：本技术 一种地下空间的三维定位方法 (Three-dimensional positioning method for underground space ) 是由 李文胜 雷升祥 李庆 丁正全 王华兵 傅萃清 沈学军 黄伟 王明文 贠毓 尹巧 于 2021-06-17 设计创作，主要内容包括：一种地下空间的三维定位方法,包括：移动客户端向位置装置发送电磁波信号,位置装置接收电磁波信号,并向移动客户端发送含自身位置信息的电磁波信号；移动客户端接收并解析位置装置发送的电磁波信号,得到位置装置的位置坐标；根据电磁波从位置装置发送到移动客户端的时间,计算移动客户端到位置装置距离；根据电磁波信号方向与移动客户端到位置装置距离,得到移动用户端到区域内的位置装置的相对位置关系；根据位置装置的三维坐标和移动用户端与位置装置的相对位置关系,计算得到移动用户端的三维坐标。本发明解决了现有技术中,只能得到平面二维坐标,无法得到某一物体的三维坐标的问题。(A method of three-dimensional localization of a subsurface space, comprising: the mobile client sends an electromagnetic wave signal to the position device, and the position device receives the electromagnetic wave signal and sends the electromagnetic wave signal containing self position information to the mobile client; the mobile client receives and analyzes the electromagnetic wave signal sent by the position device to obtain the position coordinate of the position device; calculating the distance from the mobile client to the position device according to the time of the electromagnetic wave transmitted from the position device to the mobile client; obtaining the relative position relation from the mobile client to the position device in the region according to the distance between the electromagnetic wave signal direction and the mobile client to the position device; and calculating to obtain the three-dimensional coordinates of the mobile user side according to the three-dimensional coordinates of the position device and the relative position relation between the mobile user side and the position device. The invention solves the problem that in the prior art, only two-dimensional plane coordinates can be obtained, and the three-dimensional coordinates of an object cannot be obtained.)

1. A three-dimensional positioning method for underground space is characterized by comprising the following steps:

s100, the mobile client sends an electromagnetic wave signal to the position device, and the position device receives the electromagnetic wave signal and sends the electromagnetic wave signal containing self position information to the mobile client;

s200, the mobile client receives and analyzes the electromagnetic wave signal sent by the position device to obtain the position coordinate of the position device;

S300, calculating the distance from the mobile client to the position device according to the time of the electromagnetic waves transmitted from the position device to the mobile client;

s400, obtaining the relative position relation from the mobile client to the position device in the region according to the distance between the electromagnetic wave signal direction and the mobile client to the position device;

s500, calculating to obtain the three-dimensional coordinates of the mobile user side according to the three-dimensional coordinates of the position device and the relative position relation between the mobile user side and the position device.

2. The method of claim 1, wherein a plurality of the position units are fixedly installed in the underground space and the above-ground construction space at S100.

3. The method as claimed in claim 1, wherein in S100, the mobile client can set a plurality of types of transmittable electromagnetic wave signals and receivable electromagnetic wave signals.

4. The method of claim 1, wherein in S100, the electromagnetic wave signal transmitted by the location device is set by a person who develops the location device, according to an actual scene, to set the wavelength and frequency of the electromagnetic wave.

5. The method as claimed in claim 1, wherein in S400, the method for obtaining the relative position relationship from the mobile ue to the location device in the area comprises: after receiving the electromagnetic wave signals sent by the position device, the mobile client side demodulates the signals to obtain three-dimensional coordinates (x) of N devices at the nearest positions _i,y_i,z_i) Wherein, i is 1, 2, 1_i，b_i) Then, calculating the time t taken for sending and receiving; wherein a is_iThe included angle between the signal direction and the true north direction on the horizontal plane is calculated clockwise; b_iIs the angle between the signal direction and the normal of the horizontal plane on the vertical plane, and the angle is calculated by clockwise.

6. The method as claimed in claim 5, wherein the step S500 of calculating the three-dimensional coordinates of the mobile user terminal includes: from the position device three-dimensional coordinates (x)_i,y_i,z_i) The time t and the electromagnetic wave propagation speed are taken to calculate the distance d between the two_iThen can be divided into N positionsThe device calculates N user positions, and the obtained user coordinates are 1/N (x)_i+d_i*cos(a_i),y_i+d_i*sin(a_i),z_i+d_i*sin(b_i) 1, 2, N, (x)_i+d_i*cos(a_i),y_i+d_i*sin(a_i),zi+d_i*sin(b_i) The result of the calculation by the i-th position device is represented.

7. The method as claimed in claim 5, wherein the step S500 of calculating the three-dimensional coordinates of the mobile user terminal further comprises: according to angle (a)_i，b_i) And position device three-dimensional coordinates (x)_i，y_i，z_i) (ii) a From the three-dimensional coordinate direction (pi + a) of the i position devices_i，π+b_i) And (4) making an extension line in the direction, if the three position devices have intersection points, calculating coordinates of the intersection points, and if the intersection points do not exist, searching a point closest to the total distance of the three lines.

Technical Field

The invention relates to the field of space positioning, in particular to a three-dimensional positioning method for underground space.

Background

The current positioning modes mainly comprise GPS positioning, base station positioning, WiFi auxiliary positioning, AGPS positioning, Glonass positioning and Beidou positioning.

The GPS positioning is positioned by a satellite and is characterized in that: and a sim card is not needed, a network is not needed to be connected, and the method is needed to be carried out in an open place outdoors. The base station positioning is to search surrounding base station signals after a terminal is inserted into a sim card, and the base station signals are easily interfered. WiFi positioning can be performed only by turning on WiFi and being in a networking state, and positioning cannot be performed without a network.

The AGPS positioning has the defects of GPS positioning and WiFi positioning, and the working principle of Glonass positioning and Beidou positioning is the same as that of the GPS, so that the AGPS positioning has the defect that the positioning must be carried out outdoors.

Patent CN201510977952.3 discloses a three-dimensional space detection system, a positioning method and a system, which adopt ultrasonic waves for positioning, the device to be marked must have a photoelectric sensing circuit and an ultrasonic receiving device, and is not beneficial to use under the condition of intensive people flow, the requirement for the device to be marked is high, and meanwhile, the transmitting device needs to transmit laser and ultrasonic waves, and the requirement for the transmitting device is high, and is not beneficial to daily use.

In addition to the above problems, all the above positioning methods have a limitation: only two-dimensional coordinates of a plane can be obtained, and three-dimensional coordinates of a certain object cannot be obtained.

Disclosure of Invention

In view of the above, the present invention has been made to provide a three-dimensional positioning method of a subsurface space that overcomes or at least partially solves the above problems.

In order to solve the technical problem, the embodiment of the application discloses the following technical scheme:

a method of three-dimensional localization of a subsurface space, comprising:

s100, the mobile client sends an electromagnetic wave signal to the position device, and the position device receives the electromagnetic wave signal and sends the electromagnetic wave signal containing self position information to the mobile client;

s200, the mobile client receives and analyzes the electromagnetic wave signal sent by the position device to obtain the position coordinate of the position device;

s300, calculating the distance from the mobile client to the position device according to the time of the electromagnetic waves transmitted from the position device to the mobile client;

s400, obtaining the relative position relation from the mobile client to the position device in the region according to the distance between the electromagnetic wave signal direction and the mobile client to the position device;

s500, calculating to obtain the three-dimensional coordinates of the mobile user side according to the three-dimensional coordinates of the position device and the relative position relation between the mobile user side and the position device.

Further, in S100, a plurality of location devices are fixedly disposed in the underground space and the above-ground building space.

Further, in S100, the mobile client may set a plurality of types of transmittable electromagnetic wave signals and receivable electromagnetic wave signals.

Further, in S100, the electromagnetic wave signal transmitted by the location device is set by a person who develops the location device, according to an actual scene, and the wavelength and frequency of the electromagnetic wave are set.

Further, in S400, the method for obtaining the relative position relationship from the mobile ue to the location device in the area includes: after receiving the electromagnetic wave signals sent by the position device, the mobile client side demodulates the signals to obtain three-dimensional coordinates (x) of N devices at the nearest positions_i,y_i,z_i) Wherein, i is 1, 2, 1_i，b_i) Then, calculating the time t taken for sending and receiving; wherein a is_iThe included angle between the signal direction and the true north direction on the horizontal plane is calculated clockwise; b_iIs the angle between the signal direction and the normal of the horizontal plane on the vertical plane, and the angle is calculated by clockwise.

Further, in S500, the method for calculating the three-dimensional coordinates of the mobile user terminal includes: from the position device three-dimensional coordinates (x) _i,y_i,z_i) The time t and the electromagnetic wave propagation speed are taken to calculate the distance d between the two_iThen, N user positions can be calculated by the N position device, and the obtained user coordinate is 1/N (x)_i+d_i*cos(a_i),y_i+d_i*sin(a_i),z_i+d_i*sin(b_i) 1, 2, N, (x)_i+d_i*cos(a_i),y_i+d_i*sin(a_i),zi+d_i*sin(b_i) The result of the calculation by the i-th position device is represented.

Further, S500, the method for calculating and obtaining the three-dimensional coordinates of the mobile user side further includes: according to angle (a)_i，b_i) And position device three-dimensional coordinates (x)_i，y_i，z_i) (ii) a From the three-dimensional coordinate direction (pi + a) of the i position devices_i，π+b_i) And (4) making an extension line in the direction, if the three position devices have intersection points, calculating coordinates of the intersection points, and if the intersection points do not exist, searching a point closest to the total distance of the three lines.

The technical scheme provided by the embodiment of the invention has the beneficial effects that at least:

the invention discloses a three-dimensional positioning method of underground space, which comprises the steps that a mobile client sends an electromagnetic wave signal to a position device, the position device receives the electromagnetic wave signal and sends the electromagnetic wave signal containing self position information to the mobile client; the mobile client receives and analyzes the electromagnetic wave signal sent by the position device to obtain the position coordinate of the position device; calculating the distance from the mobile client to the position device according to the time of the electromagnetic wave transmitted from the position device to the mobile client; obtaining the relative position relation from the mobile client to the position device in the region according to the distance between the electromagnetic wave signal direction and the mobile client to the position device; and calculating to obtain the three-dimensional coordinates of the mobile user side according to the three-dimensional coordinates of the position device and the relative position relation between the mobile user side and the position device. The problem of in the prior art, can only obtain plane two-dimensional coordinate, can not obtain the three-dimensional coordinate of a certain object is solved.

The technical solution of the present invention is further described in detail by the accompanying drawings and embodiments.

Drawings

The accompanying drawings, which are included to provide a further understanding of the invention and are incorporated in and constitute a part of this specification, illustrate embodiments of the invention and together with the description serve to explain the principles of the invention and not to limit the invention. In the drawings:

fig. 1 is a flowchart of a three-dimensional positioning method for an underground space in embodiment 1 of the present invention.

Detailed Description

Exemplary embodiments of the present disclosure will be described in more detail below with reference to the accompanying drawings. While exemplary embodiments of the present disclosure are shown in the drawings, it should be understood that the present disclosure may be embodied in various forms and should not be limited to the embodiments set forth herein. Rather, these embodiments are provided so that this disclosure will be thorough and complete, and will fully convey the scope of the disclosure to those skilled in the art.

In order to solve the problems in the prior art, embodiments of the present invention provide a three-dimensional positioning method for an underground space.

Example 1

The embodiment discloses a three-dimensional positioning method for an underground space, as shown in fig. 1, including:

s100, the mobile client sends an electromagnetic wave signal to the position device, and the position device receives the electromagnetic wave signal and sends the electromagnetic wave signal containing self position information to the mobile client; specifically, a plurality of position devices with the same individual performance are distributed in the underground space and the overground building space, and a plurality of position devices are arranged at an entrance, an intersection, upper and lower floors and main nodes of the underground space and the overground building space.

In this embodiment, the mobile user terminal sets a plurality of types of transmittable electromagnetic wave signals and receivable electromagnetic wave signals. The device sent by the mobile user terminal can be Bluetooth and other devices capable of generating electromagnetic signals. The location means are separate, fixed, devices that have been preset how to transmit. The electromagnetic wave signals transmitted by the position device are set by a person developing the position device according to different actual scenes, and the wavelength and the frequency of the electromagnetic waves are set.

S200, the mobile client receives and analyzes the electromagnetic wave signal sent by the position device to obtain the position coordinate of the position device; in this embodiment, after receiving the electromagnetic wave signal transmitted by the position device, the mobile client performs signal demodulation to obtain three-dimensional coordinates (x) of N position devices at the nearest positions_i,y_i,z_i) Where i 1, 2, and N, in some preferred embodiments, the coordinates of the 3 position devices of the nearest position are preferred.

S300, calculating the distance from the mobile client to the position device according to the time of the electromagnetic waves transmitted from the position device to the mobile client; in the embodiment, since the electromagnetic wave transmitted by the position device is already set, the propagation speed V of the electromagnetic wave is known, and the distance from the mobile client to the position device can be obtained by the time T when the electromagnetic wave is transmitted from the position device to the mobile client.

S400, obtaining the relative position relation from the mobile client to the position device in the region according to the distance between the electromagnetic wave signal direction and the mobile client to the position device; specifically, the method for obtaining the relative position relationship from the mobile user terminal to the location device in the area comprises: after receiving the electromagnetic wave signals sent by the position device, the mobile client side demodulates the signals to obtain three-dimensional coordinates (x) of N devices at the nearest positions_i,y_i,z_i) Wherein, i is 1, 2, 1_i，b_i) Then, calculating the time t taken for sending and receiving; wherein a is_iThe included angle between the signal direction and the true north direction on the horizontal plane is calculated clockwise; b_iIs the angle between the signal direction and the normal of the horizontal plane on the vertical plane, and the angle is calculated by clockwise.

S500, calculating to obtain the three-dimensional coordinates of the mobile user side according to the three-dimensional coordinates of the position device and the relative position relation between the mobile user side and the position device.

In this embodiment, the method for calculating and obtaining the three-dimensional coordinates of the mobile user side includes: from the position device three-dimensional coordinates (x)_i,y_i,z_i) The time t and the electromagnetic wave propagation speed are taken to calculate the distance d between the two _iThen, N user positions can be calculated by the N position device, and the obtained user coordinate is 1/N (x)_i+d_i*cos(a_i),y_i+d_i*sin(a_i),z_i+d_i*sin(b_i) 1, 2, N, (x)_i+d_i*cos(a_i),y_i+d_i*sin(a_i),zi+d_i*sin(b_i) The result of the calculation by the i-th position device is represented.

In this embodiment, the method for calculating and obtaining the three-dimensional coordinates of the mobile user terminal further includes: according to angle (a)_i，b_i) And position device three-dimensional coordinates (x)_i，y_i，z_i) (ii) a From the three-dimensional coordinate direction (pi + a) of the i position devices_i，π+b_i) And (4) making an extension line in the direction, if the three position devices have intersection points, calculating coordinates of the intersection points, and if the intersection points do not exist, searching a point closest to the total distance of the three lines. The intersection point can be calculated by mathematical geometry knowledge and is not described in detail.

In the three-dimensional positioning method for the underground space disclosed by the embodiment, the mobile client sends an electromagnetic wave signal to the position device, and the position device receives the electromagnetic wave signal and sends the electromagnetic wave signal containing self position information to the mobile client; the mobile client receives and analyzes the electromagnetic wave signal sent by the position device to obtain the position coordinate of the position device; calculating the distance from the mobile client to the position device according to the time of the electromagnetic wave transmitted from the position device to the mobile client; obtaining the relative position relation from the mobile client to the position device in the region according to the distance between the electromagnetic wave signal direction and the mobile client to the position device; and calculating to obtain the three-dimensional coordinates of the mobile user side according to the three-dimensional coordinates of the position device and the relative position relation between the mobile user side and the position device. The problem of in the prior art, can only obtain plane two-dimensional coordinate, can not obtain the three-dimensional coordinate of a certain object is solved.

It should be understood that the specific order or hierarchy of steps in the processes disclosed is an example of exemplary approaches. Based upon design preferences, it is understood that the specific order or hierarchy of steps in the processes may be rearranged without departing from the scope of the present disclosure. The accompanying method claims present elements of the various steps in a sample order, and are not intended to be limited to the specific order or hierarchy presented.

In the foregoing detailed description, various features are grouped together in a single embodiment for the purpose of streamlining the disclosure. This method of disclosure is not to be interpreted as reflecting an intention that the claimed embodiments of the subject matter require more features than are expressly recited in each claim. Rather, as the following claims reflect, invention lies in less than all features of a single disclosed embodiment. Thus, the following claims are hereby expressly incorporated into the detailed description, with each claim standing on its own as a separate preferred embodiment of the invention.

Those of skill would further appreciate that the various illustrative logical blocks, modules, circuits, and algorithm steps described in connection with the embodiments disclosed herein may be implemented as electronic hardware, computer software, or combinations of both. To clearly illustrate this interchangeability of hardware and software, various illustrative components, blocks, modules, circuits, and steps have been described above generally in terms of their functionality. Whether such functionality is implemented as hardware or software depends upon the particular application and design constraints imposed on the overall system. Skilled artisans may implement the described functionality in varying ways for each particular application, but such implementation decisions should not be interpreted as causing a departure from the scope of the present disclosure.

The steps of a method or algorithm described in connection with the embodiments disclosed herein may be embodied directly in hardware, in a software module executed by a processor, or in a combination of the two. A software module may reside in RAM memory, flash memory, ROM memory, EPROM memory, EEPROM memory, registers, hard disk, a removable disk, a CD-ROM, or any other form of storage medium known in the art. An exemplary storage medium is coupled to the processor such the processor can read information from, and write information to, the storage medium. Of course, the storage medium may also be integral to the processor. The processor and the storage medium may reside in an ASIC. The ASIC may reside in a user terminal. Of course, the processor and the storage medium may reside as discrete components in a user terminal.

For a software implementation, the techniques described herein may be implemented with modules (e.g., procedures, functions, and so on) that perform the functions described herein. The software codes may be stored in memory units and executed by processors. The memory unit may be implemented within the processor or external to the processor, in which case it can be communicatively coupled to the processor via various means as is known in the art.

What has been described above includes examples of one or more embodiments. It is, of course, not possible to describe every conceivable combination of components or methodologies for purposes of describing the aforementioned embodiments, but one of ordinary skill in the art may recognize that many further combinations and permutations of various embodiments are possible. Accordingly, the embodiments described herein are intended to embrace all such alterations, modifications and variations that fall within the scope of the appended claims. Furthermore, to the extent that the term "includes" is used in either the detailed description or the claims, such term is intended to be inclusive in a manner similar to the term "comprising" as "comprising" is interpreted when employed as a transitional word in a claim. Furthermore, any use of the term "or" in the specification of the claims is intended to mean a "non-exclusive or".