阅读说明：本技术 基于多基站斜率筛选的tof三维定位方法和系统 (TOF three-dimensional positioning method and system based on multi-base-station slope screening ) 是由 吴昌建 崔东东 于 2020-12-11 设计创作，主要内容包括：本发明提供了一种基于多基站斜率筛选的TOF三维定位方法和系统,该方法包括：获取当前时间点所有基站针对目标标签的TOF定位数据；对所述目标标签的TOF定位数据进行解析,并对解析结果进行分组,得到分组结果；从所有分组中选择一组作为目标组,并基于所述目标组计算所述目标标签对应的三维坐标,得到定位结果。应用本发明中的方法可以过滤掉大部分不符合计算要求的定位数据,减少了系统处理的数据量,加快了定位算法的运算速度,并且使得过滤后的数据的误差率大大降低,提升了标签在三维空间内的定位精度。(The invention provides a TOF three-dimensional positioning method and a TOF three-dimensional positioning system based on multi-base-station slope screening, wherein the method comprises the following steps: acquiring TOF (time of flight) positioning data of all base stations aiming at the target label at the current time point; analyzing the TOF positioning data of the target label, and grouping analysis results to obtain grouping results; and selecting one group from all the groups as a target group, and calculating the three-dimensional coordinates corresponding to the target labels based on the target group to obtain a positioning result. By applying the method, most positioning data which do not meet the calculation requirements can be filtered, the data amount processed by the system is reduced, the operation speed of a positioning algorithm is increased, the error rate of the filtered data is greatly reduced, and the positioning accuracy of the label in a three-dimensional space is improved.)

1. A TOF three-dimensional positioning method based on multi-base-station slope screening is characterized by comprising the following steps:

acquiring TOF (time of flight) positioning data of all base stations aiming at the target label at the current time point;

analyzing the TOF positioning data of the target label, and grouping analysis results to obtain grouping results;

and selecting one group from all the groups as a target group, and calculating the three-dimensional coordinates corresponding to the target labels based on the target group to obtain a positioning result.

2. The TOF three-dimensional positioning method based on multi-base-station slope screening according to claim 1, wherein the obtaining of TOF positioning data of all base stations at the current time point for a target tag comprises:

taking a label to be positioned as a target label;

and at the current time point, receiving TOF positioning data which is uploaded by all base stations and aims at the target label and three-dimensional coordinates corresponding to all the base stations.

3. The TOF three-dimensional positioning method based on multi-base-station slope screening as claimed in claim 1, wherein analyzing the TOF positioning data of the target label and grouping the analysis results to obtain grouping results comprises:

analyzing the TOF positioning data of the target label to obtain a data object of each base station;

and grouping the data objects obtained by analysis according to the grouping name of the base station to which the base station belongs to obtain a grouping result.

4. The TOF three-dimensional positioning method based on multi-base-station slope screening according to any one of claims 1-3, wherein selecting one group from all the groups as a target group, and calculating three-dimensional coordinates corresponding to the target label based on the target group to obtain a positioning result comprises:

sorting the grouping results according to the number of the data objects contained in the grouping, and screening out a target group meeting the conditions from a group with the largest number of the data objects, wherein the target group meets the following conditions:

the Z-axis coordinate of one base station in the target group is larger than the Z-axis coordinates of other base stations;

when the Z-axis coordinates of at least three base stations in the target group are the same and the coordinates of any one of the three base stations is taken as an origin, the slope of a connecting line of coordinate points of the other two base stations is within a preset range;

and calculating the three-dimensional coordinates corresponding to the target label according to the coordinates of the four base stations selected from the target group to obtain a positioning result.

5. The TOF three-dimensional positioning method based on multi-base-station slope screening according to claim 4, wherein calculating three-dimensional coordinates corresponding to the target label according to coordinates of four base stations selected from the target group to obtain a positioning result comprises:

determining the X-axis coordinate and the Y-axis coordinate of the target label by combining a trilateration algorithm according to the three-dimensional coordinates of three base stations with the same Z-axis coordinate;

and determining the Z-axis coordinate of the target label according to the three-dimensional coordinate of a base station with different Z-axis coordinates and the X-axis coordinate and the Y-axis coordinate of the target label.

