Electromagnetic space positioning method, device and equipment and storage medium

Through the combination of inertial sensors and magnetic sensors, the magnetic field fingerprint positioning algorithm is used after angle compensation, which solves the problem of low positioning accuracy in the existing electromagnetic positioning technology and achieves high-precision spatial positioning.

CN118960738APending Publication Date: 2024-11-15WUHAN UNIV
View PDF 0 Cites 1 Cited by

Patent Information

Application Number
CN202411022004.X
Authority / Receiving Office
CN · China
Patent Type
Applications(China)
Current Assignee / Owner
Filing Date
2024-07-29
Publication Date
2024-11-15

AI Technical Summary

Technical Problem

The existing electromagnetic positioning technology has low positioning accuracy, especially when it is disturbed by the earth's magnetic field, it is difficult to achieve high-precision positioning.

Method used

By combining inertial sensors and magnetic sensors to obtain the position information and magnetic induction intensity components of the target object, after angle compensation is performed, the position coordinates of the target object in a uniform gradient magnetic field are determined using the pre-constructed magnetic field fingerprint positioning algorithm, and the magnetic field simulation database and index are used to simulate the database and the Files are accurately positioned.

Benefits of technology

It improves positioning accuracy, meets the spatial positioning requirements of 6 degrees of freedom, and reduces the impact of earth's magnetic field interference on the positioning process.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN118960738A_ABST
    Figure CN118960738A_ABST
Patent Text Reader

Abstract

The invention provides an electromagnetic space positioning method, device and equipment and a storage medium, and the method comprises the steps: obtaining the pose information and magnetic induction intensity component of a target object; the target object comprises an inertial sensor and a magnetic sensor, and the target object is in a uniform gradient magnetic field; performing angle compensation on the magnetic induction intensity component of the target object in combination with the pose information of the target object; and calling a pre-constructed magnetic field fingerprint positioning algorithm, taking the magnetic induction intensity component after angle compensation as input, and determining position coordinates of the target object in the uniform gradient magnetic field. According to the invention, inertial measurement and magnetic sensor measurement are combined, and angle compensation is carried out on the magnetic induction intensity component measured by the sensor, so that the six-degree-of-freedom spatial positioning requirement can be met, and the problem of low positioning accuracy in the prior art is solved.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The present invention relates to the field of space positioning technology, and in particular to an electromagnetic space positioning method, device, equipment and storage medium. Background Art

[0002] The electromagnetic positioning and navigation system consists of an electromagnetic field transmitter, a receiver, and an electromagnetic tracking adapter. It uses a generator to generate an electromagnetic field, and then uses the sending and receiving of electromagnetic signals to determine the spatial position of the target. Electromagnetic positioning technology is based on the principle of electromagnetic induction, and uses sensors to measure the magnetic field information generated by the magnetic field generator to calculate the spatial posture and position information of the target. Due to the strong penetration ability of the magnetic field and little harm to the human body, electromagnetic positioning technology will not have problems when the positioning process is restricted by obstacles in optical positioning, and can also avoid the adverse effects of the complex human environment on ultrasonic positioning.

[0003] Regarding magnetic field spatial positioning, two main magnetic sources are currently used: permanent magnets and electromagnetic coils. Both technologies use magnetic dipoles as the model of the excitation source and use magnetic sensors to detect the signals emitted by the dipoles. By analyzing the coupling signal between the magnetic dipole and the sensor and using appropriate algorithms to calculate the position and direction parameters, accurate positioning of the target position is achieved. Due to the limitations of the working space, permanent magnets are usually small, resulting in a correspondingly weak and difficult to detect magnetic field, and the positioning error increases as the distance between the permanent magnet and the receiving end increases. In contrast, electromagnetic coils are able to generate a strong and consistent magnetic field for precise positioning. Electromagnetic positioning systems with electromagnetic coils as magnetic sources are usually divided into two main types: alternating current (AC) and direct current (DC), depending on the nature of the magnetic field generated. Magnetic tracking of AC electric fields often relies on one or more oscillating magnetic fields. The positioning system contains a transmitter with a three-axis orthogonal coil and one or more three-axis receivers, which are usually implemented using orthogonal coils. It relies on the use of iterative methods to calculate and estimate the posture of the tracked object, which is computationally intensive. In DC magnetic field tracking systems, magnetic sensors are usually used to measure the magnetic field generated by the electromagnetic coils. The accuracy and sampling rate of magnetic sensors are usually limited, so the sampling accuracy and rate mainly depend on the quality of the magnetic sensor itself. In addition, the use of magnetic sensors needs to take into account the interference of the earth's own magnetic field, which affects the accuracy of positioning.

