CN115575890A - Method and device for identifying electromagnetic space quadrant, storage medium and electronic equipment - Google Patents

Method and device for identifying electromagnetic space quadrant, storage medium and electronic equipment Download PDF

Info

Publication number
CN115575890A
CN115575890A CN202211568291.5A CN202211568291A CN115575890A CN 115575890 A CN115575890 A CN 115575890A CN 202211568291 A CN202211568291 A CN 202211568291A CN 115575890 A CN115575890 A CN 115575890A
Authority
CN
China
Prior art keywords
coordinate system
axis
space
tracked object
space coordinate
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.)
Pending
Application number
CN202211568291.5A
Other languages
Chinese (zh)
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.)
Quanzhou Institute of Equipment Manufacturing
Original Assignee
Quanzhou Institute of Equipment Manufacturing
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 Quanzhou Institute of Equipment Manufacturing filed Critical Quanzhou Institute of Equipment Manufacturing
Priority to CN202211568291.5A priority Critical patent/CN115575890A/en
Publication of CN115575890A publication Critical patent/CN115575890A/en
Pending legal-status Critical Current

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
    • G01S5/0257Hybrid positioning
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/20Instruments for performing navigational calculations
    • G01C21/206Instruments for performing navigational calculations specially adapted for indoor navigation