6. A TOF three-dimensional positioning system based on multi-base-station slope screening, comprising:

the acquisition module is used for acquiring TOF positioning data of all base stations aiming at the target label at the current time point;

the analysis module is used for analyzing the TOF positioning data of the target label and grouping analysis results to obtain grouping results;

and the positioning module is used for selecting one group from all the groups as a target group, and calculating the three-dimensional coordinates corresponding to the target label based on the target group to obtain a positioning result.

7. The multi-base-station slope screening-based TOF three-dimensional positioning system of claim 6, wherein the obtaining module is specifically configured to:

taking a label to be positioned as a target label;

and at the current time point, receiving TOF positioning data which is uploaded by all base stations and aims at the target label and three-dimensional coordinates corresponding to all the base stations.

8. The multi-base-station slope screening-based TOF three-dimensional positioning system of claim 6, wherein the parsing module is specifically configured to:

analyzing the TOF positioning data of the target label to obtain a data object of each base station;

and grouping the data objects obtained by analysis according to the grouping name of the base station to which the base station belongs to obtain a grouping result.

9. The system according to any of claims 6-8, wherein the positioning module is specifically configured to:

sorting the grouping results according to the number of the data objects contained in the grouping, and screening out a target group meeting the conditions from a group with the largest number of the data objects, wherein the target group meets the following conditions:

the Z-axis coordinate of one base station in the target group is larger than the Z-axis coordinates of other base stations;

when the Z-axis coordinates of at least three base stations in the target group are the same and the coordinates of any one of the three base stations is taken as an origin, the slope of a connecting line of coordinate points of the other two base stations is within a preset range;

and calculating the three-dimensional coordinates corresponding to the target label according to the coordinates of the four base stations selected from the target group to obtain a positioning result.

10. The TOF three-dimensional positioning system based on multi-base-station slope screening according to claim 9, wherein calculating the three-dimensional coordinates corresponding to the target tag according to the coordinates of four base stations selected from the target group to obtain a positioning result comprises:

determining the X-axis coordinate and the Y-axis coordinate of the target label by combining a trilateration algorithm according to the three-dimensional coordinates of three base stations with the same Z-axis coordinate;

and determining the Z-axis coordinate of the target label according to the three-dimensional coordinate of a base station with different Z-axis coordinates and the X-axis coordinate and the Y-axis coordinate of the target label.

Technical Field

The invention relates to the technical field of data processing, in particular to a TOF three-dimensional positioning method and system based on multi-base-station slope screening.

Background

With the increase of the demand of positioning application, various positioning technologies are developed, and the used scenes are wider. However, the positioning data of some companies cannot meet the requirements of positioning accuracy, speed and accuracy in various complex scenes.

Through a search of the prior art, a three-dimensional indoor positioning method is disclosed in a document with application number 201610960909.0 entitled "a three-dimensional indoor positioning system based on UWB (Ultra wide band, carrier-free communication technology"). Although the method realizes indoor three-dimensional positioning, the method ignores the system processing speed under the conditions of multiple labels, multiple base station scenes and huge data volume when the positioning scene is excessively needed. When the method is applied, the selection of the operation data finally influences the response speed of a program and the positioning accuracy, so that the method has limitations and lower positioning accuracy.

Disclosure of Invention

Aiming at the defects in the prior art, the invention aims to provide a time-of-flight (TOF) three-dimensional positioning method and system based on multi-base-station slope screening.

In a first aspect, the present invention provides a TOF three-dimensional positioning method based on multi-base-station slope screening, including:

acquiring TOF (time of flight) positioning data of all base stations aiming at the target label at the current time point;

analyzing the TOF positioning data of the target label, and grouping analysis results to obtain grouping results;

and selecting one group from all the groups as a target group, and calculating the three-dimensional coordinates corresponding to the target labels based on the target group to obtain a positioning result.

Optionally, the obtaining TOF positioning data of all base stations at the current time point for the target tag includes:

taking a label to be positioned as a target label;

and at the current time point, receiving TOF positioning data which is uploaded by all base stations and aims at the target label and three-dimensional coordinates corresponding to all the base stations.