[0004] There is currently no effective solution to the problem of low positioning accuracy in existing related technologies. Summary of the invention

[0005] The present invention provides an electromagnetic space positioning method, device, equipment and storage medium, which are used to solve the defect of low positioning accuracy in the prior art.

[0006] In a first aspect, the present invention provides an electromagnetic space positioning method, comprising: Acquiring position information and magnetic induction intensity components of a target object; the target object includes an inertial sensor and a magnetic sensor, and the target object is in a uniform gradient magnetic field; Combining the position and posture information of the target object, performing angle compensation on the magnetic induction intensity component of the target object; A pre-built magnetic field fingerprint positioning algorithm is called, and the angle-compensated magnetic induction intensity component is used as input to determine the position coordinates of the target object in the uniform gradient magnetic field.

[0007] According to an electromagnetic space positioning method provided by the present invention, angle compensation is performed on the magnetic induction intensity component of the target object in combination with the position information of the target object, including: Determining a rotation matrix of the target object according to the position and posture information of the target object; The magnetic induction intensity component of the target object is adjusted and compensated by the rotation matrix of the target object.

[0008] According to an electromagnetic space positioning method provided by the present invention, the magnetic field fingerprint positioning algorithm is constructed, including: Acquire a pre-built magnetic field simulation database; the magnetic field simulation database corresponds to the Maxwell coil that generates the uniform gradient magnetic field; Based on the magnetic field simulation database, the magnetic field fingerprint positioning algorithm is determined.

[0009] According to an electromagnetic space positioning method provided by the present invention, the magnetic field simulation database includes index files of several levels; constructing the magnetic field simulation database includes: Determining coil parameters of the Maxwell coil, and simulating the uniform gradient magnetic field generated by the Maxwell coil; Dividing the magnetic field space of the uniform gradient magnetic field into a plurality of cubes, and using the magnetic induction intensity component of the magnetic field space of each cube as a primary index of the magnetic field simulation database; Re-dividing the cube corresponding to each of the primary indexes, and determining a corresponding number of secondary indexes; According to the level division requirement of the magnetic field simulation database, it is determined whether the index division work is completed. If not, the next level index of the current division work is segmented until the level division requirement is met.

[0010] According to an electromagnetic space positioning method provided by the present invention, the coil parameters of the Maxwell coil include: radius, number of turns, wire diameter and current; the magnetic field space of the uniform gradient magnetic field is divided into a plurality of cubes, including: According to the number of turns of the Maxwell coil, the magnetic field space of the uniform gradient magnetic field is divided into a corresponding number of cubes.

[0011] According to an electromagnetic space positioning method provided by the present invention, the magnetic field fingerprint positioning algorithm is: Traversing the index files in the magnetic field simulation database level by level until the last level index file with the smallest Euclidean distance to the input of the magnetic field fingerprint positioning algorithm is obtained as the target index; Get the coordinates of the cube corresponding to the target index.

[0012] According to an electromagnetic space positioning method provided by the present invention, the magnetic induction intensity component after angle compensation is used as input to determine the position coordinates of the target object in the uniform gradient magnetic field, including: Traversing the index files in the magnetic field simulation database level by level until obtaining the last level index file having the smallest Euclidean distance to the magnetic induction intensity component after angle compensation as the target index; The coordinates of the cube corresponding to the target index are obtained, and the coordinates are used as the position coordinates of the target object.

