CN112180322B - Method for establishing basic coordinate system of space positioning system - Google Patents

Method for establishing basic coordinate system of space positioning system Download PDF

Info

Publication number
CN112180322B
CN112180322B CN202010846313.4A CN202010846313A CN112180322B CN 112180322 B CN112180322 B CN 112180322B CN 202010846313 A CN202010846313 A CN 202010846313A CN 112180322 B CN112180322 B CN 112180322B
Authority
CN
China
Prior art keywords
coordinate system
plane
virtual
base stations
handed
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
Application number
CN202010846313.4A
Other languages
Chinese (zh)
Other versions
CN112180322A (en
Inventor
雷帅锋
戴宇辉
郭立强
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Tianjin Shanshi Robot Co ltd
Original Assignee
Tianjin Shanshi Robot Co ltd
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Tianjin Shanshi Robot Co ltd filed Critical Tianjin Shanshi Robot Co ltd
Priority to CN202010846313.4A priority Critical patent/CN112180322B/en
Publication of CN112180322A publication Critical patent/CN112180322A/en
Application granted granted Critical
Publication of CN112180322B publication Critical patent/CN112180322B/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S5/00Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations
    • G01S5/02Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations using radio waves
    • GPHYSICS
    • G06COMPUTING; CALCULATING OR COUNTING
    • G06FELECTRIC DIGITAL DATA PROCESSING
    • G06F16/00Information retrieval; Database structures therefor; File system structures therefor
    • G06F16/20Information retrieval; Database structures therefor; File system structures therefor of structured data, e.g. relational data
    • G06F16/29Geographical information databases
    • GPHYSICS
    • G06COMPUTING; CALCULATING OR COUNTING
    • G06FELECTRIC DIGITAL DATA PROCESSING
    • G06F17/00Digital computing or data processing equipment or methods, specially adapted for specific functions
    • G06F17/10Complex mathematical operations
    • G06F17/16Matrix or vector computation, e.g. matrix-matrix or matrix-vector multiplication, matrix factorization
    • GPHYSICS
    • G06COMPUTING; CALCULATING OR COUNTING
    • G06FELECTRIC DIGITAL DATA PROCESSING
    • G06F17/00Digital computing or data processing equipment or methods, specially adapted for specific functions
    • G06F17/10Complex mathematical operations
    • G06F17/18Complex mathematical operations for evaluating statistical data, e.g. average values, frequency distributions, probability functions, regression analysis

Landscapes

  • Engineering & Computer Science (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Data Mining & Analysis (AREA)
  • Theoretical Computer Science (AREA)
  • Mathematical Physics (AREA)
  • Mathematical Analysis (AREA)
  • Databases & Information Systems (AREA)
  • Pure & Applied Mathematics (AREA)
  • Mathematical Optimization (AREA)
  • Computational Mathematics (AREA)
  • General Engineering & Computer Science (AREA)
  • Algebra (AREA)
  • Remote Sensing (AREA)
  • Software Systems (AREA)
  • Evolutionary Biology (AREA)
  • Bioinformatics & Computational Biology (AREA)
  • Operations Research (AREA)
  • Probability & Statistics with Applications (AREA)
  • Bioinformatics & Cheminformatics (AREA)
  • Life Sciences & Earth Sciences (AREA)
  • Computing Systems (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Mobile Radio Communication Systems (AREA)

Abstract

A method for establishing a basic coordinate system of a space positioning system belongs to the technical field of wireless positioning, and the step of establishing the basic coordinate system is as follows: at least four non-coplanar base stations A, B, C and D are randomly installed to form a basic positioning system; establishing a left-handed space positioning system or a right-handed space positioning system; calculating the distance between every two base stations; calculating the coordinates of the base stations A, B, C and D in the virtual coordinate system; verifying the relation between the left chiral coordinate system, the right chiral coordinate system and the virtual coordinate system; determining vertical coordinate Z of D-point base station D Taking the value of (a); fitting an alpha plane under a virtual coordinate system; rotating a beta plane of the virtual coordinate system; the virtual coordinate system is translated. The invention adopts gesture recognition algorithm to realize three-dimensional space positioning, and adopts a beacon space moving method to determine the position of the base station in the reference coordinate system.

Description

Method for establishing basic coordinate system of space positioning system
Technical Field
The invention relates to the technical field of wireless positioning, in particular to a method for establishing a basic coordinate system of a space positioning system.
Background
In 'a UWB base station coordinate self-calibration method' patent applied by rho and kong lin, 2016 (application publication No. CN 106211080A), a tag is used to calibrate the position of a base station after the base station is changed, but there is no material description in the patent on how to use the tag to automatically calibrate the coordinates of the base station.
In 2017, a patent of "method for establishing coordinate systems among base stations in a positioning system" filed by zhaxing chapter and the like (application publication No. CN 106990389A), the method for establishing a coordinate system by using distances among base stations solves the problem that in the prior art, a coordinate system is established by using a measuring instrument such as a total station or a laser range finder to perform manual measurement, but has the problem that when the positioning system establishes the coordinate system, the approximate directions of the base stations need to be determined first, and positioning data cannot be normally acquired even if the non-line-of-sight distance or the directions are unclear.
In 2018, a patent of UWB system positioning base station calibration method and device applied by tian shi wei et al (application publication No. CN 109218967A) proposes that a manual measurement mode is used to measure the real coordinate value of the base station to be calibrated in the current positioning environment, and then a reference coordinate system is established.
In 2019, patent of UWB base station coordinate automatic calibration method and system based on optimization theory, applied by xu cheng et al (application publication No. CN 110290463A), proposes that a minimum UWB system is first constructed by placing base stations and labels at corresponding positions, and optimization processing is performed on the sum of residual errors of all theoretical distances and actual measured distances by using optimization theory, so as to calibrate the system.
In practical application, base stations distributed randomly need to be calibrated, and a spatial coordinate system is established as a primary condition for calibration, in a conventional calibration algorithm, the directions of the base stations need to be set manually, or coordinates need to be designated, and in this embodiment, the spatial coordinate system is established by identifying the rule of movement of a beacon in a space.
Therefore, the research on the method for establishing the coordinate system and measuring the position of the base station with low labor cost and high accuracy is a problem that needs to be solved by researchers in the field.
Disclosure of Invention
The invention provides a method for establishing a basic coordinate system of a space positioning system by establishing a 3D positioning system reference coordinate system chirality identification and calibration method and adopting a positioning beacon to do special motion in a positioning system signal coverage range so as to determine the chirality of a positioning system and the relative coordinate of each base station, so that a third-party device is not needed to be used for measuring the coordinates of the base stations when the base stations are installed.
In order to achieve the purpose, the invention adopts the following technical scheme:
a method for establishing a basic coordinate system of a space positioning system comprises the following steps:
at least four non-coplanar base stations A, B, C and D are randomly installed to form a basic positioning system;
establishing a left-handed space positioning system or a right-handed space positioning system;
calculating the distance between every two base stations;
calculating the coordinates of the base stations A, B, C and D in the virtual coordinate system;
verifying the relation between the left chiral coordinate system, the right chiral coordinate system and the virtual coordinate system;
determining vertical coordinate Z of D-point base station D Taking the value of (A);
fitting an alpha plane under a virtual coordinate system;
rotating a beta plane of the virtual coordinate system;
the virtual coordinate system is translated.
Further, the condition of local area distribution density of the distributed local positioning base stations is met, four non-coplanar base stations are randomly installed, and the signal coverage areas of the four base stations have a public signal area.
Furthermore, a vector formed by the base station A and the base station C by taking the base station A as a coordinate origin
Figure GDA0003907897700000031
For the X-axis, with reference to the X-axis, the Y-axis is established in a plane ABC, the Z-axis pointing to the location of the base station DAnd (5) establishing a right chiral space coordinate system in the vertical direction.
Furthermore, a vector formed by the base station A and the base station B by taking the base station A as a coordinate origin
Figure GDA0003907897700000032
And establishing a Y axis in a plane ABC by taking the X axis as a reference, and establishing a left-handed space coordinate system by pointing a Z axis in the vertical direction of the position of the base station D.
Further, the right chiral coordinate system and the virtual coordinate system are established in the same direction.
Further, the distance between every two base stations is obtained by measuring the base stations in the basic positioning system and averaging.
Further, the virtual coordinate system is a mirror image of the left-handed coordinate system, and the virtual coordinate system is consistent with the right-handed coordinate system.
Further, fitting an alpha plane under a virtual coordinate system, wherein a unitized normal vector corresponding to the alpha plane is N.
Further, when the coordinate measured in the virtual coordinate system is β, the coordinate α in the new reference coordinate system is represented as α = R β.
Further, the mathematical expression of translation followed by rotation is α = R (β + e) 1 ) The mathematical expression of rotation before translation is alpha = R beta + e 2
The invention has the following beneficial effects for the prior art:
according to the invention, a left-handed space coordinate system and a right-handed space coordinate system are adopted, and the coordinates of four basic base stations can be obtained by simultaneously calculating the distance measurement characteristics of the system, so that three-dimensional space positioning is realized; determining the position of a base station in a reference coordinate system by adopting a method that a beacon moves in a space with UWB positioning technology; the relative position of the beacon moving plane and the plane where the virtual coordinate system is located is adjusted, so that control and measurement are facilitated. The algorithm is insensitive to the installation position of the UWB positioning base station, the installation and debugging efficiency can be improved, the algorithm complexity is low, and the real-time performance can be ensured; the invention has the advantages of high efficiency, random installation and deployment of the positioning base station and easy realization.
Drawings
In order to more clearly illustrate the embodiments of the present invention or the technical solutions in the prior art, the drawings used in the embodiments or the prior art descriptions will be briefly described below, and it is obvious that the drawings in the following description are some embodiments of the present invention, and other drawings can be obtained by those skilled in the art without creative efforts.
FIG. 1 is a schematic diagram of a right-handed spatial coordinate system according to the present invention;
FIG. 2 is a schematic diagram of the left-handed spatial coordinate system of the present invention;
FIG. 3 is a schematic diagram of a point in a right-handed chiral coordinate system of the present invention coinciding with a virtual mapping point;
FIG. 4 is a schematic diagram of a point in a left-handed coordinate system and a virtual mapping point in a mirror image according to the present invention;
FIG. 5 is a schematic view of the invention with the alpha plane perpendicular to the vertical;
fig. 6 is a schematic view of the invention with the beta plane perpendicular to the vertical.
Detailed Description
The technical solutions of the present invention will be described clearly and completely with reference to the accompanying drawings, and it is to be understood that the described embodiments are only a part of the embodiments of the present invention, and not all of the embodiments. All other embodiments, which can be obtained by a person skilled in the art without making any creative effort based on the embodiments in the present invention, belong to the protection scope of the present invention.
In the description of the present invention, it should be noted that the terms "center", "upper", "lower", "left", "right", "vertical", "horizontal", "inner", "outer", etc. indicate orientations or positional relationships based on the orientations or positional relationships shown in the drawings, and are only for convenience of description and simplification of description, but do not indicate or imply that the device or element referred to must have a specific orientation, be constructed and operated in a specific orientation, and thus, should not be construed as limiting the present invention. Furthermore, the terms "first," "second," and "third" are used for descriptive purposes only and are not to be construed as indicating or implying relative importance.
In the description of the present invention, it should be noted that, unless otherwise explicitly specified or limited, the terms "mounted," "connected," and "connected" are to be construed broadly and may be, for example, fixedly connected, detachably connected, or integrally connected; can be mechanically or electrically connected; they may be connected directly or indirectly through intervening media, or they may be interconnected between two elements. The specific meanings of the above terms in the present invention can be understood in specific cases to those skilled in the art.
Example 1
The present embodiment is explained with reference to fig. 1 to 6: a method for establishing a basic coordinate system of a space positioning system comprises the following steps:
under the condition of meeting the local area distribution density of distributed local positioning base stations, at least four non-coplanar base stations A, B, C and D are randomly installed to form a basic positioning system, and the signal coverage areas of the four base stations have public signal areas;
the steps of establishing the left-handed space positioning system are as follows: vector formed by base station A and base station B by taking base station A as coordinate origin
Figure GDA0003907897700000063
Establishing a Y axis in a plane ABC by taking the X axis as a reference, and establishing a left-handed spatial coordinate system by taking a Z axis as a vertical direction of the position of the base station D;
the steps of establishing the right chiral space positioning system are as follows: vector formed by base station A as coordinate origin and base stations A and C
Figure GDA0003907897700000062
Establishing a Y axis in a plane ABC by taking the X axis as a reference, and establishing a right chiral space coordinate system by taking a Z axis as a vertical direction of the position of the base station D;
as a preferred scheme, the right chiral coordinate system and the virtual coordinate system are set in the same direction;
by the arrangement, the base station is randomly installed in the space, and the left-handed coordinate system and the right-handed coordinate system can be obtained due to the fact that the coordinate directions of the base station are different.
Example 2
In the embodiment described in the first embodiment, the distance between two base stations is obtained by measuring the base stations in the basic positioning system, and they are respectively expressed as
Figure GDA0003907897700000061
By setting each azimuth vector, subsequent calculation is facilitated.
Further optimized, a virtual coordinate system is established by taking the right-handed space positioning system as a standard, wherein
The coordinates of the base stations A, B, C, D are A (0, 0), B (X) B ,Y B ,0),C(b,0,0),D(X D ,Y D ,Z D ),
Wherein,
Figure GDA0003907897700000071
s represents the area of the delta ABC,
Figure GDA0003907897700000072
then the
Figure GDA0003907897700000073
V represents the volume of the triangular pyramid D-ABC
Figure GDA0003907897700000074
G=(c 2 +d 2 -e 2 ) 2
H=(b 2 +d 2 -f 2 ) 2
K=(b 2 +c 2 -a 2 ) 2
Then:
Figure GDA0003907897700000075
Figure GDA0003907897700000076
when d is 2 -Z D 2 -X D 2 >At the time of 0, the number of the first electrode,
Figure GDA0003907897700000077
d 2 -Z D 2 -X D 2 when =0, Y D =0。
With the arrangement, the specific coordinate values of the base station in the virtual coordinate system can be obtained through calculation, so as to determine the position of the base station.
Example 3
To describe the present embodiment with reference to the first to second embodiments, the positions of the actual base stations a ', B', C ', and D' in the virtual coordinate system are the length mapping between two base stations, that is, the actual base stations a ', B', C ', and D' are mapped to the lengths of two base stations
Figure GDA0003907897700000081
Figure GDA0003907897700000082
The virtual coordinate system and the coordinate system corresponding to the actual base station have mirror images or are consistent according to the mapping relation.
Preferably, when the point in the right-handed coordinate system corresponds to the virtual mapping point one by one and the positions of the points coincide, the beacon Q moves in space according to the y → x → z track, and in the virtual coordinate system, a Q 'point also moves along the y' → x '→ z' track, and the vector coordinate system formed by the movement track is the right-handed spatial coordinate system track;
furthermore, when a point in the left-handed coordinate system is mirrored from the virtual mapping point, the beacon Q moves in space along the y → x → z trajectory, and in the virtual coordinate system, a Q ' point also moves along the y ' → x ' → z ', and the corresponding y ' → x ' → z ' trajectory is the left-handed spatial coordinate system trajectory;
according to the arrangement, the left and right chiral space coordinate systems are distinguished through the difference of the motion tracks, and the difference of the chirality determines the difference of the algorithm;
the beacon Q is located at the point O at the initial moment, and the distance from the beacon Q to four points A, B, C and D is respectively L through the ranging values in the ranging system of the right chiral coordinate system A 、L B 、L C 、L D Calculating the coordinate Q 'of the beacon Q at O by a four-point space positioning method, obtaining corresponding coordinates X', Y 'and Z' of the beacon Q at X, Y and Z, and expressing the motion track obtained by a virtual coordinate system as a vector
Figure GDA0003907897700000083
According to the right-hand screw rule, vector pair
Figure GDA0003907897700000084
And
Figure GDA0003907897700000085
perform outer product operation, i.e.
Figure GDA0003907897700000086
Thereby to obtain
Figure GDA0003907897700000087
In that
Figure GDA0003907897700000088
Projection onto
Figure GDA0003907897700000089
The inner product of (a) is a positive value, which indicates that the right chiral coordinate system is consistent with the virtual coordinate system;
still further, the beacon Q is located at the point O at the initial time, and the distance from the beacon Q to four points a, B, C and D is L through the ranging values in the left-handed coordinate system ranging system A 、L B 、L C 、L D Calculating the coordinate Q 'of the beacon Q at O by a four-point space positioning method, obtaining the corresponding coordinates X', Y 'and Z' of the beacon Q at X, Y and Z, and expressing the motion track obtained from a virtual coordinate system by using a vector as
Figure GDA0003907897700000091
According to the right-hand screw rule, for the vector
Figure GDA0003907897700000092
And
Figure GDA0003907897700000093
do an outer product operation, i.e.
Figure GDA0003907897700000094
Thereby, the device
Figure GDA0003907897700000095
In that
Figure GDA0003907897700000096
Projection onto
Figure GDA0003907897700000097
The inner product of (b) is a negative value, which indicates that the left-handed coordinate system and the virtual coordinate system are mirror images;
by means of the arrangement, when the initial calculation is carried out, the right chiral coordinate system is consistent with the virtual coordinate system when the vertical coordinate of the D base station is positive, and the left chiral coordinate system is mirrored with the virtual coordinate system when the vertical coordinate of the D base station is negative, so that the actual coordinates of the base stations A, B, C and D in the virtual coordinate system can be determined.
Example 4
In the embodiment described in conjunction with the first to third embodiments, the 3D space plane expression is
Ax + By + Cz + D =0, wherein
Figure GDA0003907897700000098
A series of coordinate points (x) in the alpha plane measured by the 3D ranging type space positioning system i ,y i ,z i ),i=1,…,n,
According to the least square idea, when the square sum of the distances from all sampling points to the plane is minimum, the corresponding plane is the plane to be solved, assuming that the minimum value is f,
namely, it is
Figure GDA0003907897700000099
Figure GDA00039078977000000910
Order to
Figure GDA0003907897700000101
To obtain
Figure GDA0003907897700000102
Order to
Figure GDA0003907897700000103
By bringing formula (4.2) into formula (4.1)
Figure GDA0003907897700000104
The formula (4.3) is a quadratic form with respect to the vectors (A, B, C),
namely, it is
Figure GDA0003907897700000105
Order to
Figure GDA0003907897700000111
Figure GDA0003907897700000112
Get f = N' PN
For | | | N' | =1, P is a quadratic form f of a real symmetric matrix, when f obtains the minimum value, the value of the vector N is the eigenvector corresponding to the minimum eigenvalue of the matrix P, a plane can be fitted according to the acquired data, and the unitized normal vector corresponding to the plane is N; thus, the solution of the alpha plane is completed.
Example 5
To describe the present embodiment with reference to the first to fourth embodiments, the method for rotating the β plane of the virtual coordinate system includes the following specific steps:
in the virtual coordinate system, assume that a normal vector M = (0, 1) of the β plane, a normal vector of the α plane is N in the virtual coordinate system, and a rotation vector of the β plane to the α plane is N
K=M×N
K is a unit vector, assuming a unit rotation vector K = [ K = x ,k y ,k z ],k x 、k y 、k z Coordinate values of three axes are expressed, so that an antisymmetric array corresponding to a unit rotation vector K is obtained
Figure GDA0003907897700000113
Cosine value of rotation angle
Figure GDA0003907897700000121
According to the Rodrigues rotation algorithm, the rotation matrix from the beta plane to the alpha plane is
R=I+K′sinθ+(1-cosθ)K′ 2
The coordinate measured in the virtual coordinate system is beta, and the coordinate alpha in the new reference coordinate system is represented as
α=Rβ
Calculating to obtain the rotation angle and the rotation relation between the alpha plane and the beta plane;
preferably, the step of translating the virtual coordinate system comprises: the mathematical expression of translation first and rotation later is
α=R(β+e 1 )
Further optimization, e 1 Representing a translation vector relative to a virtual coordinate system.
Alternatively, the mathematical expression of rotation followed by translation is
α=Rβ+e 2
Further optimization, e 2 Representing a translation vector relative to the virtual coordinate system after rotation; the adjustment method may be translation first and rotation second or rotation first and translation second, with no sequential provision.
Finally, it should be noted that: the above embodiments are only used to illustrate the technical solution of the present invention, and not to limit the same; while the invention has been described in detail and with reference to the foregoing embodiments, it will be understood by those skilled in the art that: the technical solutions described in the foregoing embodiments may still be modified, or some or all of the technical features may be equivalently replaced; and the modifications or the substitutions do not make the essence of the corresponding technical solutions depart from the scope of the technical solutions of the embodiments of the present invention.