Optionally, analyzing the TOF positioning data of the target label, and grouping analysis results to obtain grouping results, including:

analyzing the TOF positioning data of the target label to obtain a data object of each base station;

and grouping the data objects obtained by analysis according to the grouping name of the base station to which the base station belongs to obtain a grouping result.

Optionally, selecting one group from all the groups as a target group, and calculating a three-dimensional coordinate corresponding to the target tag based on the target group to obtain a positioning result, including:

sorting the grouping results according to the number of the data objects contained in the grouping, and screening out a target group meeting the conditions from a group with the largest number of the data objects, wherein the target group meets the following conditions:

the Z-axis coordinate of one base station in the target group is larger than the Z-axis coordinates of other base stations;

when the Z-axis coordinates of at least three base stations in the target group are the same and the coordinates of any one of the three base stations is taken as an origin, the slope of a connecting line of coordinate points of the other two base stations is within a preset range;

and calculating the three-dimensional coordinates corresponding to the target label according to the coordinates of the four base stations selected from the target group to obtain a positioning result.

Optionally, calculating a three-dimensional coordinate corresponding to the target tag according to the coordinates of the four base stations selected from the target group to obtain a positioning result, where the method includes:

determining the X-axis coordinate and the Y-axis coordinate of the target label by combining a trilateration algorithm according to the three-dimensional coordinates of three base stations with the same Z-axis coordinate;

and determining the Z-axis coordinate of the target label according to the three-dimensional coordinate of a base station with different Z-axis coordinates and the X-axis coordinate and the Y-axis coordinate of the target label.

In a second aspect, the present invention provides a TOF three-dimensional positioning system based on multi-base-station slope screening, including:

the acquisition module is used for acquiring TOF positioning data of all base stations aiming at the target label at the current time point;

the analysis module is used for analyzing the TOF positioning data of the target label and grouping analysis results to obtain grouping results;

and the positioning module is used for selecting one group from all the groups as a target group, and calculating the three-dimensional coordinates corresponding to the target label based on the target group to obtain a positioning result.

Optionally, the obtaining module is specifically configured to:

taking a label to be positioned as a target label;

and at the current time point, receiving TOF positioning data which is uploaded by all base stations and aims at the target label and three-dimensional coordinates corresponding to all the base stations.

Optionally, the parsing module is specifically configured to:

analyzing the TOF positioning data of the target label to obtain a data object of each base station;

and grouping the data objects obtained by analysis according to the grouping name of the base station to which the base station belongs to obtain a grouping result.

Optionally, the positioning module is specifically configured to:

sorting the grouping results according to the number of the data objects contained in the grouping, and screening out a target group meeting the conditions from a group with the largest number of the data objects, wherein the target group meets the following conditions:

the Z-axis coordinate of one base station in the target group is larger than the Z-axis coordinates of other base stations;

when the Z-axis coordinates of at least three base stations in the target group are the same and the coordinates of any one of the three base stations is taken as an origin, the slope of a connecting line of coordinate points of the other two base stations is within a preset range;

and calculating the three-dimensional coordinates corresponding to the target label according to the coordinates of the four base stations selected from the target group to obtain a positioning result.

Optionally, calculating a three-dimensional coordinate corresponding to the target tag according to the coordinates of the four base stations selected from the target group to obtain a positioning result, where the method includes:

determining the X-axis coordinate and the Y-axis coordinate of the target label by combining a trilateration algorithm according to the three-dimensional coordinates of three base stations with the same Z-axis coordinate;

and determining the Z-axis coordinate of the target label according to the three-dimensional coordinate of a base station with different Z-axis coordinates and the X-axis coordinate and the Y-axis coordinate of the target label.

Compared with the prior art, the invention has the following beneficial effects:

the TOF three-dimensional positioning method and the TOF three-dimensional positioning system based on multi-base-station slope screening can filter most of positioning data which do not meet the calculation requirements, reduce the data amount processed by the system, accelerate the operation speed of a positioning algorithm, greatly reduce the error rate of the filtered data and improve the positioning accuracy of labels in a three-dimensional space.

Drawings