[0013] In a second aspect, the present invention further provides an electromagnetic space positioning device, comprising: An acquisition module, used to acquire the position information and magnetic induction intensity component of a target object; the target object includes an inertial sensor and a magnetic sensor, and the target object is in a uniform gradient magnetic field; A compensation module, used to perform angle compensation on the magnetic induction intensity component of the target object in combination with the position and posture information of the target object; The determination module is used to call a pre-built magnetic field fingerprint positioning algorithm, take the angle-compensated magnetic induction intensity component as input, and determine the position coordinates of the target object in the uniform gradient magnetic field.

[0014] In a third aspect, the present invention further provides an electronic device comprising a memory, a processor, and a computer program stored in the memory and executable on the processor, wherein when the processor executes the program, the electromagnetic space positioning method as described in the first aspect above is implemented.

[0015] In a fourth aspect, the present invention further provides a non-transitory computer-readable storage medium having a computer program stored thereon, which, when executed by a processor, implements the electromagnetic space positioning method as described in the first aspect above.

[0016] In a fifth aspect, the present invention further provides a computer program product, comprising a computer program, which, when executed by a processor, implements the electromagnetic space positioning method as described in the first aspect above.

[0017] Compared with the prior art, the present invention has the following beneficial effects: The electromagnetic space positioning method provided by the present invention obtains the current posture information of the target object through the inertial sensor in the target object, and obtains the magnetic induction intensity component of the target object in the current uniform gradient magnetic field through the magnetic sensor. Then, in combination with the posture information of the target object, the magnetic induction intensity component of the target object is angle-compensated to reduce the interference of the magnetic field of the earth itself during the positioning process. Finally, the magnetic induction intensity component after angle compensation is used as the input of the magnetic field fingerprint positioning algorithm to determine the coordinates of the target object. This method combines inertial measurement with magnetic sensor measurement, and performs angle compensation on the magnetic induction intensity component measured by the sensor, so that it can meet the spatial positioning requirements of 6 degrees of freedom, solving the problem of low positioning accuracy in the existing related technologies. BRIEF DESCRIPTION OF THE DRAWINGS

[0018] In order to more clearly illustrate the technical solutions in the present invention or the prior art, the drawings required for use in the embodiments or the description of the prior art will be briefly introduced below. Obviously, the drawings described below are some embodiments of the present invention. For ordinary technicians in this field, other drawings can be obtained based on these drawings without paying creative work.

[0019] Figure 1 is a flow chart of the electromagnetic space positioning method proposed by the present invention; Figure 2 is a schematic diagram of magnetic field intensity simulation data in an embodiment of the present invention; Figure 3 It is a structural block diagram of the electromagnetic space positioning device provided by the present invention; Figure 4 is a schematic diagram of the electromagnetic space positioning system provided by the present invention; Figure 5 It is a structural schematic diagram of the electronic device provided by the present invention. DETAILED DESCRIPTION

[0020] In order to make the purpose, technical solution and advantages of the present invention clearer, the technical solution of the present invention will be clearly and completely described below in conjunction with the drawings of the present invention. Obviously, the described embodiments are part of the embodiments of the present invention, not all of the embodiments. Based on the embodiments of the present invention, all other embodiments obtained by ordinary technicians in this field without creative work are within the scope of protection of the present invention.

[0021] The present invention provides an electromagnetic space positioning method. Figure 1 is a flow chart of the electromagnetic space positioning method proposed by the present invention, such as Figure 1 As shown, the method comprises the following steps: Step S101, acquiring the position information and magnetic induction intensity component of the target object; the target object includes an inertial sensor and a magnetic sensor, and the target object is in a uniform gradient magnetic field.

[0022] Step S102, combining the position and posture information of the target object, performing angle compensation on the magnetic induction intensity component of the target object.

[0023] Step S103, calling a pre-built magnetic field fingerprint positioning algorithm, taking the angle-compensated magnetic induction intensity component as input, and determining the position coordinates of the target object in the uniform gradient magnetic field.