Claims (6)

1. A method for establishing a basic coordinate system of a space positioning system is characterized in that the step of establishing the basic coordinate system is as follows:
at least four non-coplanar base stations A, B, C and D are randomly installed to form a basic positioning system;
establishing a left-handed space positioning system or a right-handed space positioning system,
the establishment of the right-handed spatial localization system comprises the following steps:
taking the base station A as the origin of coordinates, the base stations A and C form a structureA vector of
Figure FDA0003920767790000011
Establishing a Y axis in a plane ABC by taking the X axis as a reference, and establishing a space coordinate system by taking a Z axis as a vertical direction of the position of the base station D;
the establishment of the left-handed spatial localization system comprises the following steps:
vector formed by base station A and base station B by taking base station A as coordinate origin
Figure FDA0003920767790000012
Establishing a Y axis in a plane ABC by taking the X axis as a reference, and establishing a space coordinate system by taking a Z axis as a vertical direction of the position of the base station D; calculating the distance between every two base stations;
calculating the coordinates of the base stations A, B, C and D in the virtual coordinate system: establishing a virtual coordinate system by taking a right chiral coordinate system as a standard, wherein the coordinates of the base stations A, B, C and D are A (0, 0) and B (X) B ,Y B ,0),C(b,0,0),D(X D ,Y D ,Z D );
The positions of the actual base stations A ', B', C 'and D' in the virtual coordinate system are the mapping of the lengths between every two base stations, i.e. the mapping is carried out
Figure FDA0003920767790000013
Figure FDA0003920767790000014
A ', B', C ', D' are respectively mapped with A, B, C and D, and the virtual coordinate system and the coordinate system corresponding to the actual base station have mirror images or are consistent according to the mapping relation;
verifying the relation between the left-handed coordinate system, the right-handed coordinate system and the virtual coordinate system: when the point in the right-handed coordinate system corresponds to the virtual mapping point one by one and the positions are consistent, the beacon Q is moved in the space according to the y → x → z track, in the virtual coordinate system, a point Q 'also moves along the y' → x '→ z', and the vector coordinate system formed by the moving track is the right-handed space coordinate system track;
the beacon Q is located at the point O at the initial moment, and the distance from the beacon Q to the four points A, B, C and D is respectively L through the ranging values in the ranging system of the right chiral coordinate system A 、L B 、L C 、L D Calculating the coordinate Q 'of the beacon Q at O by a four-point space positioning method, obtaining the corresponding coordinates X', Y 'and Z' of the beacon Q at X, Y and Z, and expressing the motion track obtained from a virtual coordinate system by using a vector as
Figure FDA0003920767790000021
For vector
Figure FDA0003920767790000022
And
Figure FDA0003920767790000023
do an outer product operation, i.e.
Figure FDA0003920767790000024
Thereby to obtain
Figure FDA0003920767790000025
In that
Figure FDA00039207677900000213
Projection onto
Figure FDA00039207677900000212
The inner product of (b) is a positive value, which indicates that the right chiral coordinate system is consistent with the virtual coordinate system;
when the point in the left-handed coordinate system is mirrored with the virtual mapping point, the beacon Q moves in space and moves according to the y → x → z trajectory, and in the virtual coordinate system, a Q ' point also moves along the y ' → x ' → z ', and the corresponding y ' → x ' → z ' movement trajectory is the left-handed spatial coordinate system trajectory;
the beacon Q at the initial moment is at the point O, and the distance measurement value in the distance measurement system of the left-handed coordinate system is used as the beaconThe distances from the mark Q to the four points A, B, C and D are respectively L A 、L B 、L C 、L D Calculating the coordinate Q 'of the beacon Q at O by a four-point space positioning method, obtaining corresponding coordinates X', Y 'and Z' of the beacon Q at X, Y and Z, and expressing the motion track obtained by a virtual coordinate system as a vector
Figure FDA0003920767790000026
For vector
Figure FDA0003920767790000027
And
Figure FDA0003920767790000028
do an outer product operation, i.e.
Figure FDA0003920767790000029
Thereby to obtain
Figure FDA00039207677900000210
In that
Figure FDA00039207677900000214
Projection onto
Figure FDA00039207677900000211
The inner product of (a) is a negative value, which indicates that the left-handed coordinate system and the virtual coordinate system are mirror images;
determining vertical coordinate Z of D-point base station D Determining the coordinates of the actual base stations A, B, C and D in the virtual coordinate system;
fitting an alpha plane under a virtual coordinate system, wherein the alpha plane is a measuring plane of a space positioning system;
rotating a beta plane of a virtual coordinate system, wherein the beta plane is a horizontal plane of the virtual coordinate system, namely an OXY plane;
the beta plane of the virtual coordinate system is translated such that the measurement plane and the horizontal plane of the virtual coordinate system are parallel.
2. The method as claimed in claim 1, wherein four non-coplanar base stations are installed randomly to satisfy the local area distribution density of the distributed local positioning base stations, and the signal coverage of the four base stations has a common signal area.
3. The method as claimed in claim 1, wherein the distance between two base stations is obtained by measuring and averaging the base stations in the base positioning system.
4. The method of claim 1, wherein the α plane is fitted to the virtual coordinate system, and the unitary normal vector corresponding to the α plane is N.
5. The method of claim 1, wherein the horizontal plane β plane of the virtual coordinate system is rotated to be parallel to the α plane of the measurement plane of the spatial positioning system, which is represented as α = R β, and R is a rotation matrix of the β plane to the α plane.
6. The method of claim 1, wherein the mathematical expression of translation followed by rotation is α = R (β + e) 1 ) The mathematical expression of rotation followed by translation is α = R β + e 2 ,e 1 Representing translation vectors relative to a virtual coordinate system, e 2 Representing a translation vector relative to the virtual coordinate system after rotation.
CN202010846313.4A 2020-08-21 2020-08-21 Method for establishing basic coordinate system of space positioning system Active CN112180322B (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202010846313.4A CN112180322B (en) 2020-08-21 2020-08-21 Method for establishing basic coordinate system of space positioning system

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202010846313.4A CN112180322B (en) 2020-08-21 2020-08-21 Method for establishing basic coordinate system of space positioning system

Publications (2)

Publication Number Publication Date
CN112180322A CN112180322A (en) 2021-01-05
CN112180322B true CN112180322B (en) 2022-12-23

Family

ID=73924191

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202010846313.4A Active CN112180322B (en) 2020-08-21 2020-08-21 Method for establishing basic coordinate system of space positioning system

Country Status (1)

Country Link
CN (1) CN112180322B (en)

Families Citing this family (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN113286255B (en) * 2021-04-09 2023-04-14 安克创新科技股份有限公司 Ad hoc network method of positioning system based on beacon base station and storage medium
CN115999137A (en) * 2022-12-13 2023-04-25 九江古玛机电有限公司 Manufacturing method of dragon boat race electronic referee system based on wireless positioning technology

Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN103293514A (en) * 2013-05-08 2013-09-11 北京盛世光明软件股份有限公司 Self-positioning type RFID positioning system
CN104457750A (en) * 2014-11-17 2015-03-25 南京沃旭通讯科技有限公司 Emergency rescue personnel location system and emergency rescue personnel location method
CN107728615A (en) * 2017-09-26 2018-02-23 上海思岚科技有限公司 A kind of method and system of adaptive region division
CN110244263A (en) * 2019-06-06 2019-09-17 华中科技大学 A kind of robot passive location method, system and equipment
CN111007459A (en) * 2019-12-19 2020-04-14 浙江工业大学之江学院 Dynamic topology positioning method

Patent Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN103293514A (en) * 2013-05-08 2013-09-11 北京盛世光明软件股份有限公司 Self-positioning type RFID positioning system
CN104457750A (en) * 2014-11-17 2015-03-25 南京沃旭通讯科技有限公司 Emergency rescue personnel location system and emergency rescue personnel location method
CN107728615A (en) * 2017-09-26 2018-02-23 上海思岚科技有限公司 A kind of method and system of adaptive region division
CN110244263A (en) * 2019-06-06 2019-09-17 华中科技大学 A kind of robot passive location method, system and equipment
CN111007459A (en) * 2019-12-19 2020-04-14 浙江工业大学之江学院 Dynamic topology positioning method

Non-Patent Citations (3)

* Cited by examiner, † Cited by third party
Title
"A study or indoor positioning based on UWB base-station configurations";Aifeng Ren et al.;《2017 IEEE 2nd Advanced Information Technology, Electronic and Automation Control Conference(IAEAC)》;20171002;1939-1942 *
"基于UWB的室内定位算法研究";赖寒;《中国优秀博硕士学位论文全文数据库(硕士) 信息科技辑》;20200215;7-17 *
一种单基站高精度室内应急定位方法;甄杰等;《武汉大学学报(信息科学版)》;20200803;第45卷(第08期);1146-1154 *

Also Published As

Publication number Publication date
CN112180322A (en) 2021-01-05

Similar Documents

Publication Publication Date Title
CN107703499B (en) Point cloud error correction method based on self-made foundation laser radar alignment error
CN107782240B (en) Two-dimensional laser scanner calibration method, system and device
CN107883870B (en) Overall calibration method based on binocular vision system and laser tracker measuring system
CN108413988B (en) Method for quickly calibrating coordinate system of theodolite at tail end of robot
CN107290735B (en) Point cloud error correction method based on self-made foundation laser radar verticality error
CN112180322B (en) Method for establishing basic coordinate system of space positioning system
CN101655343B (en) Target, base and reference meter for calibrating spatial coordinate measuring system of electronic theodolite
CN102622747B (en) Camera parameter optimization method for vision measurement
CN104200086A (en) Wide-baseline visible light camera pose estimation method
CN109712201B (en) Positioning capability calibration device and calibration method for wide-area camera
CN104596411A (en) Cylindrical measuring device and automatic recognition algorithm
CN110246191A (en) Camera nonparametric model scaling method and stated accuracy appraisal procedure
CN115451846B (en) TLS-based large parabolic antenna caliber measuring and calculating method
CN109887041A (en) A kind of method of mechanical arm control digital camera photo centre position and posture
CN112288823A (en) Calibration method of standard cylinder curved surface point measuring equipment
CN103278095B (en) The production method of one-dimensional extension type target apparatus and feature point for calibration thereof
CN109883406A (en) Calculation method and system based on the total station outline pose less put
CN112180321B (en) Adjusting method applied to relative position of control coordinate system of 3D positioning system
Wu et al. A calibration method for spatial pose of a laser beam
CN111426304B (en) Accurate attitude positioning method based on vision, satellite positioning and GIS algorithm
CN109238246A (en) The adaptive six degree of freedom measurement method of multistation multiple spot based on complete cycle angle restriction
CN109489642B (en) Dynamic measurement method for relative attitude of two cube mirrors under any spatial attitude
CN115289999A (en) Self-calibration method of three-dimensional laser scanning system
CN112180319B (en) Space positioning system based on left and right chirality and positioning method thereof
CN111479214B (en) Wireless sensor network optimal target positioning method based on TOA measurement

Legal Events

Date Code Title Description
PB01 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination
SE01 Entry into force of request for substantive examination
GR01 Patent grant
GR01 Patent grant