Disclosure of Invention
The invention aims to overcome the defects of the prior art and provide a distance measurement verification device and a verification method based on wireless distance measurement, which can realize the pre-verification and correction of a distance measurement verification device and provide verification data for research and analysis, thereby effectively improving the distance measurement precision, reducing the cost and improving the efficiency.
The invention provides a distance measurement verification device based on wireless distance measurement, which comprises high-precision distance sensing units T1-T6 which are sequentially arranged at six vertexes of a regular hexagonal frame with side length a, wherein the position coordinates of the six vertexes are known and are respectively marked as C1(x1,y1,z1), C2(x2,y2,z2),C3(x3,y3,z3),C4(x4,y4,z4),C5(x5,y5,z5),C1(x6,y6,z6);
The distance measuring device is arranged at the center position of the regular hexagonal frame, and the position coordinates of the distance measuring device are marked as O (x ', y ', z ');
the target is arranged on an extension line which passes through the center of the regular hexagon and is vertical to the plane of the regular hexagon frame, and the position coordinate is marked as M (x, y, z);
guide rails H1, H2 and H3 are respectively arranged on three diagonal lines formed by connecting opposite vertexes of the regular hexagonal frame; and the driving unit is used for driving the high-precision distance sensing units T1-T6 to move along the corresponding guide rails.
The high-precision distance sensing unit is a high-precision ultrasonic distance sensing unit or a high-precision laser distance sensing unit or a combination of the high-precision ultrasonic distance sensing unit and the high-precision laser distance sensing unit.
Wherein, the device also comprises a memory for storing measured or calculated data.
Wherein the driving unit is a stepping motor.
The invention also provides a distance measurement verification method of the distance measurement verification device based on wireless distance measurement, which sequentially comprises the following steps:
(1) initializing a distance measurement verification device based on wireless distance measurement, arranging the distance measurement device at the center position of a regular hexagon frame, and arranging a target on an extension line which passes through the center of the regular hexagon and is vertical to the plane of the regular hexagon frame;
(2) the high-precision distance sensing units T1, T3 and T5 are divided into a first group, T2, T4 and T6 are a second group, and the first group of high-precision distance sensing units respectively measure the linear distances L from the high-precision distance sensing units T1, T3 and T5 to the target through a TOA method11,L31, L51The second group of high-precision distance sensing units respectively measure the linear distances L from the high-precision distance sensing units T2, T4 and T6 to the target by the RSSI method21,L41,L61;
By the formula
Respectively obtaining the distances D from the central positions to the targets
11,D
21,D
31,D
41,D
51,D
61Wherein i is the number of the corresponding high-precision distance sensing unit;
separately determine D11And D41,D21And D51,D31And D61Average value D of1,D2,D3As a first set of measurement data;
(3) the high-precision distance sensing units T1, T2 and T3 are divided into a third group, the T4, T5 and T6 are a fourth group, and the third group of high-precision distance sensing units respectively measure the linear distances L from the high-precision distance sensing units T1, T2 and T3 to the target through a TOA method
12,L
22, L
32And the fourth group of high-precision distance sensing units respectively measure the linear distances L from the high-precision distance sensing units T4, T5 and T6 to the target by an RSSI method
42,L
52,L
62By the formula
Respectively obtaining the distances D from the central positions to the targets
12,D
22,D
32,D
42, D
52,D
62Separately calculating D
12,D
22And D
32,D
42,D
52And D
62Average value D of
4,D
5As a second set of measurement data;
(4) driving the high-precision distance sensing units T1-T6 to move a fixed distance c along the corresponding guide rails by using a driving unit, wherein the distance from the centers of the high-precision distance sensing units T1-T6 is b;
(5) the high-precision distance sensing units T1, T3 and T5 are divided into a first group, T2, T4 and T6 are a second group, and the first group of high-precision distance sensing units respectively measure the linear distances L from the high-precision distance sensing units T1, T3 and T5 to the target through a TOA method13,L33, L53The second group of high-precision distance sensing units respectively measure the linear distances L from the high-precision distance sensing units T2, T4 and T6 to the target by the RSSI method23,L43,L63;
By the formula
Respectively obtaining the distances D from the central positions to the targets
13,D
23,D
33,D
43,D
53,D
63Wherein i is the number of the corresponding high-precision distance sensing unit;
separately determine D13And D43,D23And D53,D33And D63Average value D of7,D8,D9As a third set of measurement data;
(6) the high-precision distance sensing units T1, T2 and T3 are divided into a third group, the high-precision distance sensing units T4, T5 and T6 are a fourth group, and the third group of high-precision distance sensing units respectively measure the linear distances L from the high-precision distance sensing units T1, T2 and T3 to the
target 2 through a TOA method
14, L
24,L
34The fourth group of high-precision distance sensing units respectively measure the linear distances L from the high-precision distance sensing units T4, T5 and T6 to the
target 2 by the RSSI method
44,L
54,L
64By the formula
Respectively obtaining the distances D from the central positions to the targets
14,D
24, D
34,D
44,D
54,D
64Separately calculating D
14,D
24And D
34,D
44,D
54And D
64Average value D of
10,D
11As a fourth set of measurement data;
(7) using the coordinates C at the positions of the high-precision distance sensing units T1, T3, T51(x1,y1,z1),C3(x3,y3,z3),C5(x5, y5,z5) And a linear distance L to the target11,L31,L51The position coordinate M1 (x) of the object is calculated11,y11,z11) And then the coordinates C at the positions of the high-precision distance sensing units T2, T4 and T6 are utilized2(x2,y2,z2),C4(x4,y4,z4),C6(x6,y6,z6) And a linear distance L to the target21,L41,L61The position coordinate M2 (x) of the object is calculated22,y22,z22);
(8) Mixing M1 (x)11,y11,z11) And M2 (x)22,y22,z22) Averaging the corresponding coordinates to obtain a position coordinate M (x, y, z) of the target;
using the known coordinates C of the high-precision distance sensing units T1 and T41(x1,y1,z1) And C4(x4,y4,z4) Calculating to obtain a position coordinate O (x ', y ', z ') of the distance measuring device;
the calculated distance D is obtained from a distance formula using the position coordinates M (x, y, z) of the target and the position coordinates O (x ', y ', z ') of the distance measuring device O6As a fifth set of measurement data;
(9) the distance D from the target to the distance measuring device is obtained through measurement of the distance measuring device, whether the error meets a preset threshold value or not is judged, if the error is larger than or equal to the threshold value, the distance measuring device is considered to be inaccurate in measurement and not meet the distance measuring requirement, and if the error is smaller than the threshold value, the distance measuring device is considered to be accurate in measurement and meets the distance measuring requirement.
The specific method for the ranging device to measure the distance D to the target is a TOA method or an RSSI method.
The specific method for judging whether the error meets the preset threshold value is to calculate the error rate W1And W2Whether a preset threshold is met:
if the error rate W1And W2And if one of the threshold values is not met or the preset threshold value is not met, the distance measuring device is not accurate and the distance measuring requirement is not met.
Wherein the threshold is 0.01.
Wherein, the method also comprises a step (10) of converting D11,D21,D31,D41,D51,D61,D12,D22,D32,D42,D52,D62,D13,D23,D33,D43,D53,D63,D14,D24,D34,D44,D54,D64And storing the first, second, third, fourth and fifth groups of measurement data.
The distance measurement verification device and the distance measurement verification method based on wireless distance measurement can realize that:
1) the distance measurement verification device can be verified and corrected in advance, and verification data is provided for research and analysis;
2) the distance measurement precision is effectively improved, the cost is reduced, and the efficiency is improved;
3) the distance data can be obtained in various ways, the measurement data are rich, and the measurement data can be stored for research and analysis;
4) the device has simple structure, and utilizes various mathematical models to calculate, the mode is simple, and the efficiency is high;
5) the position of the high-precision distance sensing unit is variable by utilizing the track, so that the verification environment is effectively and regularly changed, certain randomness is achieved, and the verification accuracy is improved.
Detailed Description
Reference will now be made in detail to the embodiments of the present invention, the following examples of which are intended to be illustrative only and are not to be construed as limiting the scope of the invention.
The invention provides a distance measurement verification device 1 based on wireless distance measurement, as shown in figures 1 and 2, the distance measurement verification device 1 based on wireless distance measurement is used for measuring the distance of a target 2, so that the accuracy verification of a distance measurement sensing device positioned at an O point is realized, the distance measurement sensing device is corrected immediately, the measured data is subjected to big data processing and storage, the measured data for research and analysis is provided, and the distance measurement precision is effectively improved.
As shown in FIG. 2, the distance measurement verification apparatus 1 based on wireless distance measurement includes high-precision distance sensing units T1-T6 arranged in sequence at six vertexes of a regular hexagonal frame with a side length of a, wherein the position coordinates of the six vertexes are known and are respectively marked as C1(x1,y1,z1),C2(x2, y2,z2),C3(x3,y3,z3),C4(x4,y4,z4),C5(x5,y5,z5),C1(x6,y6,z6) The distance measuring device O is positioned at the center of the regular hexagonal frame and is marked as O (x ', y ', z '), the target 2 is arranged on an extension line which passes through the center of the regular hexagonal frame and is vertical to the plane of the regular hexagonal frame, and the position coordinate is marked as M (x, y, z); on three diagonal lines formed by connecting lines of opposite vertices of the regular hexagonal frame, guide rails 3, which are respectively denoted as H1, H2, and H3, are provided, wherein the high-precision distance sensing units T1-T6 can be driven to move along the corresponding guide rails by a driving unit, preferably a stepping motor.
Firstly, dividing the high-precision distance sensing units T1, T3 and T5 into a first group, and dividing the high-precision distance sensing units T2, T4 and T6 into a second group, wherein the first group of high-precision distance sensing units respectively measure the linear distances L from the high-precision distance sensing units T1, T3 and T5 to a target by a TOA method
11,L
31, L
51The second group of high-precision distance sensing units respectively measure the linear distances L from the high-precision distance sensing units T2, T4 and T6 to the target by the RSSI method
21,L
41,L
61By the formula
Respectively obtaining the distances D from the central positions to the
targets 2
11,D
21,D
31, D
41,D
51,D
61And i is the number corresponding to the high-precision distance sensing unit. Since the data of two distance sensing units on the same straight line have symmetry, D is obtained separately
11And D
41,D
21And D
51,D
31And D
61Average value D of
1,D
2,D
3As a first set of measurement data.
Secondly, the regular hexagon has space symmetry, namely T1, T2, T3 and T4, T5 and T6 are symmetrical, so that the high-precision distanceThe distance sensing units T1, T2 and T3 are divided into a third group, the distance sensing units T4, T5 and T6 are divided into a fourth group, and the third group of high-precision distance sensing units respectively measure the linear distances L from the high-precision distance sensing units T1, T2 and T3 to the
target 2 by a TOA method
12,L
22,L
32The fourth group of high-precision distance sensing units respectively measure the linear distances L from the high-precision distance sensing units T4, T5 and T6 to the
target 2 by the RSSI method
42,L
52,L
62By the formula
Respectively obtaining the distances D from the central positions to the
targets 2
12,D
22,D
32,D
42,D
52,D
62Separately calculating D
12,D
22And D
32,D
42,D
52And D
62Average value D of
4,D
5As a second set of measurement data.
Generally, the device will generate errors due to various factors, and these errors are not easy to be found if they are a relatively stable value, so for better verification, the structure of the ranging verification device can be changed, so that it has a certain randomness, which is helpful for data verification. Therefore, the invention is provided with the guide rails H1, H2 and H3 which are respectively arranged on three diagonal lines formed by connecting lines of opposite vertexes of the regular hexagonal frame, and the positions of the high-precision distance sensing units T1-T6 are changed to realize the transformation of the verification environment, thereby improving the verification precision. Specifically, the driving unit is used to drive the high-precision distance sensing units T1-T6 to move along the corresponding guide rails, and if the high-precision distance sensing units T1-T6 move along the corresponding guide rails by a fixed distance c, the properties of the regular hexagon are still used, so that the distances from the centers of the high-precision distance sensing units T1-T6 are b, the high-precision distance sensing units T1-T6 are still located at the vertexes of the regular hexagon with the side length of b, and the structure after the movement is as shown in fig. 2.
Then, after moving, the high-precision distance sensing units T1, T3 and T5 are still divided into the first unitsAnd the T2, the T4 and the T6 are taken as a second group, the first group of high-precision distance sensing units respectively measure the linear distances L from the high-precision distance sensing units T1, T3 and T5 to the target by the TOA method
13,L
33,L
53The second group of high-precision distance sensing units respectively measure the linear distances L from the high-precision distance sensing units T2, T4 and T6 to the target by the RSSI method
23,L
43,L
63By the formula
Respectively obtaining the distances D from the central positions to the
targets 2
13, D
23,D
33,D
43,D
53,D
63And i is the number corresponding to the high-precision distance sensing unit. Since the data of two distance sensing units on the same straight line have symmetry, D is obtained separately
13And D
43,D
23And D
53,D
33And D
63Average value D of
7,D
8,D
9As a third set of measurement data.
Similarly, the high-precision distance sensing units T1, T2 and T3 are further divided into a third group, T4, T5 and T6 are a fourth group, and the third group of high-precision distance sensing units respectively measure the linear distances L from the high-precision distance sensing units T1, T2 and T3 to the
target 2 by the TOA method
14, L
24,L
34The fourth group of high-precision distance sensing units respectively measure the linear distances L from the high-precision distance sensing units T4, T5 and T6 to the
target 2 by the RSSI method
44,L
54,L
64By the formula
Respectively obtaining the distances D from the central positions to the
targets 2
14,D
24, D
34,D
44,D
54,D
64Separately calculating D
14,D
24And D
34,D
44,D
54And D
64Average value D of
10,D
11As a fourth set of measurement data.
Then, benefit fromWith the coordinates C at the initial positions of the high-precision distance sensing units T1, T3, T51(x1,y1,z1),C3(x3,y3, z3),C5(x5,y5,z5) And a linear distance L to the target11,L31,L51The position coordinate M1 (x) of the object is calculated11,y11,z11) And then the coordinates C at the positions of the high-precision distance sensing units T2, T4 and T6 are utilized2(x2,y2,z2),C4(x4,y4,z4),C6(x6,y6, z6) And a linear distance L to the target21,L41,L61The position coordinate M2 (x) of the object is calculated22,y22,z22) Mixing M1 (x)11,y11, z11) And M2 (x)22,y22,z22) Averaging the corresponding coordinates to obtain a position coordinate M (x, y, z) of the target; using the known coordinates C at the initial positions of the high-precision distance sensing units T1 and T41(x1,y1,z1) And C4(x4,y4,z4) Calculating to obtain the position coordinate O (x ', y', z ') of the distance measuring device O, and obtaining the calculated distance D by using the position coordinate M (x, y, z) of the target and the position coordinate O (x', y ', z') of the distance measuring device O through a distance formula6。
And finally, measuring the distance D from the target 2 by using a distance measuring device O, wherein the measuring mode is not limited and is determined according to the measuring mode of the distance measuring device O, such as a TOA mode, an RSSI mode and the like. And judging whether the error meets a preset threshold value, if the error is greater than or equal to the threshold value, considering that the distance measuring device O is inaccurate, and does not meet the distance measuring requirement, debugging and replacing can be carried out, and if the error is less than the threshold value, considering that the distance measuring device O is accurate, and meeting the distance measuring requirement. The specific method for judging whether the error meets the preset threshold value is to calculate the error rate:
if the error rate W1And W2And if one of the distance measuring devices does not meet or does not meet the preset threshold value at the same time, the distance measuring device O is considered to be inaccurate and does not meet the distance measuring requirement.
In addition, the high-precision distance sensing unit can be selected according to actual conditions in consideration of cost, performance and other factors, such as a high-precision ultrasonic distance sensing unit, a high-precision laser distance sensing unit and the like.
The invention has more measurement and calculation data for distance measurement, and after the distance measuring device is verified, the measurement and calculation data can be stored to provide theoretical data for research and analysis.
Although exemplary embodiments of the present invention have been described for illustrative purposes, those skilled in the art will appreciate that various modifications, additions, substitutions and the like can be made in form and detail without departing from the scope and spirit of the invention as disclosed in the accompanying claims, all of which are intended to fall within the scope of the claims, and that various steps in the various sections and methods of the claimed product can be combined together in any combination. Therefore, the description of the embodiments disclosed in the present invention is not intended to limit the scope of the present invention, but to describe the present invention. Accordingly, the scope of the present invention is not limited by the above embodiments, but is defined by the claims or their equivalents.