[0024] In this method, when the target object needs to be positioned, the current position and posture information of the target object is obtained through the inertial sensor in the target object, and the magnetic induction intensity component of the target object in the current uniform gradient magnetic field is obtained through the magnetic sensor. Then, combined with the position and posture information of the target object, the magnetic induction intensity component of the target object is angle-compensated to reduce the interference of the earth's own magnetic field during the positioning process. Finally, the angle-compensated magnetic induction intensity component is used as the input of the magnetic field fingerprint positioning algorithm to determine the coordinates of the target object. This method combines inertial measurement with magnetic sensor measurement, and performs angle compensation on the magnetic induction intensity component measured by the sensor, so that it can meet the spatial positioning requirements of 6 degrees of freedom, solving the problem of low positioning accuracy in existing related technologies.

[0025] In some of the embodiments, step S102, in combination with the posture information of the target object, performs angle compensation on the magnetic induction intensity component of the target object, including: determining the rotation matrix of the target object according to the posture information of the target object; and adjusting and compensating the magnetic induction intensity component of the target object through the rotation matrix of the target object.

[0026] For example, the posture information calculated by the inertial sensor is used to obtain the corresponding rotation matrix, and the magnetic induction intensity component measured by the magnetic sensor is obtained by the rotation matrix. Perform angle compensation to obtain the magnetic induction intensity component that can be used in the magnetic field fingerprint positioning algorithm. Among them, the representation method of the rotation matrix of the posture information can be selected according to the needs. In practical applications, it can be represented by Euler angles. The specific formula is as follows:

[0027] in, R represents the rotation matrix, Indicates the pitch angle of the target object. Indicates the roll angle (Roll) of the target object. Indicates the heading angle (Yaw) of the target object. In addition, the position information of the target object can also be represented by a quaternion, which consists of a real part and three imaginary parts, and is defined as:

[0028] in, q represents a quaternion, is the real part of the quaternion, , and is the imaginary part of the quaternion, , and is a standard orthogonal basis in three-dimensional space. The rotation matrix represented by the quaternion R for:

[0029] After the rotation matrix of the target object is obtained by the inertial sensor, the magnetic induction intensity component obtained by the magnetic sensor is B Perform angle compensation to obtain the magnetic induction intensity component after angle compensation :

[0030] in, represents the magnetic induction intensity component after angle compensation, It represents the magnetic induction intensity component before angle compensation, R represents the rotation matrix, , and Respectively expressed in x , y and z The component of magnetic induction intensity in the direction.

[0031] In some of the embodiments, constructing a magnetic field fingerprint positioning algorithm includes: obtaining a pre-constructed magnetic field simulation database; the magnetic field simulation database corresponds to a Maxwell coil that generates a uniform gradient magnetic field; and determining a magnetic field fingerprint positioning algorithm based on the magnetic field simulation database.

[0032] Specifically, the magnetic field simulation database includes index files of several levels; constructing the magnetic field simulation database includes: determining the coil parameters of the Maxwell coil, and simulating the uniform gradient magnetic field generated by the Maxwell coil; dividing the magnetic field space of the uniform gradient magnetic field into several cubes, and using the magnetic induction intensity component of the magnetic field space of each cube as the primary index of the magnetic field simulation database; dividing the cube corresponding to each primary index again, and determining the corresponding number of secondary indexes; judging whether the index division work is completed according to the level division requirements of the magnetic field simulation database, if not completed, dividing the next level index of the current division work until the level division requirements are met.

[0033] In this embodiment, the coil parameters of the Maxwell coil include: radius, number of turns, wire diameter and current. Dividing the magnetic field space of the uniform gradient magnetic field into a number of cubes includes: dividing the magnetic field space of the uniform gradient magnetic field into a corresponding number of cubes according to the number of turns of the Maxwell coil.

