Positioning method and device based on specific electromagnetic field relation mapping and medium
By establishing a simulation model of the magnetic field environment and expanding Kalman filtering preprocessing technology, the problem of large amount of magnetic field positioning is solved, efficient and low-cost magnetic field positioning is achieved, and the reliability and stability of electromagnetic radiation positioning is improved.
Patent Information
- Application Number
- CN202411126121.0
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Filing Date
- 2024-08-16
- Publication Date
- 2024-11-22
AI Technical Summary
When the existing magnetic field positioning technology constructs a spatial mapping relationship between magnetic field intensity and direction, the calculation amount is large and complex, which limits its application in practical applications.
By establishing a simulation model of the target magnetic field environment, using multiple magnetic field sensor samples to obtain orderly readings, establish a coordinate system of the magnetic field intensity distribution map, and invert the space of the object to be measured in the magnetic field by expanding Kalman filtering preprocessing data, inverting the calculation of the space of the object to be measured in the magnetic field. Position, reduce the amount of calculation and prediction times.
It realizes efficient and low-cost magnetic field positioning, improves the reliability and stability of electromagnetic radiation positioning technology, and simplifies the magnetic field environment modeling process.
Smart Images

Figure CN119001556A_ABST
Abstract
Description
Technical Field
[0001] The present invention relates to the field of electromagnetic field positioning technology, and in particular to a positioning method, device and medium based on specific electromagnetic field relationship mapping. Background Art
[0002] As a vector field, the use of magnetic field measurement information for positioning and navigation has many unique advantages. First, the magnetic field can penetrate many common obstacles, so it can still achieve high positioning accuracy in an environment with obstructions. Secondly, the environmental adaptability of magnetic field positioning is better than GNSS. The magnetic field is not easily affected by environmental changes and can work stably in environments with large changes in temperature and humidity. Finally, the magnetic field positioning system has a low response delay and can achieve real-time positioning and navigation.
[0003] Due to these characteristics, magnetic field positioning systems show great potential in some specific application scenarios. For example, in complex environments such as between obstacles, at night or in bad weather, magnetic field positioning systems use a positioning method based on specific electromagnetic field relationship mapping, combined with magnetic field measurement information, to construct a spatial mapping relationship between magnetic field intensity and direction to achieve positioning and navigation. Such a method can not only overcome some of the shortcomings of GNSS, but also provide more reliable positioning services in complex and dynamic environments.
[0004] Nevertheless, magnetic field positioning also has some defects. It is difficult to implement magnetic field positioning and requires detailed mapping and modeling of the magnetic field environment, which may be time-consuming and complicated in practical applications, limiting the application of this technology. Since the calculation of the magnetic field strength at various locations in the environment is large and difficult, how to obtain a positioning model of the magnetic field strength through limited mapping is a matter of research. Summary of the invention
[0005] The purpose of the present invention is to provide a positioning method, device and medium based on specific electromagnetic field relationship mapping in order to overcome the defect of large amount of calculation in the above-mentioned prior art.
[0006] The purpose of the present invention can be achieved by the following technical solutions:
[0007] A positioning method based on specific electromagnetic field relationship mapping comprises the following steps:
[0008] S1: Establish a simulation model of the target magnetic field environment to obtain a magnetic field intensity distribution map, and establish a coordinate system for the magnetic field intensity distribution map;
[0009] S2: Use a magnetic field measurement device containing multiple magnetic field sensors, place it in the target magnetic field environment for sampling, and obtain ordered readings of the magnetic field sensors;
[0010] S3: establishing a spatial position relationship mapping table of the target magnetic field environment and the magnetic field intensity distribution map according to the ordered readings of the magnetic field sensor and the coordinate system of the magnetic field intensity distribution map;
[0011] S4: Place the object to be measured equipped with the same magnetic field measuring device as S2 into the target magnetic field environment, obtain the ordered readings of the magnetic field sensor of the object to be measured, and inversely calculate the spatial position of the object to be measured in the magnetic field according to the ordered readings of the magnetic field sensor of the object to be measured and the spatial position relationship mapping table.
[0012] Furthermore, the simulation model includes the physical area and size, medium, excitation, boundary conditions, and network segmentation structure of the magnetic field simulation.
[0013] Furthermore, the simulation model detects the sudden change position of the magnetic field intensity through gradient calculation. The calculation expression of the gradient is:
[0014]
[0015] In the formula, is the gradient, x is the abscissa of the magnetic field intensity distribution diagram, and y is the ordinate of the magnetic field intensity distribution diagram.
[0016] Furthermore, in step S3, the ordered readings of the magnetic field sensor are preprocessed, and the calculation expression of the preprocessing is:
[0017] x k+1 =f(x k ,u k )+w k
[0018] z k =h(x k )+v k
[0019] In the formula, x k is the state vector of the magnetic field sensor, u k is the control input, w k and v k are process noise and measurement noise, respectively, f(·) and h(·) are state transfer function and observation function, respectively. The calculation expression for the sensor reading in the magnetic field after preprocessing is:
[0020]
[0021]
[0022]
[0023]
[0024]
[0025]
[0026]
[0027] P k|k =(IK k H k ) k|k-1
[0028]
[0029] In the formula, is the predicted state, P k|k-1 is the covariance matrix of the prediction error, F k is the Jacobian matrix of the state transfer function, Q is the process noise covariance, R is the measurement noise covariance, y k is the error vector, S k is the innovation covariance matrix, K k is the Kalman gain, H k is the Jacobian matrix of the observation function, is the reading of the sensor in the magnetic field after preprocessing.
[0030] Furthermore, in step S4, the specific process of the inversion calculation is:
[0031] The magnetic field distribution function H(r) is known, where r = (x, y), which represents the position coordinates. The magnetic field sensor reading is H meas (i) Where i represents the i-th sensor, and the position r0 that makes the objective function at the minimum value is calculated. The calculation expression of the objective function is:
[0032]
[0033] In the formula, r i is the position of the i-th sensor relative to the center of the sampling structure, setting the initial position of the sampling structure in the magnetic field The optimization algorithm is used to iteratively solve the best position. The calculation expression for solving the best position is:
[0034]
[0035] Iteratively update the position r0, the corresponding update expression is:
[0036]
[0037] In the formula, α is the step size. In each iteration, the error of the current estimated position is calculated. The error calculation expression is:
[0038]
[0039] In the formula, E (k) is the error, when the error E (k) When it is less than the preset threshold or the error change rate is less than the preset threshold, the iteration is stopped to obtain the final position. The final position r is found to match the detection structure, and the matching degree between the estimated position and the actual position is measured by combining the Pearson correlation coefficient. The calculation expression of the final position r is:
[0040]
[0041] In the formula, is the mean of the estimated magnetic field values, It is the mean of the measured magnetic field values. Finally, the first three groups of data whose absolute values of the Pearson correlation coefficient are closest to 1 indicate that the object may be in the spatial location area.
[0042] Furthermore, the structure of the magnetic field measuring device is an I-shaped structure, and magnetic field sensors are arranged in order at four ends of the I-shaped structure.
[0043] Furthermore, the sensor data is preprocessed by an extended Kalman filter.
[0044] Furthermore, the target magnetic field environment is a vertical plane of the cable line.
[0045] In a second aspect of the present invention, a positioning device based on specific electromagnetic field relationship mapping includes a memory, a processor, and a program stored in the memory, and when the processor executes the program, it implements any of the above positioning methods based on specific electromagnetic field relationship mapping.
[0046] A third aspect of the present invention is a storage medium having a program stored thereon, which, when executed, implements any of the above positioning methods based on specific electromagnetic field relationship mapping.
[0047] Compared with the prior art, the present invention has the following beneficial effects:
[0048] 1) In the modeling process, the present invention uses a magnetic field detection device to obtain ordered readings in the magnetic field and constructs a spatial position relationship mapping table of the magnetic field intensity distribution diagram, thereby reducing the amount of calculation and the number of predictions required to convert the actual magnetic field environment into a quantifiable positioning model. In the positioning process, the spatial position relationship mapping table is matched according to the ordered readings of the magnetic field detection device, and the spatial position of the object to be measured in the magnetic field is obtained through inversion calculation, thereby achieving efficient and low-cost positioning.
[0049] 2) The present invention can further improve the reliability and stability of electromagnetic radiation positioning technology by matching multiple groups of sampling structures. BRIEF DESCRIPTION OF THE DRAWINGS
[0050] Figure 1 is a flow chart of a positioning method based on specific electromagnetic field relationship mapping provided by an embodiment of the present invention;
[0051] Figure 2 The positioning method based on specific electromagnetic field relationship mapping provided by the embodiment of the present invention performs a gridding structure and establishes a model to obtain a magnetic field intensity distribution map;
[0052] Figure 3 It is a spatial position distribution diagram after cutting according to the magnetic field intensity distribution diagram provided by an embodiment of the present invention;
[0053] Figure 4 This is an I-shaped structural diagram of the sampling sensor layout provided by an embodiment of the present invention;
[0054] Markings in the figure: 1, first magnetic field sensor, 2, second magnetic field sensor, 3, third magnetic field sensor, 4, fourth magnetic field sensor. DETAILED DESCRIPTION
[0055] The present invention is described in detail below in conjunction with the accompanying drawings and specific embodiments. This embodiment is implemented based on the technical solution of the present invention, and provides a detailed implementation method and specific operation process, but the protection scope of the present invention is not limited to the following embodiments.
[0056] Example 1
[0057] The present invention is a positioning method, device and medium based on specific electromagnetic field relationship mapping, such as Figure 1 As shown, the method comprises the following steps:
[0058] S1: Establish a simulation model of the target magnetic field environment to obtain a magnetic field intensity distribution map, and establish a coordinate system for the magnetic field intensity distribution map;
[0059] S1.1: Use the simulation software Maxwell to simulate a specific magnetic field, define the physical area and size of the magnetic field simulation, select the medium, excitation settings, boundary conditions, set the network segmentation structure, and establish a model to obtain the magnetic field intensity distribution diagram. The magnetic field intensity distribution diagram is as follows: Figure 2 shown.
[0060] S1.2 first uses the image segmentation method based on gradient information to identify the edges in the magnetic field intensity distribution map. Secondly, by calculating the gradient, the sudden change position of the magnetic field intensity can be detected. The calculation of the gradient can be achieved by solving the derivative of the field intensity, and the calculation expression is:
[0061]
[0062] In the formula, is the gradient, x is the abscissa of the magnetic field intensity distribution diagram, and y is the ordinate of the magnetic field intensity distribution diagram.
[0063] S1.3: Select the lower left corner of the image as the origin, the horizontal axis as the x-axis, and the vertical axis as the y-axis. The x-axis and y-axis intersect at the origin O and are perpendicular to each other. Place the sampling structure, which includes four sensors, in this rectangular coordinate system, ensuring that the sensors are parallel to the coordinate system. The coordinate of the magnetometer in the coordinate system is A i =(X i , Y i ), i=1, 2, 3,..., N, N≥4;
[0064] S1.4: According to the distribution diagram, the cut blocks are marked, and the blocks are marked from left to right as A1, A2, A3..., and the structural layout diagram is as follows: Figure 3 shown.
[0065] S2: Use a magnetic field measurement device containing multiple magnetic field sensors, place it in the target magnetic field environment for sampling, and obtain ordered readings of the magnetic field sensors;
[0066] S2.1: To ensure the accuracy and comprehensiveness of magnetic field data collection, use an I-shaped object for sampling, such as Figure 4 As shown. Placing the first magnetic field sensor 1, the second magnetic field sensor 2, the third magnetic field sensor 3, and the fourth magnetic field sensor 4 at the four ends of the sampling structure can maximize the use of edge data and reduce the impact of edge effects on measurement results. The ordered readings of each magnetic field sensor are recorded as:
[0067] S3: establishing a spatial position relationship mapping table of the target magnetic field environment and the magnetic field intensity distribution map according to the ordered readings of the magnetic field sensor and the coordinate system of the magnetic field intensity distribution map;
[0068] S3.1: The readings of the sensor may be affected by various noises and interferences. In order to improve the accuracy and reliability of the data, the raw data of the sensor needs to be preprocessed. The state equation and observation equation of the system are:
[0069] x k+1 =f(x k ,u k )+w k
[0070] z k =h(x k )+v k
[0071] In the formula, x k is the state vector of the system, u k is the control input, w kand v k are process noise and measurement noise respectively, their covariances are Q and R respectively, f(·) and h(·) are state transfer function and observation function respectively. By calculating the error vector, Kalman gain, innovation covariance matrix and Jacobian matrix of observation function, the reading of the sensor in the magnetic field after preprocessing is obtained. The calculation expression is:
[0072]
[0073]
[0074]
[0075]
[0076]
[0077]
[0078]
[0079] P k|k =(IK k H k ) k|k-1
[0080]
[0081] In the formula, is the predicted state, P k|k-1 is the covariance matrix of the prediction error, F k is the Jacobian matrix of the state transfer function, Q is the process noise covariance, R is the measurement noise covariance, y k is the error vector, S k is the innovation covariance matrix, K k is the Kalman gain, H k is the Jacobian matrix of the observation function, is the reading of the sensor in the magnetic field after preprocessing.
[0082] S3.2: The sampled values of the sensor in the magnetic field are marked as Where x is the mapping space area number, and a, b, c, and d correspond to the numbers of the sensors on the I-shaped object.
[0083] S3.3: Complete the mapping from magnetic field distribution to spatial position relationship according to S1.3 and S3.2, and obtain the magnetic field distribution reading φ i , where i is the corner mark that is marked from left to right according to the order of the blocks after the blocks are cut according to S1.4. Figure 3, and finally the spatial position relationship mapping table is obtained, as shown in Table 1.
[0084] Table 1 Spatial position relationship mapping table
[0085]
[0086] S4: Place the object to be measured equipped with the same magnetic field measuring device as S2 into the target magnetic field environment, obtain the ordered readings of the magnetic field sensor of the object to be measured, and inversely calculate the spatial position of the object to be measured in the magnetic field according to the ordered readings of the magnetic field sensor of the object to be measured and the spatial position relationship mapping table.
[0087] S4.1: Calculate the position of the sampling structure in the magnetic field using the inversion algorithm based on the magnetic field strength data measured by the magnetometer. Match the measured magnetic field data with the known magnetic field model to find the best fit position. Assume that the magnetic field distribution function H(r) is known, where r = (x, y), which represents the position coordinates, and the magnetic field sensor reading is H meas (i) Where i represents the i-th sensor, and the position r0 that makes the objective function at the minimum value is calculated. The calculation expression is:
[0088]
[0089] In the formula, r i is the position of the i-th sensor relative to the center of the sampling structure, setting the initial position of the sampling structure in the magnetic field Use the optimization algorithm to iteratively solve the best position, and the calculation expression is:
[0090]
[0091] Iteratively update the position r0, the corresponding update expression is:
[0092]
[0093] In the formula, α is the step size. In each iteration, the error of the current estimated position is calculated. The error calculation expression is:
[0094]
[0095] In the formula, E (k) is the error, when the error E (k) When it is less than the preset threshold or the error change rate is less than the preset threshold, the iteration is stopped to obtain the final position. The final position r is found to match the detection structure, and the matching degree between the estimated position and the actual position is measured by combining the Pearson correlation coefficient. The calculation expression of the final position r is:
[0096]
[0097] In the formula, is the mean of the estimated magnetic field values, It is the mean of the measured magnetic field values. Finally, the first three groups of data whose absolute values of the Pearson correlation coefficient are closest to 1 indicate that the object may be in the spatial location area.
[0098] In summary, the present invention provides a positioning method based on specific electromagnetic field relationship mapping. First, a suitable sampling structure is selected in a specific electromagnetic field to arrange a sensor array. These sensor arrays are used to sense and read electromagnetic field vector information in space to ensure that the electromagnetic field distribution characteristics can be captured comprehensively and accurately. According to the known specific electromagnetic field, a data table of electromagnetic field intensity distribution is established. The data table records the electromagnetic field signal characteristics at different positions in detail as the basis for subsequent positioning mapping calculations. Secondly, the data read by the sensor is preprocessed by an extended Kalman filter (EKF) to reduce the error of the sensor reading and the influence of various noises, which can improve the accuracy and reliability of the data and provide high-quality data input for subsequent positioning calculations. Finally, the preprocessed data is used to calculate and match the position of the object in the magnetic field. By comparing the electromagnetic field signal collected in real time with the electromagnetic field distribution data in the data table, the closest first three groups of sampling structures are found to perform position positioning. In this way, the position of the target can be effectively determined. The method can not only realize the positioning of the target position in the electromagnetic field, but also further improve the reliability and stability of the electromagnetic radiation positioning technology through the matching of multiple groups of sampling structures.
[0099] In this embodiment, in order to simplify observation, the partial magnetic field distribution in the vertical direction along a cable is taken as an example to illustrate the model, which does not represent a limitation on the applicable conditions of the present invention.
[0100] The program code for implementing the method of the present invention can be written in any combination of one or more programming languages. These program codes can be provided to a processor or controller of a general-purpose computer, a special-purpose computer or other programmable data processing device, so that the program code, when executed by the processor or controller, enables the functions / operations specified in the flow chart and / or block diagram to be implemented. The program code can be executed entirely on the machine, partially on the machine, partially on the machine as a stand-alone software package and partially on a remote machine, or entirely on a remote machine or server.
[0101] In the context of the present invention, a machine-readable medium may be a tangible medium that may contain or store a program for use by or in conjunction with an instruction execution system, device, or apparatus. A machine-readable medium may be a machine-readable signal medium or a machine-readable storage medium. A machine-readable medium may include, but is not limited to, an electronic, magnetic, optical, electromagnetic, infrared, or semiconductor system, device, or device, or any suitable combination of the foregoing. More specific examples of machine-readable storage media may include an electrical connection based on one or more wires, a portable computer disk, a hard disk, a random access memory (RAM), a read-only memory (ROM), an erasable programmable read-only memory (EPROM or flash memory), an optical fiber, a portable compact disk read-only memory (CD-ROM), an optical storage device, a magnetic storage device, or any suitable combination of the foregoing.
[0102] The preferred specific embodiments of the present invention are described in detail above. It should be understood that a person skilled in the art can make many modifications and changes based on the concept of the present invention without creative work. Therefore, any technical solution that can be obtained by a person skilled in the art through logical analysis, reasoning or limited experiments based on the concept of the present invention on the basis of the prior art should be within the scope of protection determined by the claims.
Claims
1. A positioning method based on specific electromagnetic field relationship mapping, It is characterized in that The following steps are involved: S1: Establish a simulation model of the target magnetic field environment to obtain a magnetic field intensity distribution map, and establish a coordinate system for the magnetic field intensity distribution map; S2: Use a magnetic field measurement device containing multiple magnetic field sensors, place it in a target magnetic field environment, and sample and obtain ordered readings of the magnetic field sensors; S3: establishing a spatial position relationship mapping table of the target magnetic field environment and the magnetic field intensity distribution map according to the ordered readings of the magnetic field sensor and the coordinate system of the magnetic field intensity distribution map; S4: Place the object to be measured equipped with the same magnetic field measuring device as S2 into the target magnetic field environment, obtain the ordered readings of the magnetic field sensor of the object to be measured, and inversely calculate the spatial position of the object to be measured in the magnetic field according to the ordered readings of the magnetic field sensor of the object to be measured and the spatial position relationship mapping table.
2. A positioning method based on specific electromagnetic field relationship mapping according to claim 1, It is characterized in that The simulation model includes the physical area and size, medium, excitation, boundary conditions, and network segmentation structure of the magnetic field simulation.
3. A positioning method based on specific electromagnetic field relationship mapping according to claim 1, It is characterized in that The simulation model detects the sudden change position of the magnetic field intensity by gradient calculation, and the calculation expression of the gradient is: In the formula, is the gradient, x is the abscissa of the magnetic field intensity distribution diagram, and y is the ordinate of the magnetic field intensity distribution diagram.
4. A positioning method based on specific electromagnetic field relationship mapping according to claim 1, It is characterized in that In step S3, the ordered readings of the magnetic field sensor are preprocessed, and the calculation expression of the preprocessing is: x k+1 =f(x k ,u k )+w k z k =h(x k )+v k In the formula, x k is the state vector of the magnetic field sensor, u k is the control input, w k and v k are process noise and measurement noise, respectively, f(·) and h(·) are state transfer function and observation function, respectively. The calculation expression for the sensor reading in the magnetic field after preprocessing is: In the formula, is the predicted state, P k|k-1 is the covariance matrix of the prediction error, F k is the Jacobian matrix of the state transfer function, Q is the process noise covariance, R is the measurement noise covariance, y k is the error vector, S k is the innovation covariance matrix, K k is the Kalman gain, H k is the Jacobian matrix of the observation function, is the reading of the sensor in the magnetic field after preprocessing.
5. A positioning method based on specific electromagnetic field relationship mapping according to claim 1, It is characterized in that In step S4, the specific process of the inversion calculation is: The magnetic field distribution function H(r) is known, where r = (x, y), which represents the position coordinates. The magnetic field sensor reading is H meas (i) where i represents the i-th sensor, and the position r that makes the objective function at the minimum value is calculated. 0 , the calculation expression of the objective function is: In the formula, r i is the position of the i-th sensor relative to the center of the sampling structure, setting the initial position of the sampling structure in the magnetic field The optimal position is iteratively solved using an optimization algorithm, and the calculation expression for solving the optimal position is: Iteratively update the position r 0 , the corresponding update expression is: Where α is the step size. In each iteration, the error of the current estimated position is calculated. The calculation expression of the error is: In the formula, E (k) is the error, when the error E (k) When it is less than the preset threshold or the error change rate is less than the preset threshold, the iteration is stopped to obtain the final position, and the final position r is found to match the detection structure, and the matching degree between the estimated position and the actual position is measured in combination with the Pearson correlation coefficient. The calculation expression of the final position r is: In the formula, is the mean of the estimated magnetic field values, It is the mean of the measured magnetic field values. Finally, the first three groups of data whose absolute values of the Pearson correlation coefficient are closest to 1 indicate that the object may be in the spatial location area.
6. A positioning method based on specific electromagnetic field relationship mapping according to claim 1, It is characterized in that The structure of the magnetic field measuring device is an I-shaped structure, and magnetic field sensors are arranged in order at four ends of the I-shaped structure.
7. A positioning method based on specific electromagnetic field relationship mapping according to claim 1, It is characterized in that The sensor data is preprocessed by an extended Kalman filter.
8. A positioning method based on specific electromagnetic field relationship mapping according to claim 1, It is characterized in that The target magnetic field environment is a vertical plane of the cable line.
9. A positioning device based on specific electromagnetic field relationship mapping, comprising a memory, a processor, and a program stored in the memory, It is characterized in that When the processor executes the program, the positioning method based on specific electromagnetic field relationship mapping as described in any one of claims 1-8 is implemented.
10. A storage medium having a program stored thereon, It is characterized in that When the program is executed, a positioning method based on specific electromagnetic field relationship mapping as described in any one of claims 1-8 is implemented.
Citation Information
Cited By
Flat panel detector positioning method, system and device and medium
CN119949869A
Positioning method and device, electronic equipment and storage medium
CN120212836A