Landscapes

  • Engineering & Computer Science (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Radar Systems Or Details Thereof (AREA)

Abstract

The application relates to the technical field of electromagnetism, and discloses a method and a device for identifying electromagnetic space quadrants, a storage medium and electronic equipment. The identification method of the electromagnetic space quadrant comprises the steps of obtaining and decomposing the absolute value of a space coordinate, obtaining and converting the actual speed value of a tracked object and judging the quadrant position of the tracked object. The method comprises the steps of obtaining an actual speed value of a tracked object, carrying out one-to-one difference between the actual speed value of the tracked object and a possible speed value (formed by resolving an absolute value of a space coordinate) of a space coordinate system to obtain various difference values, and comparing the magnitude of the various difference values to judge the actual quadrant position of the tracked object. The identification method is quick and accurate, and can solve the problem of quadrant ambiguity of electromagnetic tracking.

Description

Method and device for identifying electromagnetic space quadrant, storage medium and electronic equipment
Technical Field
The present application relates to the field of electromagnetic technologies, and in particular, to a method and an apparatus for identifying an electromagnetic space quadrant, a storage medium, and an electronic device.
Background
The traditional indoor space positioning mainly depends on optical, UWB or Bluetooth and other modes for positioning. The optical positioning precision is high, the millimeter level is achieved, and the technology is mature. But are susceptible to ambient light and when object occlusion occurs, the tracked object is lost. UWB is a wireless carrier communication technology, and the device distance is measured and calculated by sending nanosecond-level non-sine wave transmission data and calculating electric wave return time based on TOF technology, the precision can reach centimeter level, and the UWB can penetrate through a sheltering object to perform space positioning. In a traditional wireless electromagnetic positioning system, due to hemisphere ambiguity and phase-locked loop ambiguity, only an absolute value of a space coordinate can be acquired, and a corresponding phase cannot be acquired. This application fuses wireless electromagnetic positioning technique and nine motion sensor mutually, can effectually remedy this defect, reaches the space quadrant discernment through multisource data fusion.
Disclosure of Invention
Additional features and advantages of the present application will be set forth in the description which follows, and in part will be obvious from the description, or may be learned by the practice of the present application. The objectives and other advantages of the application may be realized and attained by the structure particularly pointed out in the written description and drawings.
The present application aims to overcome the above disadvantages and provide a method and an apparatus for identifying electromagnetic space quadrants, a storage medium, and an electronic device.
In a first aspect, the present application provides a method for identifying quadrants in an electromagnetic space. The identification method comprises
S1, acquiring and decomposing an absolute value of a space coordinate, acquiring the absolute value of the space coordinate, and decomposing the acquired absolute value of the space coordinate into a possible speed value of a space coordinate system;
s2, acquiring and converting an actual speed value of the tracked object, acquiring the actual speed value of the tracked object and converting the acquired actual speed value of the tracked object into a speed value of a world coordinate system;
and S3, judging the quadrant position of the tracked object, namely, subtracting the speed value of the world coordinate system from the possible speed value of the space coordinate system to obtain a difference value, and comparing the difference value to judge the quadrant position of the tracked object.
In some embodiments, the velocity value is an acceleration, a linear acceleration, or an angular velocity.
In some embodiments, the possible acceleration of the spatial coordinate system is calculated by the formula:
in the x-axis, the x-axis coordinate at time t1 is x1, the x-axis coordinate at time t2 is x2, and the time interval is
Figure 154861DEST_PATH_IMAGE001
Figure 20049DEST_PATH_IMAGE002
In the y-axis, the y-axis coordinate at time t1 is y1, the y-axis coordinate at time t2 is y2, and the time interval is
Figure 627747DEST_PATH_IMAGE001
Figure 414438DEST_PATH_IMAGE003
In the z-axis, the z-axis coordinate at time t1 is z1, the z-axis coordinate at time t2 is z2, and the time interval is
Figure 664154DEST_PATH_IMAGE001
Figure 869001DEST_PATH_IMAGE004
In some embodiments, the spatial coordinate system may calculate linear acceleration according to the following formula:
in the x-axis, the x-axis coordinate at time t1 is x1, the x-axis coordinate at time t2 is x2, the x-axis coordinate at time t3 is x3, and the time interval is
Figure 647601DEST_PATH_IMAGE001
Figure 187167DEST_PATH_IMAGE005
In the y-axis, the y-axis coordinate at time t1 is y1, the y-axis coordinate at time t2 is y2, the y-axis coordinate at time t3 is y3, and the time interval is
Figure 709415DEST_PATH_IMAGE001
Figure 18037DEST_PATH_IMAGE006
In the z-axis, the z-axis coordinate at time t1 is z1, the z-axis coordinate at time t2 is z2, the z-axis coordinate at time t3 is z3, and the time interval is
Figure 482385DEST_PATH_IMAGE001
Figure 509247DEST_PATH_IMAGE007
In some embodiments, the acceleration of the world coordinate system is calculated as
Figure 835186DEST_PATH_IMAGE008
Wherein, the first and the second end of the pipe are connected with each other,
Figure 263893DEST_PATH_IMAGE009
in order for the tracked object to actually accelerate,
Figure 384296DEST_PATH_IMAGE010
a rotation matrix of euler angles or quaternions.
In some embodiments, the linear acceleration of the world coordinate system is calculated by the formula
Figure 649186DEST_PATH_IMAGE008
Wherein, the first and the second end of the pipe are connected with each other,
Figure 513237DEST_PATH_IMAGE009
in order for the tracked object to actually linearly accelerate,
Figure 62030DEST_PATH_IMAGE010
a rotation matrix of euler angles or quaternions.
In some embodiments, the angular velocity of the world coordinate system is calculated by
Figure 353334DEST_PATH_IMAGE011
Wherein, the first and the second end of the pipe are connected with each other,
Figure 89209DEST_PATH_IMAGE012
in order to be the actual angular velocity of the tracked object,
Figure 271798DEST_PATH_IMAGE010
a rotation matrix of euler angles or quaternions.
In some embodiments, the actual angular velocity of the tracked object is calculated by acquiring a quaternion of the tracked object by an electromagnetic positioning system and converting the quaternion into an euler angle, specifically:
acquisition of quaternion of tracked object by electromagnetic positioning system
Figure 409518DEST_PATH_IMAGE013
The euler angle is obtained by converting the formula,
Figure 871723DEST_PATH_IMAGE014
Figure 360473DEST_PATH_IMAGE015
Figure 831906DEST_PATH_IMAGE016
the angular velocity is calculated by means of the euler angle,
Figure 574865DEST_PATH_IMAGE017
in a second aspect, the present application provides an apparatus for identification of electromagnetic space quadrants. The identification device comprises
The acquisition module is used for acquiring an absolute value of the space coordinate and an actual speed value of the tracked object;
the processing module is used for decomposing the space coordinate absolute value into a space coordinate system possible speed value and converting the tracked object actual speed value into a world coordinate system speed value;
and the judging module is used for subtracting the world coordinate system speed value from the space coordinate system possible speed value to obtain a difference value, and comparing the difference value to judge the quadrant position of the tracked object.
In some embodiments, the processing module comprises
The decomposition unit is used for decomposing the space coordinate absolute value into a space coordinate system possible speed value;
and the conversion unit is used for converting the actual speed value of the tracked object into the speed value of the world coordinate system.
In a third aspect, the present application provides a computer storage medium storing computer-executable instructions for performing the method for identifying quadrants of an electromagnetic space as described above.
In a fourth aspect, the present application provides an electronic device comprising
At least one processor; and the number of the first and second groups,
a memory communicatively coupled to the at least one processor; wherein the content of the first and second substances,
the memory stores instructions executable by the at least one processor to enable the at least one processor to perform the method for identifying electromagnetic space quadrants as described above.
Through adopting foretell technical scheme, the beneficial effect of this application is:
the actual speed value of the tracked object is obtained, the actual speed value of the tracked object is subjected to difference with the possible speed value (formed by decomposition of the absolute value of the space coordinate) of the space coordinate system one by one, all difference values are obtained, and then the magnitude of each difference value is compared to judge the actual quadrant position of the tracked object. The identification method is quick and accurate, and can solve the problem of quadrant ambiguity of electromagnetic tracking.
It is to be understood that both the foregoing general description and the following detailed description are exemplary and explanatory only and are not restrictive of the disclosure.
Clearly, such objects and other objects of the present application will become more apparent after a detailed description of the preferred embodiments thereof as illustrated in the various figures and drawings.
These and other objects, features and advantages of the present application will become more apparent from the following detailed description of one or more preferred embodiments, which is to be read in connection with the accompanying drawings.
Drawings
The accompanying drawings, which are included to provide a further understanding of the application and are incorporated in and constitute a part of this specification, illustrate embodiments of the application and together with the description serve to explain the principles of the application and not to limit the application.
In the drawings, like parts are designated with like reference numerals, and the drawings are schematic and not necessarily drawn to scale.
In order to more clearly illustrate the embodiments of the present application or the technical solutions in the prior art, the drawings needed to be used in the description of the embodiments or the prior art will be briefly described below, it is obvious that the drawings in the following description are only one or several embodiments of the present application, and other drawings can be obtained by those skilled in the art without creative efforts.
FIG. 1 is a flow chart of a method for identification of electromagnetic space quadrants according to some embodiments of the present application;
FIG. 2 is a flowchart of a method for identifying quadrants in an electromagnetic space according to embodiment 1 of the present application;
FIG. 3 is a flowchart of a method for identifying quadrants in an electromagnetic space according to embodiment 2 of the present application;
FIG. 4 is a flowchart of a method for identifying quadrants in an electromagnetic space according to embodiment 3 of the present application;
FIG. 5 is a block diagram of an identification device of electromagnetic space quadrants according to some embodiments of the present application.
Detailed Description
In order to make the objects, technical solutions and advantages of the present application more apparent, the present application is further described in detail with reference to the following detailed description. It should be understood that the detailed description and specific examples, while indicating the present application, are given by way of illustration only.
In addition, in the description of the present application, it is to be understood that the terms "center", "upper", "lower", "front", "rear", "left", "right", "vertical", "horizontal", "top", "bottom", "inner", "outer", "axial", "radial", "circumferential", and the like, indicate orientations and positional relationships based on those shown in the drawings, are only for convenience of description and simplicity of description, and do not indicate or imply that the referenced devices or elements must have a particular orientation, be constructed and operated in a particular orientation, and thus, are not to be construed as limiting the present application.
In this application, unless expressly stated or limited otherwise, the terms "mounted," "connected," "secured," and the like are to be construed broadly and can include, for example, fixed connections, removable connections, or integral parts; either directly or indirectly through intervening media, either internally or in any other relationship. However, the direct connection means that the two bodies are not connected through a transition structure, but are connected through a connection structure to form a whole. The specific meaning of the above terms in the present application can be understood by those of ordinary skill in the art as appropriate.
In this application, unless expressly stated or limited otherwise, a first feature is "on" or "under" a second feature such that the first and second features are in direct contact, or the first and second features are in indirect contact via an intermediary. In the description herein, reference to the description of the term "one embodiment," "some embodiments," "an example," "a specific example," or "some examples," etc., means that a particular feature, structure, material, or characteristic described in connection with the embodiment or example is included in at least one embodiment or example of the application. In this specification, the schematic representations of the terms used above are not necessarily intended to refer to the same embodiment or example. Furthermore, the particular features, structures, materials, or characteristics described may be combined in any suitable manner in any one or more embodiments or examples.
Referring to fig. 1, fig. 1 is a flow chart of a method for identifying electromagnetic space quadrants according to some embodiments of the present application.
According to some embodiments of the present application, a method of identification of electromagnetic space quadrants is provided. The identification method comprises the following steps:
s1, acquiring and decomposing absolute value of space coordinate
The method comprises the steps of receiving wireless alternating electromagnetic waves by transmitting the wireless alternating electromagnetic waves, and calculating and acquiring an absolute value of a space coordinate through the change of electromagnetic signals; and decomposing the acquired absolute value of the space coordinate into possible velocity values of the space coordinate system.
S2, acquiring and converting actual speed value of tracked object
Acquiring an actual speed value of a tracked object by a nine-axis motion sensor (the nine-axis motion sensor is installed in the tracked object); and converting the obtained actual speed value of the tracked object into a world coordinate system speed value.
S3, judging quadrant position of tracked object
And (3) subtracting the world coordinate system speed value from the possible space coordinate system speed value to obtain a difference value, and comparing the obtained difference value to judge the quadrant position of the tracked object.
Therein, a spaceThe absolute value of the coordinate is (# |)
Figure 473551DEST_PATH_IMAGE018
|,
Figure 184018DEST_PATH_IMAGE019
Figure 459142DEST_PATH_IMAGE020
). The possible velocity values of the space coordinate system may be (
Figure 305875DEST_PATH_IMAGE018
Figure 624730DEST_PATH_IMAGE021
Figure 822493DEST_PATH_IMAGE022
)、(
Figure 635728DEST_PATH_IMAGE018
Figure 336968DEST_PATH_IMAGE023
Figure 843036DEST_PATH_IMAGE022
)、(
Figure 13248DEST_PATH_IMAGE018
Figure 630174DEST_PATH_IMAGE021
Figure 451500DEST_PATH_IMAGE024
)、(
Figure 862889DEST_PATH_IMAGE018
,-
Figure 35245DEST_PATH_IMAGE021
Figure 439550DEST_PATH_IMAGE024
)、(
Figure 380961DEST_PATH_IMAGE025
Figure 963252DEST_PATH_IMAGE021
Figure 622904DEST_PATH_IMAGE022
)、(
Figure 316053DEST_PATH_IMAGE025
Figure 128283DEST_PATH_IMAGE023
Figure 615896DEST_PATH_IMAGE022
)、(
Figure 497264DEST_PATH_IMAGE025
Figure 259684DEST_PATH_IMAGE021
Figure 910108DEST_PATH_IMAGE024
)、(
Figure 349048DEST_PATH_IMAGE025
Figure 452134DEST_PATH_IMAGE023
Figure 487086DEST_PATH_IMAGE024
)。
According to some embodiments of the application, optionally, the velocity value is an acceleration, a linear acceleration or an angular velocity. Specifically, the spatial coordinate system possible velocity value includes, but is not limited to, a spatial coordinate system possible acceleration, a spatial coordinate system possible linear acceleration, or a spatial coordinate system possible angular velocity; the tracked object actual speed value includes, but is not limited to, a tracked object actual acceleration, a tracked object actual linear acceleration or a tracked object actual angular velocity; the world coordinate system velocity value includes, but is not limited to, a world coordinate system acceleration, a world coordinate system linear acceleration, or a world coordinate system angular velocity.
According to some embodiments of the application, optionally, the calculation formula of the possible acceleration of the spatial coordinate system is:
in the x-axis, the x-axis coordinate at time t1 is x1, the x-axis coordinate at time t2 is x2, and the time interval is
Figure 257596DEST_PATH_IMAGE001
Figure 618170DEST_PATH_IMAGE002
When the space coordinate system has possible acceleration of
Figure 959284DEST_PATH_IMAGE026
Then the x-axis is positive; when the space coordinate system has possible acceleration of
Figure 797927DEST_PATH_IMAGE027
Then the x-axis is negative.
In the y-axis, the y-axis coordinate at time t1 is y1, the y-axis coordinate at time t2 is y2, and the time interval is
Figure 422943DEST_PATH_IMAGE001
Figure 688839DEST_PATH_IMAGE003
When the space coordinate system has possible acceleration of
Figure 281364DEST_PATH_IMAGE028
When so, then the y-axis is positive; when the space coordinate system has possible acceleration of
Figure 658118DEST_PATH_IMAGE029
Then the y-axis is negative.
In the z-axis, the z-axis coordinate at time t1 is z1, the z-axis coordinate at time t2 is z2, and the time interval is
Figure 137641DEST_PATH_IMAGE001
Figure 574439DEST_PATH_IMAGE004
When the space coordinate system has possible acceleration of
Figure 404991DEST_PATH_IMAGE030
If so, then the z-axis is positive; when the space coordinate system has possible acceleration of
Figure 324451DEST_PATH_IMAGE031
Then the z-axis is negative.
According to some embodiments of the application, optionally, the spatial coordinate system may calculate the linear acceleration according to the following formula:
in the x-axis, the x-axis coordinate at time t1 is x1, the x-axis coordinate at time t2 is x2, the x-axis coordinate at time t3 is x3, and the time interval is
Figure 658480DEST_PATH_IMAGE001
Figure 531758DEST_PATH_IMAGE005
Possible linear acceleration in a space coordinate system is
Figure 584028DEST_PATH_IMAGE032
Then the x-axis is positive; possible linear acceleration in a space coordinate system is
Figure 817432DEST_PATH_IMAGE033
Then the x-axis is negative.
In the y-axis, the y-axis coordinate at time t1 is y1, the y-axis coordinate at time t2 is y2, and the y-axis coordinate at time t3 is yCoordinate y3, time interval of
Figure 5968DEST_PATH_IMAGE001
Figure 784568DEST_PATH_IMAGE006
Possible linear acceleration in a space coordinate system is
Figure 589713DEST_PATH_IMAGE034
When so, then the y-axis is positive; possible linear acceleration in a space coordinate system is
Figure 111961DEST_PATH_IMAGE035
The y-axis is negative.
In the z-axis, the z-axis coordinate at time t1 is z1, the z-axis coordinate at time t2 is z2, the z-axis coordinate at time t3 is z3, and the time interval is
Figure 171315DEST_PATH_IMAGE001
Figure 386396DEST_PATH_IMAGE007
Possible linear acceleration in a space coordinate system is
Figure 413258DEST_PATH_IMAGE036
If so, then the z-axis is positive; possible linear acceleration in a space coordinate system of
Figure 473618DEST_PATH_IMAGE037
Then the z-axis is negative.
According to some embodiments of the application, optionally, the world coordinate system acceleration is calculated as
Figure 886013DEST_PATH_IMAGE008
Wherein the content of the first and second substances,
Figure 271995DEST_PATH_IMAGE009
in order for the tracked object to actually accelerate,
Figure 786153DEST_PATH_IMAGE010
a rotation matrix of euler angles or quaternions.
According to some embodiments of the application, optionally, the linear acceleration of the world coordinate system is calculated by
Figure 650204DEST_PATH_IMAGE008
Wherein the content of the first and second substances,
Figure 198997DEST_PATH_IMAGE009
in order for the tracked object to actually linearly accelerate,
Figure 241033DEST_PATH_IMAGE010
a rotation matrix of euler angles or quaternions.
According to some embodiments of the application, optionally, the calculation formula of the world coordinate system angular velocity is
Figure 976908DEST_PATH_IMAGE011
Wherein, the first and the second end of the pipe are connected with each other,
Figure 644650DEST_PATH_IMAGE012
in order for the actual angular velocity of the tracked object,
Figure 47949DEST_PATH_IMAGE010
a rotation matrix of euler angles or quaternions.
According to some embodiments of the present application, optionally, the actual angular velocity of the tracked object is calculated by acquiring a quaternion of the tracked object by an electromagnetic positioning system and converting the quaternion into an euler angle, specifically:
acquisition of quaternion of tracked object by electromagnetic positioning system
Figure 510155DEST_PATH_IMAGE013
The euler angle is obtained by converting the formula,
Figure 248173DEST_PATH_IMAGE014
Figure 454026DEST_PATH_IMAGE015
Figure 446253DEST_PATH_IMAGE016
the angular velocity is calculated by the euler angle,
Figure 344939DEST_PATH_IMAGE017
referring to FIG. 5, FIG. 5 is a block diagram of an identification device of electromagnetic space quadrants according to some embodiments of the present application.
According to some embodiments of the present application, there is provided an apparatus for identification of electromagnetic space quadrants. The identification device comprises
The acquisition module is used for acquiring an absolute value of the space coordinate and an actual speed value of the tracked object;
the processing module is used for decomposing the space coordinate absolute value into a space coordinate system possible speed value and converting the tracked object actual speed value into a world coordinate system speed value;
and the judging module is used for subtracting the world coordinate system speed value from the space coordinate system possible speed value to obtain a difference value, and comparing the difference value to judge the quadrant position of the tracked object.
According to some embodiments of the present application, optionally, the processing module comprises a decomposition unit and a conversion unit. The decomposition unit is used for decomposing the absolute value of the space coordinate into possible speed values of a space coordinate system; the conversion unit is used for converting the actual speed value of the tracked object into a world coordinate system speed value.
According to some embodiments of the present application, the spatial coordinate system possible velocity values optionally include, but are not limited to, spatial coordinate system possible acceleration, spatial coordinate system possible linear acceleration, or spatial coordinate system possible angular velocity.
According to some embodiments of the present application, optionally, the tracked object actual velocity value includes, but is not limited to, a tracked object actual acceleration, a tracked object actual linear acceleration, or a tracked object actual angular velocity.
According to some embodiments of the present application, optionally, the world coordinate system velocity value includes, but is not limited to, a world coordinate system acceleration, a world coordinate system linear acceleration, or a world coordinate system angular velocity.
According to some embodiments of the present application, a computer storage medium is provided. The computer storage medium stores computer-executable instructions for performing the above-described method for identification of electromagnetic space quadrants.
According to some embodiments of the present application, an electronic device is provided. The electronic device includes at least one processor and a memory communicatively coupled to the at least one processor. Wherein the memory stores instructions executable by the at least one processor to enable the at least one processor to perform the method for identification of electromagnetic space quadrants as described above.
Example 1
Referring to fig. 2, fig. 2 is a flowchart of an identification method of an electromagnetic space quadrant according to embodiment 1 of the present application.
The embodiment provides an identification method of an electromagnetic space quadrant. The identification method comprises the following steps:
s1, acquiring and decomposing absolute value of space coordinate
Calculating and acquiring absolute value of space coordinate (counting through transmission of wireless alternating electromagnetic wave, reception of wireless alternating electromagnetic wave, change of electromagnetic signal
Figure 320985DEST_PATH_IMAGE018
|,
Figure 815682DEST_PATH_IMAGE019
Figure 193574DEST_PATH_IMAGE020
) (ii) a Then the obtained space coordinate absolute value (& gtY & lt)
Figure 997582DEST_PATH_IMAGE018
|,
Figure 195345DEST_PATH_IMAGE019
Figure 8580DEST_PATH_IMAGE020
) Decomposing the acceleration into possible acceleration of the space coordinate system, and determining the space coordinate system according to the possible acceleration of the space coordinate system. The method specifically comprises the following steps:
s11, obtaining the absolute value of the space coordinate
Calculating and acquiring absolute value of space coordinate (& lt & gtY & gt) by transmitting wireless alternating electromagnetic wave, receiving wireless alternating electromagnetic wave and change of electromagnetic signal
Figure 224667DEST_PATH_IMAGE018
|,
Figure 465155DEST_PATH_IMAGE019
Figure 150215DEST_PATH_IMAGE020
)。
S12, calculating the possible acceleration of the space coordinate system
The calculation formula of the possible acceleration of the space coordinate system is as follows:
in the x-axis, the x-axis coordinate at time t1 is x1, the x-axis coordinate at time t2 is x2, and the time interval is
Figure 501562DEST_PATH_IMAGE001
Figure 73620DEST_PATH_IMAGE002
In the y-axis, the y-axis coordinate at time t1 is y1, the y-axis coordinate at time t2 is y2, and the time interval is
Figure 485009DEST_PATH_IMAGE001
Figure 657365DEST_PATH_IMAGE003
In the z-axis, the z-axis coordinate at time t1 is z1, the z-axis coordinate at time t2 is z2, and the time interval is
Figure 546823DEST_PATH_IMAGE001
Figure 753814DEST_PATH_IMAGE004
S13, judging the positive and negative of the possible acceleration of the space coordinate system to determine the space coordinate system
When the space coordinate system on the x-axis has a possible acceleration of
Figure 585372DEST_PATH_IMAGE026
When the space coordinate system on the y-axis may be accelerated by
Figure 979445DEST_PATH_IMAGE028
When the space coordinate system on the z-axis may be accelerated by
Figure 938173DEST_PATH_IMAGE030
Then, the space coordinate system is (
Figure 202933DEST_PATH_IMAGE018
Figure 221704DEST_PATH_IMAGE021
Figure 853805DEST_PATH_IMAGE022
)。
When the space coordinate system on the x-axis can beCan accelerate to
Figure 350645DEST_PATH_IMAGE026
When the space coordinate system on the y-axis may be accelerated by
Figure 266649DEST_PATH_IMAGE029
When the space coordinate system on the z-axis may be accelerated by
Figure 925163DEST_PATH_IMAGE030
Then, the space coordinate system is (
Figure 543095DEST_PATH_IMAGE018
Figure 843626DEST_PATH_IMAGE023
Figure 614136DEST_PATH_IMAGE022
)。
When the space coordinate system on the x-axis has a possible acceleration of
Figure 443552DEST_PATH_IMAGE026
When the space coordinate system on the y-axis may be accelerated by
Figure 565092DEST_PATH_IMAGE028
When the space coordinate system on the z-axis may be accelerated by
Figure 154467DEST_PATH_IMAGE031
Then, the space coordinate system is (
Figure 513905DEST_PATH_IMAGE018
Figure 45380DEST_PATH_IMAGE021
Figure 123057DEST_PATH_IMAGE024
)。
When the space coordinate system on the x-axis canCan accelerate to
Figure 765391DEST_PATH_IMAGE026
When the space coordinate system on the y-axis may be accelerated by
Figure 759761DEST_PATH_IMAGE029
When the space coordinate system on the z-axis may be accelerated by
Figure 196559DEST_PATH_IMAGE031
Then the space coordinate system is (
Figure 761532DEST_PATH_IMAGE018
,-
Figure 207557DEST_PATH_IMAGE021
Figure 541586DEST_PATH_IMAGE024
)。
When the space coordinate system on the x-axis has a possible acceleration of
Figure 165597DEST_PATH_IMAGE027
When the space coordinate system on the y-axis may be accelerated by
Figure 217866DEST_PATH_IMAGE028
When the space coordinate system on the z-axis may be accelerated by
Figure 936424DEST_PATH_IMAGE030
Then, the space coordinate system is (
Figure 390539DEST_PATH_IMAGE025
Figure 434718DEST_PATH_IMAGE021
Figure 223552DEST_PATH_IMAGE022
)。
Space coordinate system on x axisMay be accelerated by
Figure 745800DEST_PATH_IMAGE027
When the space coordinate system on the y-axis may be accelerated by
Figure 54421DEST_PATH_IMAGE029
When the space coordinate system on the z-axis may be accelerated by
Figure 269502DEST_PATH_IMAGE030
Then the space coordinate system is (
Figure 793236DEST_PATH_IMAGE025
Figure 119175DEST_PATH_IMAGE023
Figure 547882DEST_PATH_IMAGE022
)。
When the space coordinate system on the x-axis has a possible acceleration of
Figure 668285DEST_PATH_IMAGE027
When the space coordinate system on the y-axis may be accelerated by
Figure 448022DEST_PATH_IMAGE028
When the space coordinate system on the z-axis may be accelerated by
Figure 561341DEST_PATH_IMAGE031
Then, the space coordinate system is (
Figure 844554DEST_PATH_IMAGE025
Figure 401438DEST_PATH_IMAGE021
Figure 137312DEST_PATH_IMAGE024
)。
Space coordinate system on x axisMay be accelerated by
Figure 805054DEST_PATH_IMAGE027
When the space coordinate system on the y-axis may be accelerated by
Figure 427928DEST_PATH_IMAGE029
When the space coordinate system on the z-axis may be accelerated by
Figure 421291DEST_PATH_IMAGE031
Then, the space coordinate system is (
Figure 644462DEST_PATH_IMAGE025
Figure 850316DEST_PATH_IMAGE023
Figure 108122DEST_PATH_IMAGE024
)。
S2, acquiring and converting actual acceleration of tracked object
Acquiring the actual acceleration of the tracked object by a nine-axis motion sensor (the nine-axis motion sensor is installed in the tracked object); and then converting the obtained actual acceleration of the tracked object into the acceleration of a world coordinate system. The method specifically comprises the following steps:
s21, acquiring actual acceleration of the tracked object
A nine-axis motion sensor is arranged in the tracked object, and the actual acceleration of the tracked object is obtained through the nine-axis motion sensor
Figure 256075DEST_PATH_IMAGE009
S22, calculating the acceleration of the world coordinate system
The actual acceleration of the tracked object is calculated by a quaternion algorithm or an Euler angle algorithm
Figure 700963DEST_PATH_IMAGE009
Converted into world coordinate system acceleration
Figure 976087DEST_PATH_IMAGE038
The acceleration of the world coordinate system is calculated according to the formula
Figure 88399DEST_PATH_IMAGE008
Wherein the content of the first and second substances,
Figure 157986DEST_PATH_IMAGE009
in order for the tracked object to actually accelerate,
Figure 106482DEST_PATH_IMAGE010
a rotation matrix of euler angles or quaternions.
S3, judging the quadrant position of the tracked object, converting the actual acceleration of the tracked object into the acceleration of a world coordinate system
And (3) obtaining a difference value by subtracting the acceleration of the world coordinate system and the possible acceleration of the space coordinate system, and comparing the obtained difference value to judge the quadrant position of the tracked object. The method specifically comprises the following steps:
s31, calculating the difference value between the acceleration of the world coordinate system and the possible acceleration of the space coordinate system
In the x-axis, the possible accelerations of the spatial coordinate system include 2, i.e.
Figure 654138DEST_PATH_IMAGE026
And with
Figure 886536DEST_PATH_IMAGE027
Therefore, the difference between the world coordinate system acceleration and the space coordinate system possible acceleration also includes 2 kinds, i.e. X1 and X2. Wherein, the first and the second end of the pipe are connected with each other,
X1=
Figure 861445DEST_PATH_IMAGE038
-
Figure 795772DEST_PATH_IMAGE026
X2=
Figure 412698DEST_PATH_IMAGE038
-(
Figure 234024DEST_PATH_IMAGE027
)。
in the y-axis, the possible accelerations of the spatial coordinate system comprise 2, i.e.
Figure 645414DEST_PATH_IMAGE028
And with
Figure 817769DEST_PATH_IMAGE029
Therefore, the difference between the world coordinate system acceleration and the space coordinate system possible acceleration also includes 2 kinds, i.e., Y1 and Y2. Wherein the content of the first and second substances,
Y1=
Figure 457960DEST_PATH_IMAGE038
-
Figure 664950DEST_PATH_IMAGE028
Y2=
Figure 981662DEST_PATH_IMAGE038
-(
Figure 641314DEST_PATH_IMAGE029
)。
in the z-axis, the possible accelerations of the spatial coordinate system include 2, i.e.
Figure 68884DEST_PATH_IMAGE030
And with
Figure 379648DEST_PATH_IMAGE031
Therefore, the difference between the world coordinate system acceleration and the possible acceleration of the space coordinate system also includes 2 types, i.e., Z1 and Z2. Wherein, the first and the second end of the pipe are connected with each other,
Z1=
Figure 132841DEST_PATH_IMAGE038
-
Figure 14209DEST_PATH_IMAGE030
Z2=
Figure 245470DEST_PATH_IMAGE038
-(
Figure 161474DEST_PATH_IMAGE031
)。
s32, comparing the difference value between the acceleration of the world coordinate system and the possible acceleration of the space coordinate system, wherein the difference value is small, and the position of the space coordinate system where the possible acceleration of the space coordinate system is located is the actual position of the tracked object
If X1 is less than X2, the coordinate value of the possible acceleration of the space coordinate system on the X axis is positive, namely the actual coordinate value of the tracked object on the X axis is positive;
if X1 is greater than X2, the coordinate value of the possible acceleration of the space coordinate system on the X axis is negative, namely the actual coordinate value of the tracked object on the X axis is negative;
if Y1 is greater than Y2, the coordinate value of the possible acceleration of the space coordinate system on the Y axis is negative, namely the actual coordinate value of the tracked object on the Y axis is negative;
if Y1 is less than Y2, the coordinate value of the possible acceleration of the space coordinate system on the Y axis is positive, namely the actual coordinate value of the tracked object on the Y axis is positive;
if Z1 is less than Z2, the coordinate value of the possible acceleration of the space coordinate system on the Z axis is positive, namely the actual coordinate value of the tracked object on the Z axis is positive;
if Z1 > Z2, the coordinate value of the possible acceleration in the space coordinate system on the Z-axis is negative, i.e. the actual coordinate value of the tracked object on the Z-axis is negative.
Example 2
Referring to fig. 3, fig. 3 is a flowchart of an identification method for electromagnetic space quadrants according to embodiment 2 of the present application.
The embodiment provides an identification method of electromagnetic space quadrants. The identification method comprises the following steps:
s1, acquiring and decomposing absolute value of space coordinate
By transmitting and receiving radio alternating electromagnetic wavesCalculating the change of electromagnetic signal and obtaining the absolute value of space coordinate (& gtnon calculation)
Figure 836300DEST_PATH_IMAGE018
|,
Figure 204964DEST_PATH_IMAGE019
Figure 239916DEST_PATH_IMAGE020
) (ii) a Then the obtained space coordinate absolute value (non-counting)
Figure 10426DEST_PATH_IMAGE018
|,
Figure 354689DEST_PATH_IMAGE019
Figure 210649DEST_PATH_IMAGE020
) The possible linear acceleration of the space coordinate system is resolved, and then the space coordinate system is determined according to the possible linear acceleration of the space coordinate system. The method specifically comprises the following steps:
s11, obtaining the absolute value of the space coordinate
Calculating and acquiring absolute value of space coordinate (counting through transmission of wireless alternating electromagnetic wave, reception of wireless alternating electromagnetic wave, change of electromagnetic signal
Figure 49292DEST_PATH_IMAGE018
|,
Figure 674309DEST_PATH_IMAGE019
Figure 940205DEST_PATH_IMAGE020
)。
S12, calculating the possible linear acceleration of the space coordinate system
The calculation formula of the possible linear acceleration of the space coordinate system is as follows:
in the x-axis, the x-axis coordinate at time t1 is x1, the x-axis coordinate at time t2 is x2, the x-axis coordinate at time t3 is x3, and the time interval is
Figure 34194DEST_PATH_IMAGE001
Figure 676528DEST_PATH_IMAGE005
In the y-axis, the y-axis coordinate at time t1 is y1, the y-axis coordinate at time t2 is y2, the y-axis coordinate at time t3 is y3, and the time interval is
Figure 156051DEST_PATH_IMAGE001
Figure 592848DEST_PATH_IMAGE006
In the z-axis, the z-axis coordinate at time t1 is z1, the z-axis coordinate at time t2 is z2, the z-axis coordinate at time t3 is z3, and the time interval is
Figure 407090DEST_PATH_IMAGE001
Figure 587535DEST_PATH_IMAGE007
S13, judging the positive and negative of the possible linear acceleration of the space coordinate system to determine the space coordinate system
When the space coordinate system on the x-axis can be linearly accelerated by
Figure 187144DEST_PATH_IMAGE032
When the space coordinate system on the y-axis can linearly accelerate to
Figure 794843DEST_PATH_IMAGE034
When the space coordinate system on the z-axis can be linearly accelerated by
Figure 112691DEST_PATH_IMAGE036
Then, the space coordinate system is (
Figure 581981DEST_PATH_IMAGE018
Figure 36096DEST_PATH_IMAGE021
Figure 814696DEST_PATH_IMAGE022
)。
When the space coordinate system on the x-axis can be linearly accelerated by
Figure 354262DEST_PATH_IMAGE032
When the space coordinate system on the y-axis can linearly accelerate to
Figure 142090DEST_PATH_IMAGE035
When the space coordinate system on the z-axis can be linearly accelerated by
Figure 434400DEST_PATH_IMAGE036
Then, the space coordinate system is (
Figure 649480DEST_PATH_IMAGE018
Figure 410763DEST_PATH_IMAGE023
Figure 736702DEST_PATH_IMAGE022
)。
When the space coordinate system on the x-axis can be linearly accelerated by
Figure 916142DEST_PATH_IMAGE032
When the space coordinate system on the y-axis can linearly accelerate to
Figure 36544DEST_PATH_IMAGE034
When the space coordinate system on the z-axis can be linearly accelerated by
Figure 550702DEST_PATH_IMAGE039
Then, the space coordinate system is (
Figure 414753DEST_PATH_IMAGE018
Figure 697967DEST_PATH_IMAGE021
Figure 504118DEST_PATH_IMAGE024
)。
When the space coordinate system on the x-axis can be linearly accelerated by
Figure 239993DEST_PATH_IMAGE032
When the space coordinate system on the y-axis can linearly accelerate to
Figure 907734DEST_PATH_IMAGE035
When the space coordinate system on the z-axis can be linearly accelerated by
Figure 45455DEST_PATH_IMAGE039
Then, the space coordinate system is (
Figure 512253DEST_PATH_IMAGE018
,-
Figure 735424DEST_PATH_IMAGE021
Figure 206856DEST_PATH_IMAGE024
)。
When the space coordinate system on the x-axis can be linearly accelerated by
Figure 199083DEST_PATH_IMAGE040
When the space coordinate system on the y-axis can be linearly accelerated by
Figure 97769DEST_PATH_IMAGE034
When the space coordinate system on the z-axis can be linearly accelerated by
Figure 57504DEST_PATH_IMAGE036
Then, the space coordinate system is (
Figure 332627DEST_PATH_IMAGE025
Figure 179361DEST_PATH_IMAGE021
Figure 983369DEST_PATH_IMAGE022
)。
When the space coordinate system on the x-axis can be linearly accelerated by
Figure 181132DEST_PATH_IMAGE040
When the space coordinate system on the y-axis can be linearly accelerated by
Figure 745099DEST_PATH_IMAGE035
When the space coordinate system on the z-axis can be linearly accelerated by
Figure 711918DEST_PATH_IMAGE036
Then, the space coordinate system is (
Figure 952407DEST_PATH_IMAGE025
Figure 637466DEST_PATH_IMAGE023
Figure 238081DEST_PATH_IMAGE022
)。
When the space coordinate system on the x-axis can be linearly accelerated by
Figure 59406DEST_PATH_IMAGE040
When the space coordinate system on the y-axis can be linearly accelerated by
Figure 470796DEST_PATH_IMAGE034
When the space coordinate system on the z-axis can be linearly accelerated by
Figure 377572DEST_PATH_IMAGE039
Then the space coordinate system is (
Figure 798189DEST_PATH_IMAGE025
Figure 224753DEST_PATH_IMAGE021
Figure 807044DEST_PATH_IMAGE024
)。
When the space coordinate system on the x-axis can be linearly accelerated by
Figure 466696DEST_PATH_IMAGE040
When the space coordinate system on the y-axis can linearly accelerate to
Figure 159845DEST_PATH_IMAGE035
When the space coordinate system on the z-axis can be linearly accelerated by
Figure 955763DEST_PATH_IMAGE039
Then, the space coordinate system is (
Figure 223802DEST_PATH_IMAGE025
Figure 839591DEST_PATH_IMAGE023
Figure 336432DEST_PATH_IMAGE024
)。
S2, acquiring and converting actual linear acceleration of tracked object
Acquiring actual linear acceleration of a tracked object through a nine-axis motion sensor (the nine-axis motion sensor is installed in the tracked object); and converting the acquired actual linear acceleration of the tracked object into the linear acceleration of the world coordinate system. The method specifically comprises the following steps:
s21, acquiring actual linear acceleration of the tracked object
A nine-axis motion sensor is arranged in the tracked object, and the actual linear acceleration of the tracked object is obtained through the nine-axis motion sensor
Figure 986856DEST_PATH_IMAGE009
S22, calculating linear acceleration of world coordinate system
Actual linear acceleration of tracked object by quaternion algorithm or Euler angle algorithm
Figure 176529DEST_PATH_IMAGE009
Converted into linear acceleration of world coordinate system
Figure 295926DEST_PATH_IMAGE038
The linear acceleration of the world coordinate system is calculated according to the formula
Figure 330878DEST_PATH_IMAGE008
Wherein the content of the first and second substances,
Figure 101388DEST_PATH_IMAGE009
in order to achieve the actual linear acceleration of the tracked object,
Figure 196383DEST_PATH_IMAGE010
a rotation matrix of euler angles or quaternions.
S3, judging the quadrant position of the tracked object, converting the actual linear acceleration of the tracked object into the linear acceleration of a world coordinate system
And (3) subtracting the linear acceleration of the world coordinate system from the possible linear acceleration of the space coordinate system to obtain a difference value, and comparing the difference value to judge the quadrant position of the tracked object. The method specifically comprises the following steps:
s31, calculating the difference value between the linear acceleration of the world coordinate system and the possible linear acceleration of the space coordinate system
In the x-axis, the possible linear accelerations of the spatial coordinate system include 2, i.e.
Figure 36032DEST_PATH_IMAGE032
And with
Figure 140254DEST_PATH_IMAGE041
Therefore, the difference between the linear acceleration of the world coordinate system and the possible linear acceleration of the space coordinate system also includes 2 types, i.e. X1 and X2. Wherein the content of the first and second substances,
X1=
Figure 765270DEST_PATH_IMAGE038
-
Figure 31166DEST_PATH_IMAGE032
X2=
Figure 108844DEST_PATH_IMAGE038
-(
Figure 236331DEST_PATH_IMAGE041
)。
in the y-axis, the possible linear accelerations of the spatial coordinate system include 2, i.e.
Figure 981433DEST_PATH_IMAGE034
And
Figure 418231DEST_PATH_IMAGE035
therefore, the difference between the linear acceleration of the world coordinate system and the possible linear acceleration of the space coordinate system also includes 2 types, i.e., Y1 and Y2. Wherein the content of the first and second substances,
Y1=
Figure 248783DEST_PATH_IMAGE038
-
Figure 429229DEST_PATH_IMAGE034
Y2=
Figure 278105DEST_PATH_IMAGE038
-(
Figure 151383DEST_PATH_IMAGE035
)。
in the z-axis, the possible linear accelerations of the spatial coordinate system include 2, i.e.
Figure 938074DEST_PATH_IMAGE036
And
Figure 922210DEST_PATH_IMAGE039
therefore, the difference between the linear acceleration of the world coordinate system and the possible linear acceleration of the space coordinate system also includes 2 types, i.e., Z1 and Z2. Wherein the content of the first and second substances,
Z1=
Figure 641905DEST_PATH_IMAGE038
-
Figure 171237DEST_PATH_IMAGE036
Z2=
Figure 445224DEST_PATH_IMAGE038
-(
Figure 233051DEST_PATH_IMAGE039
)。
s31, comparing the difference value between the linear acceleration of the world coordinate system and the possible linear acceleration of the space coordinate system, wherein the difference value is small, and the position of the space coordinate system where the possible linear acceleration of the space coordinate system is located is the actual position of the tracked object
If X1 < X2, the coordinate value of the possible linear acceleration of the space coordinate system on the X axis is positive, namely the actual coordinate value of the tracked object on the X axis is positive;
if X1 is greater than X2, the coordinate value of the possible linear acceleration of the space coordinate system on the X axis is negative, namely the actual coordinate value of the tracked object on the X axis is negative;
if Y1 is greater than Y2, the coordinate value of the possible linear acceleration of the space coordinate system on the Y axis is negative, namely the actual coordinate value of the tracked object on the Y axis is negative;
if Y1 is less than Y2, the coordinate value of the possible linear acceleration of the space coordinate system on the Y axis is positive, namely the actual coordinate value of the tracked object on the Y axis is positive;
if Z1 is less than Z2, the coordinate value of the possible linear acceleration of the space coordinate system on the Z axis is positive, namely the actual coordinate value of the tracked object on the Z axis is positive;
if Z1 > Z2, the coordinate value of the spatial coordinate system of the possible linear acceleration on the Z-axis is negative, i.e. the actual coordinate value of the tracked object on the Z-axis is negative.
Example 3
Referring to fig. 4, fig. 4 is a flowchart of an identification method for electromagnetic space quadrants according to embodiment 3 of the present application.
The embodiment provides an identification method of electromagnetic space quadrants. The identification method comprises the following steps:
s1, acquiring and decomposing absolute value of space coordinate
Calculating and acquiring absolute value of space coordinate (& lt & gtY & gt) by transmitting wireless alternating electromagnetic wave, receiving wireless alternating electromagnetic wave and change of electromagnetic signal
Figure 541673DEST_PATH_IMAGE018
|,
Figure 756753DEST_PATH_IMAGE019
Figure 32883DEST_PATH_IMAGE020
) (ii) a Then the obtained space coordinate absolute value (non-counting)
Figure 93243DEST_PATH_IMAGE018
|,
Figure 787529DEST_PATH_IMAGE019
Figure 907932DEST_PATH_IMAGE020
) Decomposing the angular velocity into possible angular velocity of the space coordinate system, and determining the space coordinate system according to the possible angular velocity of the space coordinate system. The method specifically comprises the following steps:
s11, obtaining the absolute value of the space coordinate
Calculating and acquiring absolute value of space coordinate (& lt & gtY & gt) by transmitting wireless alternating electromagnetic wave, receiving wireless alternating electromagnetic wave and change of electromagnetic signal
Figure 422090DEST_PATH_IMAGE018
|,
Figure 36873DEST_PATH_IMAGE019
Figure 320087DEST_PATH_IMAGE020
)。
S12, calculating possible angular speed of a space coordinate system
Calculating the possible angular velocity of the space coordinate system
Figure 876970DEST_PATH_IMAGE042
Figure 612845DEST_PATH_IMAGE043
Figure 529854DEST_PATH_IMAGE044
S13, judging the positive and negative of the possible angular velocity of the space coordinate system to determine the space coordinate system
When the space coordinate system on the x-axis has a possible angular velocity of
Figure 933154DEST_PATH_IMAGE045
When the space coordinate system on the y-axis has a possible angular velocity of
Figure 395359DEST_PATH_IMAGE046
When the space coordinate system on the z-axis has a possible angular velocity of
Figure 618530DEST_PATH_IMAGE047
Then, the space coordinate system is (
Figure 355542DEST_PATH_IMAGE018
Figure 98501DEST_PATH_IMAGE021
Figure 997187DEST_PATH_IMAGE022
)。
When the space coordinate system on the x-axis has a possible angular velocity of
Figure 707654DEST_PATH_IMAGE045
When the space coordinate system on the y-axis has a possible angular velocity of
Figure 982778DEST_PATH_IMAGE048
When the space coordinate system on the z-axis has a possible angular velocity of
Figure 829511DEST_PATH_IMAGE047
Then the space coordinate system is (
Figure 148366DEST_PATH_IMAGE018
Figure 346129DEST_PATH_IMAGE023
Figure 159364DEST_PATH_IMAGE022
)。
When the space coordinate system on the x-axis has a possible angular velocity of
Figure 126183DEST_PATH_IMAGE045
When the space coordinate system on the y-axis has a possible angular velocity of
Figure 366671DEST_PATH_IMAGE046
When the space coordinate system on the z-axis has a possible angular velocity of
Figure 548603DEST_PATH_IMAGE049
Then the space coordinate system is (
Figure 165529DEST_PATH_IMAGE018
Figure 986854DEST_PATH_IMAGE021
Figure 398244DEST_PATH_IMAGE024
)。
When the space coordinate system on the x-axis has a possible angular velocity of
Figure 570599DEST_PATH_IMAGE045
When the space coordinate system on the y-axis has a possible angular velocity of
Figure 974905DEST_PATH_IMAGE048
When the space coordinate system on the z-axis has a possible angular velocity of
Figure 916316DEST_PATH_IMAGE049
Then the space coordinate system is (
Figure 498607DEST_PATH_IMAGE018
,-
Figure 892679DEST_PATH_IMAGE021
Figure 851408DEST_PATH_IMAGE024
)。
When the space coordinate system on the x-axis has a possible angular velocity of
Figure 398058DEST_PATH_IMAGE050
When the space coordinate system on the y-axis has a possible angular velocity of
Figure 151250DEST_PATH_IMAGE046
When the space coordinate system on the z-axis has a possible angular velocity of
Figure 32619DEST_PATH_IMAGE047
Then, the space coordinate system is (
Figure 795038DEST_PATH_IMAGE025
Figure 445463DEST_PATH_IMAGE021
Figure 618824DEST_PATH_IMAGE022
)。
When the space coordinate system on the x-axis has a possible angular velocity of
Figure 987488DEST_PATH_IMAGE050
When the space coordinate system on the y-axis has a possible angular velocity of
Figure 22440DEST_PATH_IMAGE048
When the space coordinate system on the z-axis has a possible angular velocity of
Figure 58530DEST_PATH_IMAGE047
Then the space coordinate system is (
Figure 153525DEST_PATH_IMAGE025
Figure 9485DEST_PATH_IMAGE023
Figure 598861DEST_PATH_IMAGE022
)。
When the space coordinate system on the x-axis has a possible angular velocity of
Figure 223877DEST_PATH_IMAGE050
When the space coordinate system on the y-axis has a possible angular velocity of
Figure 489773DEST_PATH_IMAGE046
When the space coordinate system on the z-axis has a possible angular velocity of
Figure 833030DEST_PATH_IMAGE049
Then, the space coordinate system is (
Figure 459052DEST_PATH_IMAGE025
Figure 204154DEST_PATH_IMAGE021
Figure 640952DEST_PATH_IMAGE024
)。
When the space coordinate system on the x-axis has a possible angular velocity of
Figure 205925DEST_PATH_IMAGE050
When the space coordinate system on the y-axis has a possible angular velocity of
Figure 651950DEST_PATH_IMAGE048
When the space coordinate system on the z-axis has a possible angular velocity of
Figure 736712DEST_PATH_IMAGE049
Then the space coordinate system is (
Figure 609990DEST_PATH_IMAGE025
Figure 662260DEST_PATH_IMAGE023
Figure 646396DEST_PATH_IMAGE024
)。
S2, acquiring and converting actual angular speed of tracked object
Acquiring the actual angular velocity of the tracked object by a nine-axis motion sensor (the nine-axis motion sensor is installed in the tracked object); and converting the obtained actual angular velocity of the tracked object into the angular velocity of a world coordinate system. The method comprises the following specific steps:
s21, acquiring actual angular velocity of tracked object
A nine-axis motion sensor is arranged in the tracked object, and the actual angular velocity of the tracked object is obtained through the nine-axis motion sensor
Figure 100511DEST_PATH_IMAGE012
S22, calculating the angular velocity of the world coordinate system
The actual angular velocity of the tracked object is calculated by quaternion algorithm or Euler angle algorithm
Figure 128379DEST_PATH_IMAGE012
Angular velocity converted into world coordinate systemDegree of rotation
Figure 667945DEST_PATH_IMAGE051
The calculation formula of the angular velocity of the world coordinate system is
Figure 455772DEST_PATH_IMAGE011
Wherein, the first and the second end of the pipe are connected with each other,
Figure 764394DEST_PATH_IMAGE012
in order for the actual angular velocity of the tracked object,
Figure 713895DEST_PATH_IMAGE010
a rotation matrix of euler angles or quaternions.
Actual angular velocity of tracked object
Figure 491489DEST_PATH_IMAGE052
The method is obtained by acquiring quaternion of a tracked object by an electromagnetic positioning system, converting the quaternion into Euler angles and calculating, and specifically comprises the following steps:
acquisition of quaternion of tracked object by electromagnetic positioning system
Figure 817429DEST_PATH_IMAGE013
The euler angle is obtained by converting the formula,
Figure 980557DEST_PATH_IMAGE014
Figure 366539DEST_PATH_IMAGE015
Figure 880697DEST_PATH_IMAGE016
the angular velocity is calculated by the euler angle,
Figure 994015DEST_PATH_IMAGE017
s3, judging the quadrant position of the tracked object, converting the actual angular velocity of the tracked object into the angular velocity of a world coordinate system
And (3) obtaining a difference value by subtracting the angular speed of the world coordinate system and the possible angular speed of the space coordinate system, and comparing the obtained difference value to judge the quadrant position of the tracked object. The method comprises the following specific steps:
s31, calculating the difference value between the angular velocity of the world coordinate system and the possible angular velocity of the space coordinate system
In the x-axis, the possible angular velocities of the spatial coordinate system include 2, i.e.
Figure 277229DEST_PATH_IMAGE045
And
Figure 568533DEST_PATH_IMAGE053
therefore, the difference between the angular velocity of the world coordinate system and the possible angular velocity of the space coordinate system also includes 2 kinds, i.e., X1 and X2. Wherein the content of the first and second substances,
X1=
Figure 569987DEST_PATH_IMAGE051
-
Figure 988461DEST_PATH_IMAGE045
X2=
Figure 126181DEST_PATH_IMAGE051
-(
Figure 853966DEST_PATH_IMAGE053
)。
in the y-axis, the possible angular velocities of the spatial coordinate system include 2, i.e.
Figure 77137DEST_PATH_IMAGE046
And
Figure 282990DEST_PATH_IMAGE054
therefore, the angular velocity of the world coordinate systemThe difference between the degree and the possible angular velocity of the spatial coordinate system also includes 2 kinds, i.e. Y1 and Y2. Wherein the content of the first and second substances,
Y1=
Figure 790064DEST_PATH_IMAGE051
-
Figure 688750DEST_PATH_IMAGE046
Y2=
Figure 399217DEST_PATH_IMAGE051
-(
Figure 408761DEST_PATH_IMAGE054
)。
in the z-axis, the possible angular velocities of the spatial coordinate system include 2, i.e.
Figure 521074DEST_PATH_IMAGE047
And
Figure 341393DEST_PATH_IMAGE055
therefore, the difference between the angular velocity of the world coordinate system and the possible angular velocity of the space coordinate system also includes 2 types, i.e., Z1 and Z2. Wherein, the first and the second end of the pipe are connected with each other,
Z1=
Figure 539156DEST_PATH_IMAGE051
-
Figure 86812DEST_PATH_IMAGE047
Z2=
Figure 319210DEST_PATH_IMAGE051
-(
Figure 559699DEST_PATH_IMAGE055
)。
s31, comparing the difference value of the angular velocity of the world coordinate system and the possible angular velocity of the space coordinate system, wherein the difference value is small, and the position of the space coordinate system where the possible angular velocity of the space coordinate system is located is the actual position of the tracked object
If X1 < X2, the coordinate value of the possible angular speed of the space coordinate system on the X axis is positive, namely the actual coordinate value of the tracked object on the X axis is positive;
if X1 is greater than X2, the coordinate value of the possible angular speed of the space coordinate system on the X axis is negative, namely the actual coordinate value of the tracked object on the X axis is negative;
if Y1 is greater than Y2, the coordinate value of the possible angular speed of the space coordinate system on the Y axis is negative, namely the actual coordinate value of the tracked object on the Y axis is negative;
if Y1 is less than Y2, the coordinate value of the possible angular speed of the space coordinate system on the Y axis is positive, namely the actual coordinate value of the tracked object on the Y axis is positive;
if Z1 is less than Z2, the coordinate value of the possible angular speed of the space coordinate system on the Z axis is positive, namely the actual coordinate value of the tracked object on the Z axis is positive;
if Z1 > Z2, the coordinate value of the spatial coordinate system possible angular velocity on the Z-axis is negative, i.e. the actual coordinate value of the tracked object on the Z-axis is negative.
It should be noted that in the description above, numerous specific details are set forth in order to provide a thorough understanding of the present application, however, the present application may be practiced otherwise than as specifically described herein and, therefore, the scope of the present application should not be limited by the specific embodiments disclosed below.