[0034] For example, the number of Maxwell coils used in this embodiment is two, and the radius of the Maxwell coil is R , the distance between the Maxwell coils is , the number of turns is , the wire diameter is , opposite currents are passed through , and simulate the uniform gradient magnetic field it generates. The number of turns and current of the Maxwell coil are set according to the magnetic field strength measurement range of the magnetic sensor. Moreover, the Maxwell coil used in this embodiment is a DC electromagnetic coil, which is designed to achieve a stable gradient magnetic field to obtain higher and more consistent positioning accuracy. Compared with the AC electromagnetic field, the DC electromagnetic field is not limited by the coil excitation cycle, and has a higher possibility of achieving high positioning frequency. At the same time, there is no defect that when using a permanent magnet as a magnetic source for positioning, the positioning error will increase with the increase of the distance between the permanent magnet and the receiving end. Figure 2 As shown, Figure 2 : is a schematic diagram of magnetic field strength simulation data in an embodiment of the present invention, in which: Represents the magnetic induction intensity component With the coordinate axis X The gradient of change, Represents the magnetic induction intensity component With the coordinate axis Y The gradient of change, Represents the magnetic induction intensity component With the coordinate axis The dotted box represents the selected effective positioning cube space (in terms of coil radius =180 , effectively locate the side length of the space =140 Taking a cube as an example), it is necessary to ensure that the change gradient of the magnetic induction intensity component in the selected positioning space is linear, and the magnetic induction intensity measurement range of the magnetic sensor should be greater than the maximum value in the dotted box.

[0035] The magnetic field space of the uniform gradient magnetic field is evenly divided into cube, and this The magnetic induction intensity components corresponding to the cubes are used as the primary index of the magnetic field simulation database. Based on the first division of the magnetic field space, the cubes represented by each primary index are evenly divided again. cubes, we get Secondary indexes are generated to complete the construction of the secondary-divided magnetic field simulation database. According to the requirements of M-level space division, it is determined whether the division of the M-level index is completed. If not, the next-level index of the current division work is repeatedly divided until the M-level space division is completed, and the construction of the M-level divided database is constructed.

[0036] Taking the secondary space partition when M=2 as an example, a secondary index magnetic field simulation database is constructed. The magnetic field space is evenly divided into cube, and this The group magnetic induction intensity component is used as the primary index of the database , whose data type is ,in For the primary indexes, a total of A first-level index. Represents the magnetic induction intensity component corresponding to the index value. Based on the first division of the magnetic field space, the cube represented by each primary index is evenly divided again into cubes, we get Secondary indexes , whose data type is ,in For secondary index Neutral and magnetic induction intensity The corresponding positioning coordinates are obtained, thereby completing the construction of the magnetic field simulation database.

[0037] Based on this, the magnetic field fingerprint positioning algorithm is: traverse the index files in the magnetic field simulation database level by level until the last level index file with the smallest Euclidean distance to the input of the magnetic field fingerprint positioning algorithm is obtained as the target index; obtain the coordinates of the cube corresponding to the target index.

[0038] Specifically, traverse the first-level index and compare the magnetic induction intensity component of the target object with the first-level index. The magnetic induction intensity components of the group are compared to obtain the next level index represented by the group of first-level indexes with the smallest Euclidean distance. Enter the corresponding next-level index file and compare the magnetic induction intensity components of the target object with those in the index file. The magnetic induction intensity components of the group are compared. If the index file at this time is the last level index, a group of index files with the smallest Euclidean distance is obtained, and its corresponding cube coordinates Otherwise, continue to enter the next level index of the index file until the last level index file is traversed to obtain the cube coordinates. By implementing multi-level space division and using a hierarchical retrieval algorithm, fast and accurate positioning can be achieved within a certain space. Moreover, this method will not change significantly with the change of the target object's position within the effective positioning range.

[0039] Taking the secondary space partition when M=2 as an example, we first traverse the magnetic field simulation database. A first-level index file that contains the magnetic induction intensity components of the target object. with the index file Compare the magnetic induction intensity components of the group and enter the secondary index represented by the group of index files with the smallest Euclidean distance middle:

[0040] in, Represents a secondary index, , and Respectively represent the target objects in x , y and z The magnetic induction intensity component in the direction, , and Respectively represent i Index files in x , y and z The magnetic induction intensity component in the direction, i Is the index number.

[0041] Enter the corresponding secondary index file In the above example, the magnetic induction intensity component of the target object is With the binary index file Compare the magnetic induction intensity components of the group to obtain a group of index files with the smallest Euclidean distance and obtain their corresponding cube coordinates :