Other features, objects and advantages of the invention will become more apparent upon reading of the detailed description of non-limiting embodiments with reference to the following drawings:

fig. 1 is a schematic flowchart of a TOF three-dimensional positioning method based on multi-base-station slope screening according to an embodiment of the present invention;

FIG. 2 is a schematic diagram illustrating the determination of X-axis coordinates and Z-axis coordinates of a target tag according to an embodiment of the present invention;

fig. 3 is a schematic diagram illustrating the principle of determining the Z-axis coordinate of the target tag in the embodiment of the present invention.

Detailed Description

The present invention will be described in detail with reference to specific examples. The following examples will assist those skilled in the art in further understanding the invention, but are not intended to limit the invention in any way. It should be noted that it would be obvious to those skilled in the art that various changes and modifications can be made without departing from the spirit of the invention. All falling within the scope of the present invention.

Fig. 1 is a schematic flowchart of a TOF three-dimensional positioning method based on multi-base-station slope screening according to an embodiment of the present invention; as shown in fig. 1, in the method in this embodiment, first, TOF positioning data and three-dimensional coordinates of base stations uploaded by all base stations are obtained, and then, the received TOF positioning data are grouped according to a group of names to which the base stations belong. For example, the data sets may be divided into a first data set, a second data set, a third data set, and the like, whether the number of data objects in the acquired data set is sufficient is determined, if so, the packet data is sorted according to the height (Z coordinate) of the base station, and three base stations located on the same plane and having slopes meeting the requirement are selected from the sorted data. And calculating the X-axis coordinate and the Y-axis coordinate of the target label based on three base stations on the same plane, and calculating the Z-axis coordinate of the target label based on one base station on different planes.

For example, fig. 2 is a schematic diagram illustrating the determination of X-axis coordinates and Z-axis coordinates of a target tag according to an embodiment of the present invention; fig. 3 is a schematic diagram illustrating the principle of determining the Z-axis coordinate of the target tag in the embodiment of the present invention. With reference to fig. 2 and fig. 3, the TOF three-dimensional positioning method based on multi-base-station slope screening provided in this embodiment may include the following steps:

step 1: and acquiring TOF positioning data of all base stations relative to the target label at the current time point and three-dimensional coordinates of all base stations.

Step 2: all TOF-positioning data about the target label is parsed and grouped.

Step 2.1: and analyzing all the TOF positioning data to obtain a data object of each base station.

Step 2.2: and grouping the analyzed data objects according to the grouping name to which the base station belongs.

And step 3: and selecting the group with the most data objects from all groups classified according to the group names of the base stations to calculate the three-dimensional coordinates of the tags (each group contains at least 4 object data).

Step 3.1: and judging whether the Z-axis coordinate of a certain base station is larger than the Z-axis coordinates of other base stations in the selected grouped data object, if so, continuing to execute the step 3.2, and otherwise, discarding the grouped data.

Step 3.2: and selecting three base stations from the plurality of base stations, wherein the Z-axis coordinates of the base stations are the same and the slope is within a reasonable range.

Step 3.2.1: the base station data objects in the same group are arranged from small to large, and the first three base station data objects are selected (it should be noted that the three base stations do not include the base station with the Z-axis coordinate higher than the Z-axis coordinates of other base stations).

Step 3.2.2: in the three base stations, a straight line is respectively drawn from one base station as an origin to two base stations at the same height, the slopes of the two straight lines are respectively calculated, and tangent values of three angles are calculated according to the slopes.

Step 3.2.3: when the calculated tangents for all three angles are within a reasonable range, step 3.2.4 is continued, otherwise the packet data is discarded.

Step 3.2.4: and solving three binary quadratic equations by using three base station data objects at the same horizontal height through a trilateration algorithm to obtain X-axis and Y-axis coordinates of the target label in a plane coordinate system.

Step 3.2.5: and solving a linear equation for the Z-axis data of the target label by using the TOF positioning data of the base station with the known Z-axis coordinate higher than that of other base stations and combining the X-axis coordinate and the Y-axis coordinate of the currently acquired target label in a plane coordinate system to obtain the Z-axis data of the target label.