Claims (11)

1. A method for identifying electromagnetic space quadrants is characterized by comprising
Acquiring and decomposing the absolute value of the space coordinate, acquiring the absolute value of the space coordinate and decomposing the acquired absolute value of the space coordinate into possible speed values of a space coordinate system;
acquiring and converting an actual speed value of a tracked object, acquiring the actual speed value of the tracked object and converting the acquired actual speed value of the tracked object into a speed value of a world coordinate system;
and judging the quadrant position of the tracked object, namely, subtracting the speed value of the world coordinate system and the possible speed value of the space coordinate system to obtain a difference value, and comparing the difference value to judge the quadrant position of the tracked object.
2. Method for identification of electromagnetic space quadrants according to claim 1, characterized in that the speed values are accelerations, linear accelerations or angular velocities.
3. Method for identification of quadrants in an electromagnetic space according to claim 2, characterized in that the possible accelerations of the spatial coordinate system are calculated by the formula:
in the x-axis, the x-axis coordinate at time t1 is x1, the x-axis coordinate at time t2 is x2, and the time interval is
Figure 849068DEST_PATH_IMAGE001
Figure 926745DEST_PATH_IMAGE002
In the y-axis, the y-axis coordinate at time t1 is y1, the y-axis coordinate at time t2 is y2, and the time interval is
Figure 303500DEST_PATH_IMAGE001
Figure 517444DEST_PATH_IMAGE003
In the z-axis, the z-axis coordinate at time t1 is z1, the z-axis coordinate at time t2 is z2, and the time interval is
Figure 954241DEST_PATH_IMAGE001
Figure 253636DEST_PATH_IMAGE004
4. The method for identifying quadrants of an electromagnetic space as claimed in claim 2, wherein the possible linear acceleration of the spatial coordinate system is calculated by the formula:
in the x-axis, the x-axis coordinate at time t1 is x1, the x-axis coordinate at time t2 is x2, the x-axis coordinate at time t3 is x3, and the time interval is
Figure 434081DEST_PATH_IMAGE001
Figure 768111DEST_PATH_IMAGE005
In the y-axis, the y-axis coordinate at time t1 is y1, the y-axis coordinate at time t2 is y2, the y-axis coordinate at time t3 is y3, and the time interval is
Figure 375810DEST_PATH_IMAGE001
Figure 893991DEST_PATH_IMAGE006
In the z-axis, the z-axis coordinate at time t1 is z1, the z-axis coordinate at time t2 is z2, the z-axis coordinate at time t3 is z3, and the time interval is
Figure 878128DEST_PATH_IMAGE001
Figure 332243DEST_PATH_IMAGE007
5. Method for identification of quadrants in an electromagnetic space according to claim 2, characterized in that the acceleration of the world coordinate system is calculated by the formula
Figure 110843DEST_PATH_IMAGE008
Wherein the content of the first and second substances,
Figure 384829DEST_PATH_IMAGE009
is a quilt heelThe actual acceleration of the tracked object is,
Figure 907078DEST_PATH_IMAGE010
a rotation matrix of euler angles or quaternions.
6. Method for identification of quadrants in an electromagnetic space according to claim 2, characterized in that the linear acceleration of the world coordinate system is calculated according to the formula
Figure 215699DEST_PATH_IMAGE008
Wherein, the first and the second end of the pipe are connected with each other,
Figure 165201DEST_PATH_IMAGE009
in order for the tracked object to actually linearly accelerate,
Figure 192062DEST_PATH_IMAGE010
a rotation matrix of euler angles or quaternions.
7. Method for identification of quadrants of an electromagnetic space according to claim 2, characterized in that the calculation of the angular velocity of the world coordinate system is performed by the formula
Figure 252422DEST_PATH_IMAGE011
Wherein the content of the first and second substances,
Figure 681130DEST_PATH_IMAGE012
in order to be the actual angular velocity of the tracked object,
Figure 801532DEST_PATH_IMAGE010
a rotation matrix of euler angles or quaternions.
8. An electromagnetic space quadrant recognition device, comprising
The acquisition module is used for acquiring an absolute value of the space coordinate and an actual speed value of the tracked object;
the processing module is used for decomposing the space coordinate absolute value into a space coordinate system possible speed value and converting the tracked object actual speed value into a world coordinate system speed value;
and the judging module is used for subtracting the world coordinate system speed value from the space coordinate system possible speed value to obtain a difference value, and comparing the difference value to judge the quadrant position of the tracked object.
9. Device for the identification of quadrants of an electromagnetic space according to claim 8, characterized in that said processing module comprises
The decomposition unit is used for decomposing the absolute value of the space coordinate into a possible speed value of the space coordinate system;
and the conversion unit is used for converting the actual speed value of the tracked object into the speed value of the world coordinate system.
10. A computer storage medium having stored thereon computer-executable instructions for performing the method for identification of electromagnetic space quadrants of any of claims 1-7.
11. An electronic device, comprising
At least one processor; and the number of the first and second groups,
a memory communicatively coupled to the at least one processor; wherein, the first and the second end of the pipe are connected with each other,
the memory stores instructions executable by the at least one processor to enable the at least one processor to perform the method for identification of electromagnetic space quadrants of any of claims 1-7.
CN202211568291.5A 2022-12-08 2022-12-08 Method and device for identifying electromagnetic space quadrant, storage medium and electronic equipment Pending CN115575890A (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202211568291.5A CN115575890A (en) 2022-12-08 2022-12-08 Method and device for identifying electromagnetic space quadrant, storage medium and electronic equipment

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202211568291.5A CN115575890A (en) 2022-12-08 2022-12-08 Method and device for identifying electromagnetic space quadrant, storage medium and electronic equipment

Publications (1)

Publication Number Publication Date
CN115575890A true CN115575890A (en) 2023-01-06

Family

ID=84590172

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202211568291.5A Pending CN115575890A (en) 2022-12-08 2022-12-08 Method and device for identifying electromagnetic space quadrant, storage medium and electronic equipment

Country Status (1)

Country Link
CN (1) CN115575890A (en)

Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN103090860A (en) * 2013-01-11 2013-05-08 北京邮电大学 Method and device for obtaining movement direction
CN103120586A (en) * 2012-10-22 2013-05-29 上海大学 Auxiliary device and method used for collecting human body gait kinematical parameters
CN106500669A (en) * 2016-09-22 2017-03-15 浙江工业大学 A kind of Aerial Images antidote based on four rotor IMU parameters
KR20190041315A (en) * 2017-10-12 2019-04-22 한화디펜스 주식회사 Inertial-based navigation device and Inertia-based navigation method based on relative preintegration
CN110497423A (en) * 2019-08-22 2019-11-26 泉州装备制造研究所 A kind of manipulator adaptive machining method

Patent Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN103120586A (en) * 2012-10-22 2013-05-29 上海大学 Auxiliary device and method used for collecting human body gait kinematical parameters
CN103090860A (en) * 2013-01-11 2013-05-08 北京邮电大学 Method and device for obtaining movement direction
CN106500669A (en) * 2016-09-22 2017-03-15 浙江工业大学 A kind of Aerial Images antidote based on four rotor IMU parameters
KR20190041315A (en) * 2017-10-12 2019-04-22 한화디펜스 주식회사 Inertial-based navigation device and Inertia-based navigation method based on relative preintegration
CN110497423A (en) * 2019-08-22 2019-11-26 泉州装备制造研究所 A kind of manipulator adaptive machining method

Similar Documents

Publication Publication Date Title
CN103155001B (en) The generation of online benchmark and the methods, devices and systems of tracking for multi-user&#39;s Augmented Reality
Mohssen et al. It's the human that matters: Accurate user orientation estimation for mobile computing applications
CN106556854B (en) A kind of indoor and outdoor navigation system and method
CN101589558B (en) A user interface based on magnetic induction
JP6676082B2 (en) Indoor positioning method and system, and device for creating the indoor map
CN102918901B (en) Apparatus and method for recognizing zone in portable terminal
CN111559372B (en) Parking space detection performance evaluation method of parking system and electronic equipment
US20140129176A1 (en) Estimating the gravity vector in a world coordinate system using an accelerometer in a mobile device
US20100164807A1 (en) System and method for estimating state of carrier
CN111366908B (en) Laser radar rotary table and measuring device and measuring method thereof
KR20130124538A (en) Position determination using horizontal angles
CN109737941B (en) Human body motion capture method
CN113267794B (en) Antenna phase center correction method and device with base line length constraint
CN105607760A (en) Micro-inertial sensor based track recovery method and system
CN110293563A (en) Estimate method, equipment and the storage medium of robot pose
CN112665577A (en) Monocular vision target positioning method and system based on inverse perspective transformation matrix
CN112762945A (en) Information synchronization method, system and device of high-precision map full-element acquisition equipment
CN115575890A (en) Method and device for identifying electromagnetic space quadrant, storage medium and electronic equipment
CN107917708A (en) GPS/INS tight integration detection and reparation for cycle slips algorithms based on Bayes&#39;s compressed sensing
CN108445446A (en) A kind of passive method for locating speed measurement and device
TW201621273A (en) Mobile positioning apparatus and positioning method thereof
CN113498016A (en) Cross-region detection method for electronic fence
CN107257547B (en) Equipment positioning method and device
JP5230354B2 (en) POSITIONING DEVICE AND CHANGED BUILDING DETECTION DEVICE
CN106705954B (en) Floating ball platform carrier posture measuring method

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
RJ01 Rejection of invention patent application after publication
RJ01 Rejection of invention patent application after publication

Application publication date: 20230106