[0042] in, , and Represents the binary index file exist x , y and z The component of magnetic induction intensity in the direction.

[0043] Correspondingly, the angle-compensated magnetic induction intensity component is used as input to determine the position coordinates of the target object in the uniform gradient magnetic field, including: traversing the index files in the magnetic field simulation database step by step until the last-level index file with the smallest Euclidean distance to the angle-compensated magnetic induction intensity component is obtained as the target index; obtaining the coordinates of the cube corresponding to the target index, and using the coordinates as the position coordinates of the target object.

[0044] In this implementation, after traversing level by level to obtain the last level index file, the last level index file with the smallest Euclidean distance is used as the target index, and the coordinates of the cube corresponding to the target index are obtained, and the coordinates are used as the position coordinates of the target object to achieve the positioning of the target object.

[0045] The present invention further provides an electromagnetic space positioning device. The electromagnetic space positioning device provided by the present invention is described below. The electromagnetic space positioning device described below and the electromagnetic space positioning method described above can be referred to each other. Figure 3 is a structural block diagram of the electromagnetic space positioning device provided by the present invention, such as Figure 3 As shown, the device comprises: An acquisition module 301 is used to acquire the position information and magnetic induction intensity component of a target object; the target object includes an inertial sensor and a magnetic sensor, and the target object is in a uniform gradient magnetic field; A compensation module 302 is used to perform angle compensation on the magnetic induction intensity component of the target object in combination with the position and posture information of the target object; The determination module 303 is used to call a pre-built magnetic field fingerprint positioning algorithm, take the angle-compensated magnetic induction intensity component as input, and determine the position coordinates of the target object in the uniform gradient magnetic field.

[0046] When the device is in use and needs to locate the target object, the acquisition module 301 acquires the current posture information of the target object through the inertial sensor in the target object, and acquires the magnetic induction intensity component of the target object in the current uniform gradient magnetic field through the magnetic sensor. Then, the compensation module 302 performs angle compensation on the magnetic induction intensity component of the target object in combination with the posture information of the target object, thereby reducing the interference of the magnetic field of the earth itself during the positioning process. Finally, the determination module 303 uses the angle-compensated magnetic induction intensity component as the input of the magnetic field fingerprint positioning algorithm to determine the coordinates of the target object. The device combines inertial measurement with magnetic sensor measurement, and performs angle compensation on the magnetic induction intensity component measured by the sensor, so that it can meet the spatial positioning requirements of 6 degrees of freedom, solving the problem of low positioning accuracy in the existing related technologies.

[0047] In addition, the present invention also provides an electromagnetic space positioning system. Figure 4 is a schematic diagram of the electromagnetic space positioning system provided by the present invention, such as Figure 4 As shown in FIG. 1 , the system demonstrates the practical application scenario of the electromagnetic space positioning method and device. The system includes two sets of Maxwell coils for generating a uniform gradient magnetic field. The radius of the Maxwell coil is R , the distance between the Maxwell coils is , the number of turns is , the wire diameter is , opposite currents are passed through , and simulate the uniform gradient magnetic field it generates, the number of turns and current of the Maxwell coil are set according to the magnetic field strength measurement range of the magnetic sensor. The system also includes a mobile positioning module, which corresponds to the target object in the above-mentioned electromagnetic space positioning method, including an inertial sensor and a magnetic sensor. The system also includes a calculation module, which corresponds to the above-mentioned electromagnetic space positioning device and is used to implement the above-mentioned electromagnetic space positioning method. In actual application scenarios, the calculation module receives the data transmitted by the mobile positioning module and performs target positioning on the mobile positioning module.