Step 3.3: and determining a positioning result according to the obtained space three-dimensional coordinates of the target label.

In this embodiment, referring to fig. 2, the base station a, the base station B, and the base station C are located in the same plane, and the X-axis coordinate and the Y-axis coordinate of the tag T may be calculated according to a trilateral location algorithm and three-dimensional coordinates of the base station a, the base station B, and the base station C. Referring to fig. 3, the Z-axis coordinate of the tag T may be calculated according to the three-dimensional coordinate of the base station D and the X-axis coordinate and the Y-axis coordinate of the tag T. The base station D is not in the plane of the base stations A, B and C.

In the embodiment, most of data which do not meet the requirements are filtered by using a TOF three-dimensional positioning algorithm based on multi-base-station slope screening, so that the number of times of calculation during positioning is greatly reduced, and the running speed of a program is accelerated; the error rate of the filtered data is greatly reduced, and the positioning precision of the label in the three-dimensional space is improved.

The invention also provides a TOF three-dimensional positioning system based on multi-base-station slope screening, which comprises: the acquisition module is used for acquiring TOF positioning data of all base stations aiming at the target label at the current time point; the analysis module is used for analyzing the TOF positioning data of the target label and grouping analysis results to obtain grouping results; and the positioning module is used for selecting one group from all the groups as a target group, and calculating the three-dimensional coordinates corresponding to the target label based on the target group to obtain a positioning result.

Optionally, the obtaining module is specifically configured to: taking a label to be positioned as a target label; at the current time point, TOF positioning data which is uploaded by all base stations and aims at the target label and three-dimensional coordinates corresponding to all the base stations are received.

Optionally, the parsing module is specifically configured to: analyzing the TOF positioning data of the target label to obtain a data object of each base station; and grouping the data objects obtained by analysis according to the grouping name of the base station to which the base station belongs to obtain a grouping result.

Optionally, the positioning module is specifically configured to: sorting the grouping results according to the number of the data objects contained in the grouping, and screening out a target group meeting the conditions from a group with the largest number of the data objects, wherein the target group meets the following conditions:

the Z-axis coordinate of one base station in the target group is larger than the Z-axis coordinates of other base stations;

when the Z-axis coordinates of at least three base stations in the target group are the same and the coordinates of any one of the three base stations is taken as an origin, the slope of a connecting line of coordinate points of the other two base stations is within a preset range.

And further, calculating the three-dimensional coordinates corresponding to the target label according to the coordinates of the four base stations selected from the target group to obtain a positioning result.

Exemplarily, according to three-dimensional coordinates of three base stations with the same Z-axis coordinate, determining an X-axis coordinate and a Y-axis coordinate of a target label by combining a trilateration algorithm; and determining the Z-axis coordinate of the target label according to the three-dimensional coordinate of the base station with different Z-axis coordinates and the X-axis coordinate and the Y-axis coordinate of the target label.

It should be noted that, the steps in the TOF three-dimensional positioning method based on multi-base-station slope screening provided by the present invention can be implemented by using corresponding modules, devices, units, etc. in the TOF three-dimensional positioning system based on multi-base-station slope screening, and those skilled in the art can refer to the technical scheme of the system to implement the step flow of the method, that is, the embodiments in the system can be understood as preferred examples of the implementation method, and are not described herein again.

Those skilled in the art will appreciate that, in addition to implementing the system and its various devices provided by the present invention in purely computer readable program code means, the method steps can be fully programmed to implement the same functions by implementing the system and its various devices in the form of logic gates, switches, application specific integrated circuits, programmable logic controllers, embedded microcontrollers and the like. Therefore, the system and various devices thereof provided by the present invention can be regarded as a hardware component, and the devices included in the system and various devices thereof for realizing various functions can also be regarded as structures in the hardware component; means for performing the functions may also be regarded as structures within both software modules and hardware components for performing the methods.

The foregoing description of specific embodiments of the present invention has been presented. It is to be understood that the present invention is not limited to the specific embodiments described above, and that various changes or modifications may be made by one skilled in the art within the scope of the appended claims without departing from the spirit of the invention. The embodiments and features of the embodiments of the present application may be combined with each other arbitrarily without conflict.