[0048] Figure 5 An example of a physical structure diagram of an electronic device is shown in FIG. Figure 5 As shown, the electronic device may include: a processor 501, a communications interface 502, a memory 503 and a communication bus 504, wherein the processor 501, the communications interface 502 and the memory 503 communicate with each other via the communication bus 504. The processor 501 may call the logic instructions in the memory 503 to execute the electromagnetic space positioning method, which includes: Acquiring position information and magnetic induction intensity components of a target object; the target object includes an inertial sensor and a magnetic sensor, and the target object is in a uniform gradient magnetic field; Combined with the position and posture information of the target object, the angle compensation is performed on the magnetic induction intensity component of the target object; The pre-built magnetic field fingerprint positioning algorithm is called, and the angle-compensated magnetic induction intensity component is used as input to determine the position coordinates of the target object in the uniform gradient magnetic field.

[0049] In addition, the logic instructions in the above-mentioned memory 503 can be implemented in the form of a software functional unit and can be stored in a computer-readable storage medium when it is sold or used as an independent product. Based on such an understanding, the technical solution of the present invention, in essence, or the part that contributes to the prior art or the part of the technical solution, can be embodied in the form of a software product, and the computer software product is stored in a storage medium, including a number of instructions for a computer device (which can be a personal computer, a server, or a network device, etc.) to perform all or part of the steps of the method described in each embodiment of the present invention. The aforementioned storage medium includes: U disk, mobile hard disk, read-only memory (ROM, Read-Only Memory), random access memory (RAM, Random Access Memory), disk or optical disk, etc. Various media that can store program codes.

[0050] On the other hand, the present invention further provides a computer program product, the computer program product comprising a computer program, the computer program can be stored on a non-transitory computer-readable storage medium, when the computer program is executed by a processor, the computer can execute the electromagnetic space positioning method provided by the above methods, the method comprising: Acquiring position information and magnetic induction intensity components of a target object; the target object includes an inertial sensor and a magnetic sensor, and the target object is in a uniform gradient magnetic field; Combined with the position and posture information of the target object, the angle compensation is performed on the magnetic induction intensity component of the target object; The pre-built magnetic field fingerprint positioning algorithm is called, and the angle-compensated magnetic induction intensity component is used as input to determine the position coordinates of the target object in the uniform gradient magnetic field.

[0051] In another aspect, the present invention further provides a non-transitory computer-readable storage medium having a computer program stored thereon, which is implemented when the computer program is executed by a processor to perform the electromagnetic space positioning method provided by the above methods, the method comprising: Acquiring position information and magnetic induction intensity components of a target object; the target object includes an inertial sensor and a magnetic sensor, and the target object is in a uniform gradient magnetic field; Combined with the position and posture information of the target object, the angle compensation is performed on the magnetic induction intensity component of the target object; The pre-built magnetic field fingerprint positioning algorithm is called, and the angle-compensated magnetic induction intensity component is used as input to determine the position coordinates of the target object in the uniform gradient magnetic field.

[0052] The device embodiments described above are merely illustrative, wherein the units described as separate components may or may not be physically separated, and the components displayed as units may or may not be physical units, that is, they may be located in one place, or they may be distributed on multiple network units. Some or all of the modules may be selected according to actual needs to achieve the purpose of the scheme of this embodiment. Ordinary technicians in this field can understand and implement it without paying creative labor.

[0053] Through the description of the above implementation methods, those skilled in the art can clearly understand that each implementation method can be implemented by means of software plus a necessary general hardware platform, and of course, can also be implemented by hardware. Based on this understanding, the above technical solution is essentially or the part that contributes to the prior art can be embodied in the form of a software product, and the computer software product can be stored in a computer-readable storage medium, such as ROM / RAM, a disk, an optical disk, etc., including a number of instructions for a computer device (which can be a personal computer, a server, or a network device, etc.) to execute the methods described in each embodiment or some parts of the embodiments.

[0054] Finally, it should be noted that the above embodiments are only used to illustrate the technical solutions of the present invention, rather than to limit it. Although the present invention has been described in detail with reference to the aforementioned embodiments, those skilled in the art should understand that they can still modify the technical solutions described in the aforementioned embodiments, or make equivalent replacements for some of the technical features therein. However, these modifications or replacements do not deviate the essence of the corresponding technical solutions from the spirit and scope of the technical solutions of the embodiments of the present invention.

Claims

1. An electromagnetic space positioning method, characterized in that: include: Obtaining the position information and magnetic induction intensity components of the target object; The target object includes an inertial sensor and a magnetic sensor, and the target object is in a uniform gradient magnetic field; Combining the position and posture information of the target object, performing angle compensation on the magnetic induction intensity component of the target object; A pre-built magnetic field fingerprint positioning algorithm is called, and the angle-compensated magnetic induction intensity component is used as input to determine the position coordinates of the target object in the uniform gradient magnetic field.

2. The electromagnetic space positioning method according to claim 1, characterized in that: Combining the position information of the target object, performing angle compensation on the magnetic induction intensity component of the target object includes: Determining a rotation matrix of the target object according to the position and posture information of the target object; The magnetic induction intensity component of the target object is adjusted and compensated by the rotation matrix of the target object.

3. The electromagnetic space positioning method according to claim 1, characterized in that: Constructing the magnetic field fingerprint positioning algorithm includes: Acquire a pre-built magnetic field simulation database; the magnetic field simulation database corresponds to the Maxwell coil that generates the uniform gradient magnetic field; Based on the magnetic field simulation database, the magnetic field fingerprint positioning algorithm is determined.

4. The electromagnetic space positioning method according to claim 3, characterized in that: The magnetic field simulation database includes index files of several levels; constructing the magnetic field simulation database includes: Determining coil parameters of the Maxwell coil, and simulating the uniform gradient magnetic field generated by the Maxwell coil; Dividing the magnetic field space of the uniform gradient magnetic field into a plurality of cubes, and using the magnetic induction intensity component of the magnetic field space of each cube as a primary index of the magnetic field simulation database; Re-dividing the cube corresponding to each of the primary indexes, and determining a corresponding number of secondary indexes; According to the level division requirement of the magnetic field simulation database, it is determined whether the index division work is completed. If not, the next level index of the current division work is segmented until the level division requirement is met.

5. The electromagnetic space positioning method according to claim 4, characterized in that: The coil parameters of the Maxwell coil include: radius, number of turns, wire diameter and current; the magnetic field space of the uniform gradient magnetic field is divided into a number of cubes, including: According to the number of turns of the Maxwell coil, the magnetic field space of the uniform gradient magnetic field is divided into a corresponding number of cubes.

6. The electromagnetic space positioning method according to claim 4, characterized in that: The magnetic field fingerprint positioning algorithm is: Traversing the index files in the magnetic field simulation database level by level until the last level index file with the smallest Euclidean distance to the input of the magnetic field fingerprint positioning algorithm is obtained as the target index; Get the coordinates of the cube corresponding to the target index.

7. The electromagnetic space positioning method according to claim 6, characterized in that: Taking the angle-compensated magnetic induction intensity component as input, determining the position coordinates of the target object in the uniform gradient magnetic field includes: Traversing the index files in the magnetic field simulation database level by level until obtaining the last level index file having the smallest Euclidean distance to the magnetic induction intensity component after angle compensation as the target index; The coordinates of the cube corresponding to the target index are obtained, and the coordinates are used as the position coordinates of the target object.

8. An electromagnetic space positioning device, characterized in that: include: An acquisition module is used to acquire the position information and magnetic induction intensity components of the target object; The target object includes an inertial sensor and a magnetic sensor, and the target object is in a uniform gradient magnetic field; A compensation module, used to perform angle compensation on the magnetic induction intensity component of the target object in combination with the position and posture information of the target object; The determination module is used to call a pre-built magnetic field fingerprint positioning algorithm, take the angle-compensated magnetic induction intensity component as input, and determine the position coordinates of the target object in the uniform gradient magnetic field.

9. An electronic device comprising a memory, a processor, and a computer program stored in the memory and executable on the processor, wherein: When the processor executes the program, the electromagnetic space positioning method as described in any one of claims 1 to 7 is implemented.

10. A non-transitory computer-readable storage medium having a computer program stored thereon, characterized in that: When the computer program is executed by a processor, the electromagnetic space positioning method according to any one of claims 1 to 7 is implemented.

Citation Information

Cited By

  • Method and device for determining positioning precision of electromagnetic positioning system

    CN120403711A