Micro electromagnetic positioning method and system and storage medium thereof

Abstract

The invention discloses a micro electromagnetic positioning method and system and a storage medium thereof. The method comprises the steps that sine wave currents with specific frequency differences simultaneously pass through three sets of magnetic source micro electromagnetic coils to excite sine wave magnetic fields in three dimensions; acquiring magnetic field data information of the positioning target in the sine wave magnetic field, wherein the magnetic field data information comprises a three-dimensional magnetic field component sensed by the positioning target in the sine wave magnetic field; fitting the three-dimensional magnetic field component of each dimension, and decomposing to obtain independent magnetic field signals of the three groups of magnetic source micro electromagnetic coils at the positioning target; and obtaining position and attitude information of the positioning target according to the independent magnetic field signal. According to the invention, three-dimensional sine wave magnetic fields with different frequencies can be excited at the same time, so that three-dimensional data can be generated by a positioning target, and positioning calculation is facilitated. In addition, a function fitting mode is adopted to assist in positioning calculation, high-frequency noise signals are suppressed and low-frequency background signals are separated at a time, superimposed magnetic field signal data with high accuracy are extracted, and the precision of a positioning system can be improved. According to the positioning method, the system is high in anti-interference capability, the calculation result is more accurate, the overall power consumption is low, and the cost is low.

Description

Technical Field

[0001] The present invention relates to the field of micro-electromagnetic positioning technology, and in particular to a micro-electromagnetic positioning method, system and storage medium thereof. Background Art

[0002] Capsule endoscopes are widely used in medical examinations and auxiliary diagnosis of the digestive tract. The digestive tract environment is tortuous and there are many factors that affect intestinal peristalsis, which leads to large individual differences in the movement time and process of the capsule endoscope in the digestive tract. The movement speed of the capsule in the digestive tract is uneven, and there are often local displacements and posture changes, which are also affected by digestive tract peristalsis and body movement. It is difficult to accurately establish the three-dimensional structure of the digestive tract and locate the physical position of the lesion only through the visual images taken by the capsule endoscope. Using magnetic positioning technology to position the capsule endoscope in the body can obtain the spatial position and posture information of the capsule in addition to the capsule image, which may help establish the three-dimensional structure of the digestive tract and locate the physical position of the lesion.

[0003] The existing magnetic positioning technologies for capsule endoscopes in the human body either require the human body to stay near a fixed positioning device, or the positioning device wraps most of the torso to affect human movement, or the high power consumption limits the sustainable positioning time or the timeliness of positioning, or the poor positioning accuracy makes it difficult to distinguish the overlapping small intestinal intestinal paths. The above magnetic positioning technologies have more or less defects such as poor portability, high energy consumption, low positioning frequency, and unsatisfactory positioning accuracy.

[0004] The existing magnetic positioning technology for capsule endoscopes in the human body mainly uses square wave pulse current to pass through the magnetic source coil to generate a corresponding square wave pulse magnetic field. The square wave pulse magnetic field has high power consumption and insufficient positioning endurance, which cannot meet the actual positioning needs. At the same time, it takes a certain amount of time for the square wave type sudden power supply to reach stability, that is, there is a step-like sudden change in the coil power supply (in fact, affected by the induced magnetic field, the current and magnetic field cannot change suddenly, but require a delay process, corresponding to the delay time), resulting in a long waiting time to measure the stable magnetic field amplitude, that is, the positioning cycle is long. On the one hand, it cannot meet the positioning frame rate requirements. On the other hand, due to the long positioning cycle, if the positioning target moves within a positioning cycle. The range is large, it will cause a large positioning error. In the prior art, there is also a method of using non-stationary curve characteristics to calibrate the curve transformation coefficient to obtain the amplitude of the square wave magnetic field. Although this can shorten the positioning cycle, the square wave amplitude error obtained is large, which ultimately leads to inaccurate positioning.

[0005] In the existing magnetic positioning technology for capsule endoscopes in the human body, in order to effectively reduce the power consumption of the square wave pulse magnetic field signal of the magnetic source and the negative impact of the square wave-like mutation magnetic field on the positioning accuracy, positioning technologies with sinusoidal magnetic field signals as the magnetic source have emerged one after another. Each independent sinusoidal magnetic field signal is obtained through Fourier decomposition, and then the position and posture of the positioning target are solved.

[0006] On the one hand, when the positioning target is far away from the magnetic source, the magnetic field measurement values ​​measured by the magnetic sensor of the positioning target are widely dispersed and the signal-to-noise ratio is low. Directly using the magnetic field measurement values ​​measured by the magnetic sensor of the positioning target for decomposition results in large noise and low positioning accuracy.

[0007] On the other hand, the positioning method of obtaining each independent sinusoidal magnetic field signal through Fourier decomposition has a very complex solution process, and has high requirements on the signal frequency setting of the magnetic source coil. For example, the signal frequency of the magnetic source coil is in multiple relationship, so that the highest signal frequency f of the magnetic source coil k Large, and the maximum sampling frequency f of the magnetic sensor s is limited, which results in an inability to obtain enough samples n (n≤f s / f k ), so the measured value of the magnetic sensor cannot accurately restore the actual magnetic field value, which ultimately leads to low positioning accuracy. In order to obtain an independent signal with higher accuracy through Fourier decomposition, it is necessary to obtain a sufficient number of samples. Obviously, it is impossible to obtain such a large number of samples in one cycle. Therefore, Fourier decomposition requires multiple periodic signals, that is, the required positioning cycle is longer. If the range of movement of the positioning target is large within one positioning cycle, it will lead to a large positioning error.

[0008] In summary, the existing magnetic positioning technology cannot meet the actual positioning requirements of capsule endoscopes. Summary of the invention

[0009] The purpose of the present invention is to provide a micro-electromagnetic positioning method, a positioning calibration method and a storage medium thereof, so as to solve the technical problems in the prior art that the magnetic positioning technology of capsule endoscopes has high power consumption, poor positioning accuracy, and takes a long time in positioning solution and has poor timeliness.

[0010] To achieve one of the above-mentioned purposes, an embodiment of the present invention provides a micro-electromagnetic positioning method, the method comprising:

[0011] Sinusoidal currents with specific frequency differences are passed through three groups of magnetic source micro-electromagnetic coils simultaneously to excite three-dimensional sinusoidal magnetic fields;

[0012] Acquire magnetic field data information of a positioning target in the sinusoidal magnetic field, wherein the magnetic field data information includes a three-dimensional magnetic field component sensed by the positioning target in the sinusoidal magnetic field;

[0013] Fitting the three-dimensional magnetic field component of each dimension, and decomposing to obtain independent magnetic field signals of three groups of magnetic source micro-electromagnetic coils at the positioning target;

[0014] The position and posture information of the positioning target are obtained according to the independent magnetic field signal.

[0015] As a further improvement of the present invention, the method further comprises:

[0016] The sinusoidal current with a specific frequency difference passes through three sets of magnetic source micro-electromagnetic coils at the same time to excite the three-dimensional sinusoidal magnetic field, specifically including:

[0017] Sinusoidal currents of different frequencies are preset, and the frequency of the sine wave current is f k Satisfy f ps ≤f k ≤f s / n, where f ps is the full-load positioning frame rate of the positioning system, f s is the sampling frequency of the magnetic sensor, and n is the number of samples that can be achieved within one cycle of a sinusoidal wave signal.

[0018] As a further improvement of the present invention, the method further comprises:

[0019] The sinusoidal current with a specific frequency difference passes through three sets of magnetic source micro-electromagnetic coils at the same time to excite the three-dimensional sinusoidal magnetic field, specifically including:

[0020] Preset sinusoidal currents of different frequencies, wherein the sinusoidal currents include a first sinusoidal current with a frequency of f1, a second sinusoidal current with a frequency of f2, and a third sinusoidal current with a frequency of f3, wherein f2=f1+δ, f3=f2+δ, and δ is a frequency difference;

[0021] The corresponding magnetic source micro-electromagnetic coil is excited according to the sinusoidal current to generate the sinusoidal magnetic field.

[0022] As a further improvement of the present invention, the method further comprises:

[0023] The fitting of the three-dimensional magnetic field component of each dimension specifically includes: performing function fitting on the magnetic field measurement values ​​of the dispersed three-dimensional magnetic field components to obtain the magnetic field intensity B in the corresponding dimension s (t);

[0024] The decomposition to obtain the independent magnetic field signals of the three groups of magnetic source micro-electromagnetic coils at the positioning target includes: the magnetic field strength B after decomposition and fitting s (t), obtain the magnetic induction intensity amplitude A of the independent magnetic field signals of the three groups of magnetic source micro electromagnetic coils at the positioning target k；s , the decomposition formula is:

[0025]

[0026] Wherein, k represents the serial number of the magnetic source micro-electromagnetic coil, k=1, 2, 3; s=1, 2, 3, represents the three dimensions of the sinusoidal magnetic field, representing the X direction, the Y direction, and the Z direction respectively; A k；s is the magnetic induction intensity amplitude of the independent magnetic field signals of the three groups of magnetic source micro-electromagnetic coils at the positioning target to be determined and decomposed, that is, the magnetic field measurement peak value; c s is the background magnetic field component; the signal angular frequency w k , signal phase b k It is a known quantity directly obtained based on the frequency value and phase value of the current data.

[0027] As a further improvement of the present invention, the method further comprises:

[0028] The decomposition formula is linearized to obtain the linearized decomposition formula:

[0029]

[0030] Among them, β 0；s X0 represents the three-dimensional magnetic field strength at the positioning target when the three groups of magnetic source micro-electromagnetic coils are not powered on, that is, the ambient magnetic field strength at the positioning target; β 1；s X1, β 2；s X2, β 3；s X3 represents the three-dimensional magnetic field strength of the independent magnetic field signals of the three groups of magnetic source micro-electromagnetic coils at the positioning target;

[0031] Using a series of data at time t, {X k (t),B s (t)}, and solve the coefficient β through linear optimization k；s Then, calculate the required magnetic induction intensity amplitude A k；s and background magnetic field c s .

[0032] As a further improvement of the present invention, the method further comprises:

[0033] Acquiring the position and attitude information of the positioning target according to the independent magnetic field signal specifically includes:

[0034] The spatial distribution of magnetic induction intensity is simplified by using the magnetic dipole approximation. The calculation formula for the peak value of magnetic induction intensity is:

[0035]

[0036] Where μ0 is the vacuum magnetic permeability; M kis the peak value of the equivalent magnetic moment after the kth coil is energized, is the unit vector of the equivalent magnetic moment of the kth coil, k = 1, 2, 3; is the spatial position vector; is the spatial position unit vector;

[0037] According to the peak value of magnetic induction intensity Obtain the theoretical value of the magnetic induction intensity peak matrix

[0038]

[0039] The position and attitude information of the positioning target are obtained by solving the corresponding relationship between the theoretical value of the magnetic induction intensity peak matrix and the magnetic field measurement peak in the independent magnetic field signal through a nonlinear optimization algorithm; wherein the corresponding relationship is:

[0040]

[0041] in, A is the sensor attitude rotation matrix; k；s Measure the peak value of the magnetic field; is the theoretical value of the magnetic induction intensity peak matrix;

[0042] The nonlinear optimization algorithm is:

[0043]

[0044] As a further improvement of the present invention, the method further comprises:

[0045] The pitch angle pitch and the roll angle roll of the positioning target are obtained, and the yaw angle yaw and the position coordinates of the positioning target are calculated according to the pitch angle pitch, the roll angle roll of the positioning target and the independent magnetic field signal.

[0046] As a further improvement of the present invention, the method further comprises:

[0047] The positioning target includes at least one main positioning target and N auxiliary positioning targets. The micro-electromagnetic positioning method also includes a positioning calibration method, and the specific steps include:

[0048] Calculate the position information of N (N≥2) auxiliary positioning targets multiple times within a preset time length and calculate the average position of the N (N≥2) auxiliary positioning targets;

[0049] Calculating the position information of the main positioning target and the position information of the N (N≥2) auxiliary positioning targets after a preset time period;

[0050] Construct a scaling and rotation change matrix W*S to calibrate the position information of the main positioning target in the target detection area.

[0051] As a further improvement of the present invention, the method further comprises:

[0052] The position information of N (N≥2) auxiliary positioning targets is calculated multiple times within a preset time period, and is obtained when the human body is in an upright standard posture. The preset time period is 1 minute.

[0053] As a further improvement of the present invention, the method further comprises:

[0054] The construction of the scaling and rotation change matrix W*S satisfies Solve the transformation matrix by pseudo-inverse operation

[0055] in, The D N1 The position information of N (N≥2) auxiliary positioning targets obtained by multiple calculations within the preset time length, The set matrix of average positions of N (N≥2) auxiliary positioning targets is obtained by calculating the position information of N (N≥2) auxiliary positioning targets for multiple times within the preset time length; The D N2 is the location information of N (N≥2) auxiliary positioning targets calculated after the preset time period, is a collection matrix of position information of N (N≥2) auxiliary positioning targets calculated after the preset time length;

[0056] The calibrating the position information of the main positioning target in the target detection area specifically includes calibrating the position information C2 of the main positioning target calculated after a preset time period to obtain new position information C, satisfying C=W·S·C2.

[0057] As a further improvement of the present invention, the method further comprises:

[0058] The number of auxiliary positioning targets N=2, 3, 4.

[0059] In order to achieve one of the above-mentioned objects, the present invention further provides a micro-electromagnetic positioning system, the system comprising:

[0060] A magnetic field generating component, comprising three groups of magnetic source micro-electromagnetic coils arranged on an excitation magnetic core, wherein the magnetic source micro-electromagnetic coils are used to receive a sinusoidal current and generate a three-dimensional sinusoidal magnetic field;

[0061] A positioning target includes a three-dimensional magnetic sensor for receiving the sinusoidal magnetic field and sensing a three-dimensional magnetic field component;

[0062] A positioning processing component, electrically connected to the magnetic field generating component and the positioning target;

[0063] The positioning processing component is configured to implement the micro-electromagnetic positioning method as described above.

[0064] As a further improvement of the present invention, the system further comprises:

[0065] The three groups of magnetic source micro-electromagnetic coils are orthogonal to each other, and their centers coincide with the center of the excitation magnetic core.

[0066] As a further improvement of the present invention, the system further comprises:

[0067] It also includes a waist belt, a fixing belt and a connecting cable bundle, the positioning target includes at least a main positioning target and N auxiliary positioning targets, the N auxiliary positioning targets are spaced apart from the magnetic field generating component on the waist belt to form a target detection area, the positioning processing component is installed on the fixing belt, the positioning processing component is electrically connected to the magnetic field generating component through the connecting cable bundle, and excites the magnetic field generating component to generate a three-dimensional sinusoidal wave magnetic field, and the main positioning target is located in the target detection area.

[0068] As a further improvement of the present invention, the system further comprises:

[0069] The fixing strap is a leg strap, and the positioning processing component is installed on the leg strap.

[0070] The present invention also provides a storage medium, wherein the storage medium stores a computer program, and when the computer program is executed by a processor, the steps in the micro-electromagnetic positioning method as described above are implemented.

[0071] Compared with the prior art, the present invention has the following beneficial effects: the present invention can simultaneously excite three-dimensional sinusoidal magnetic fields of different frequencies, so that the positioning target can generate three-dimensional data for easy positioning and solution. The present invention also uses function fitting to assist in positioning and solution, suppresses high-frequency noise signals and separates low-frequency background signals at one time, extracts highly accurate superimposed magnetic field signal data, and can improve the accuracy of the positioning system. The positioning method and system of the present invention have strong anti-interference capabilities, more accurate solution results, lower overall power consumption, and low cost. BRIEF DESCRIPTION OF THE DRAWINGS

[0072] Figure 1 It is a flow chart of a micro-electromagnetic positioning method in one embodiment of the present invention.

[0073] Figure 2 It is a flow chart of fitting magnetic field data information and decomposing it to obtain independent magnetic field signals in one embodiment of the present invention.

[0074] FIG3( a ) is a diagram showing a fitting waveform of a magnetic field measured by a magnetic field sensor close to a magnetic source and a waveform diagram of an independent magnetic field signal obtained by decomposition in accordance with an embodiment of the present invention.

[0075] FIG3( b ) is a diagram showing a fitting waveform of a magnetic field measured by a magnetic field sensor far away from a magnetic source and a waveform of an independent magnetic field signal obtained by decomposition in accordance with an embodiment of the present invention.

[0076] Figure 4 It is a flow chart for solving the position and posture information of the positioning target in one embodiment of the present invention.

[0077] Figure 5 It is a positioning calibration flow chart in one embodiment of the present invention.

[0078] Figure 6 It is a schematic structural diagram of a micro-electromagnetic positioning system in one embodiment of the present invention.

[0079] Figure 7 Schematic diagram of a waist belt of a micro-electromagnetic positioning system in one embodiment of the present invention.

[0080] Figure 8 It is a schematic diagram of the position change of N auxiliary positioning target calibrations in one embodiment of the present invention.

[0081] Fig. 9 It is a schematic diagram of the structure of a magnetic field generating component in one embodiment of the present invention.

[0082] Fig.10 It is a schematic diagram of the overall structural connection of a micro electromagnetic positioning system in one embodiment of the present invention.

[0083] Fig.11 It is a computer system structure block diagram of the storage medium suitable for implementing the implementation mode of the present application in the present invention. DETAILED DESCRIPTION

[0084] The present invention will be described in detail below in conjunction with the specific embodiments shown in the accompanying drawings. However, these embodiments do not limit the present invention, and any structural, methodological, or functional changes made by a person skilled in the art based on these embodiments are all within the scope of protection of the present invention.

[0085] like Figure 1 As shown, in one embodiment of the present invention, a micro-electromagnetic positioning method is provided, which can be applied to the positioning of capsule endoscopes during gastrointestinal medical examinations and auxiliary diagnosis. A target detection area is formed by a sinusoidal magnetic field of the micro-electromagnetic positioning method, and the capsule endoscope is located and active in the target detection area. The micro-electromagnetic positioning method can calculate the position and posture of the capsule endoscope in the target detection area; wherein, the capsule endoscope is identified as a positioning target in the target detection area.

[0086] Specifically, the micro-electromagnetic positioning method includes:

[0087] S1: Sinusoidal currents with specific frequency differences pass through three sets of magnetic source micro-electromagnetic coils simultaneously to excite three-dimensional sinusoidal magnetic fields.

[0088] S2: Acquire magnetic field data information of the positioning target in the sinusoidal magnetic field, wherein the magnetic field data information includes three-dimensional magnetic field components sensed by the positioning target in the sinusoidal magnetic field.

[0089] S3: Fitting the three-dimensional magnetic field component of each dimension, and decomposing to obtain independent magnetic field signals of three groups of magnetic source micro-electromagnetic coils at the positioning target.

[0090] S4: Obtaining the position and posture information of the positioning target according to the independent magnetic field signal.

[0091] In step S1, sinusoidal currents with specific frequency differences are simultaneously passed through three groups of magnetic source micro-electromagnetic coils to respectively excite three-dimensional sinusoidal magnetic fields. Correspondingly, there are three sinusoidal currents with different frequencies.

[0092] Sine wave frequency f k There is a reasonable range of values ​​that satisfies f ps ≤f k ≤f s / n. Sine wave f k The lower frequency limit is affected by the full load positioning frame rate f of the positioning system ps Limitations, for example, if the positioning system wants to achieve a full-load positioning frame rate of 20fps, a sine wave frequency f is required. k Approximately not less than 20Hz. Sine wave frequency f k The upper limit is limited by the magnetic sensor sampling frequency f s Limit, f k ≤f s / n, to ensure that n sampling times (for example, n ≥ 30) can be achieved within a sine wave signal cycle, thereby reducing the sine wave signal fitting variance and improving the positioning accuracy of the positioning system. For example, the magnetic sensor sampling frequency is 1kHz, the number of sampling points n = 30, then the sine wave frequency f k No more than 33Hz.

[0093] Sinusoidal currents of different frequencies are preset, and the sinusoidal currents include a first sinusoidal current with a frequency of f1, a second sinusoidal current with a frequency of f2, and a third sinusoidal current with a frequency of f3, wherein f2=f1+δ, f3=f2+δ, and δ is the frequency difference.

[0094] It should be noted that the frequency difference δ is as small as possible under the premise of satisfying the signal discrimination, so as to increase the number of sampling points in a single-cycle signal and reduce the signal fitting variance.

[0095] For example, the frequencies of the three coils can be set to f1 = 20 Hz, f2 = 23 Hz, and f3 = 26 Hz. In another embodiment, the frequency differences δ of the three coils can also be set to be different, and the frequencies can also be set to other reasonable value combinations with safe frequencies and low frequency interference.

[0096] The coil of the corresponding magnetic source micro-electromagnet is excited according to the sinusoidal current to generate a sinusoidal magnetic field.

[0097] In this way, sinusoidal magnetic fields are excited respectively based on three sinusoidal currents of different frequencies so that the positioning target generates distinguishable magnetic field data information. The three-dimensional magnetic field components in the magnetic field data information can be effectively identified according to the magnetic field frequency, which can also be further facilitated for subsequent decomposition.

[0098] In step S2, the magnetic field data information of the positioning target in the sinusoidal magnetic field is obtained, and the magnetic field data information includes the three-dimensional magnetic field component sensed by the positioning target in the sinusoidal magnetic field. The three-dimensional magnetic field component sensed by the positioning target is the superposition magnetic field of the three-dimensional sinusoidal magnetic field excited by the three groups of magnetic source micro-electromagnetic coils respectively when the three groups of magnetic source micro-electromagnetic coils are energized at the same time and the ambient magnetic field.

[0099] like Figure 2 As shown, in one embodiment of the present invention, the fitting of the three-dimensional magnetic field component of each dimension in step S3 specifically includes:

[0100] The magnetic field strength B in the corresponding dimension is obtained by performing function fitting on the magnetic field measurement values ​​of the dispersed three-dimensional magnetic field components. s (t);

[0101] The decomposition in step S3 to obtain independent magnetic field signals of three groups of magnetic source micro-electromagnetic coils at the positioning target includes:

[0102] The magnetic field strength B after decomposition fitting s (t), obtain the magnetic induction intensity amplitude A of the independent magnetic field signals of the three groups of magnetic source micro electromagnetic coils at the positioning target k；s , the decomposition formula is:

[0103]

[0104] Wherein, k represents the serial number of the magnetic source micro-electromagnetic coil, k=1, 2, 3; s=1, 2, 3, represents the three dimensions of the sinusoidal magnetic field, representing the X direction, the Y direction, and the Z direction respectively; A k；sis the magnetic induction intensity amplitude of the independent magnetic field signals of the three groups of magnetic source micro-electromagnetic coils at the positioning target to be determined and decomposed, that is, the magnetic field measurement peak value; c s is the background magnetic field component; the signal angular frequency w k , signal phase b k It is a known quantity directly obtained based on the frequency value and phase value of the current data.

[0105] In one embodiment of the present invention, the decomposition formula may be linearized to obtain a linearized decomposition formula:

[0106]

[0107] Among them, β 0；s X0 represents the three-dimensional magnetic field strength at the positioning target when the three groups of magnetic source micro-electromagnetic coils are not powered on, that is, the ambient magnetic field strength at the positioning target; β 1；s X1, β 2；s X2, β 3；s X3 represents the three-dimensional magnetic field strength of the magnetic field signals of the three groups of magnetic source micro-electromagnetic coils at the positioning target, that is, the three-dimensional magnetic field strength of the independent magnetic field signals of the three groups of magnetic source micro-electromagnetic coils at the positioning target;

[0108] Using a series of data at time t, {X k (t),B s (t)}, and solve the coefficient β through linear optimization k；s Then, calculate the required magnetic induction intensity amplitude A k；s and background magnetic field c s When the corresponding time and magnetic field strength are obtained, the independent magnetic field signal of the dimension can be directly retrieved for solution, thereby improving the speed of system operation or system program calculation.

[0109] Further, as shown in Figure 3(a) and Figure 3(b), the three groups of coils are energized at the same time to generate a superimposed vector magnetic field, and the composite waveform of the magnetic field measured by the three-axis magnetic sensor and the waveform of the independent magnetic field signal sinusoidal component obtained after the composite waveform of the magnetic field is decomposed are shown as examples. The three columns on the left of Figure 3(a) and Figure 3(b) are the scattered data and fitting curves of the three-axis measurement values ​​[Bx, By, Bz] of the magnetic sensor, and the curves are translated to the fitting constant as the central axis. The three columns on the right of Figure 3(a) and Figure 3(b) are the independent magnetic field signal sinusoidal components corresponding to the three groups of coils, and there are differences in amplitude. The three groups of coils are energized at the same time to generate a superimposed vector magnetic field, which is decomposed to generate 3x3=9 sinusoidal wave signals, which are the independent magnetic field signals of the three groups of coils obtained simultaneously by the one-time measurement of the three-axis magnetic sensor. This method of simultaneously obtaining decomposed signals can improve the positioning frame rate and real-time performance of the system.

[0110] The measured magnetic field values ​​and fitting curves in Figure 3(a) are close to the magnetic source and have a small dispersion, with a high signal-to-noise ratio. The measured magnetic field values ​​and fitting curves in Figure 3(b) are far from the magnetic source and have a large dispersion, with a low signal-to-noise ratio. Function fitting can effectively suppress high-frequency noise and eliminate low-frequency background interference. For portable positioning application scenarios with strict low-power requirements, a sine wave power supply is used to generate the magnetic field of the magnetic source, and a function fitting method is used to suppress high-frequency noise signals and separate low-frequency background signals at one time, extracting high-accuracy superimposed magnetic field signal data B. s (t), can improve the accuracy of the positioning system.

[0111] Furthermore, the sinusoidal current of the coil is synchronized with the generated sinusoidal magnetic field. The phase and frequency of the corresponding independent magnetic field signal after separation can be directly obtained based on the known current phase and frequency. That is, the phase and frequency of the independent magnetic field signal are preset known quantities, and the magnetic induction intensity amplitude A of the independent magnetic field signal needs to be solved. k；s In the present invention, the superimposed magnetic field signal data B is decomposed according to the preset frequency s (t), other unimportant signals are thrown to c s The background magnetic field item, including low-frequency and high-frequency signals (that is, signals that do not belong to the frequency of independent magnetic field signals), can decompose the independent magnetic field signal data with high accuracy, which can improve the accuracy of the positioning system.

[0112] In one embodiment of the present invention, step S4 of obtaining the position and attitude information of the positioning target according to the independent magnetic field signal specifically includes:

[0113] Three sets of orthogonal coils can obtain 3x3=9 independent magnetic induction intensity amplitudes A k；s , which is sufficient to calculate the 6DOF position and attitude information of the magnetic sensor at its spatial position.

[0114] When the size of the magnetic source coil is small, the spatial distribution of the magnetic induction intensity can be simplified by using the magnetic dipole approximation. The calculation formula for the peak value of the magnetic induction intensity is:

[0115]

[0116] Where μ0 is the vacuum magnetic permeability; M k is the peak value of the equivalent magnetic moment after the kth coil is energized, is the unit vector of the equivalent magnetic moment of the kth coil, k = 1, 2, 3; is the spatial position vector; is the spatial position unit vector;

[0117] According to the peak value of magnetic induction intensity Obtain the theoretical value of the magnetic induction intensity peak matrix Specifically, the peak magnetic induction intensity It can be expressed as a matrix component form Where k is the magnetic source coil number, and s is the three-dimensional component measured by the three-axis magnetic sensor. For the magnetic source of the three sets of coils, is a 3x3 matrix. It should be noted that the magnetic induction intensity Equivalent to the theoretical value of the magnetic induction intensity peak matrix

[0118] The position and attitude information of the positioning target are obtained by solving the corresponding relationship between the theoretical value of the magnetic induction intensity peak matrix and the magnetic field measurement peak in the independent magnetic field signal through a nonlinear optimization algorithm; wherein the corresponding relationship is:

[0119]

[0120] in, A is the sensor attitude rotation matrix; k；s Measure the peak value of the magnetic field; is the theoretical value of the magnetic induction intensity peak matrix;

[0121] The sensor attitude rotation matrix can be uniquely determined by rotating the Euler angles yaw, pitch, and roll (the order of Euler angle rotation only needs to be consistent in the formula system, there is no special order requirement, and the ZYX order can generally be selected according to convention).

[0122] The following parameter optimization problem is solved by nonlinear optimization algorithm (such as LM algorithm, etc.):

[0123]

[0124] In the nonlinear optimization algorithm, the position information X, Y, Z and 3DOF attitude angles yaw (yaw angle), pitch (pitch angle) and roll (roll angle) of the positioning target are calculated based on the known theoretical value of the magnetic induction intensity peak matrix and the known magnetic field measurement peak value.

[0125] In one embodiment of the present invention, it also includes: obtaining the pitch angle pitch and roll angle roll of the positioning target, and calculating the yaw angle yaw and the position coordinates of the positioning target according to the pitch angle pitch, roll angle roll of the positioning target and the independent magnetic field signal.

[0126] Specifically, the pitch angle and roll angle of the capsule endoscope (positioning target) can be directly obtained with higher accuracy through additional devices such as IMU (inertial measurement unit). The pitch angle and roll angle are used as known input parameters. This can reduce the number of unknown parameters (from 6 to 4), further simplify the above nonlinear solution, and improve the efficiency of positioning solution.

[0127] It is further explained that, since the orthogonal magnetic source coil has the geometric feature of central symmetry, the magnetic field distribution of the magnetic source has central symmetry about the origin, and the above positioning results cannot distinguish the 3DOF position points (+x, +y, +z) and (-x, -y, -z) that are centrally symmetric about the origin. The central symmetry can be eliminated by limiting the positioning area to a half-space (for example, Y>0 or Z>0, etc.), so that the positioning solution result is uniquely determined. For example, when the positioning area is limited to a half-space Z>0, if z<0 in the solution result (x, y, z), the position result can be remapped to (-x, -y, -z).

[0128] Through the above positioning solution method, target positioning based on the micro-electromagnetic positioning method can be achieved.

[0129] It should be noted that in the capsule endoscope application scenario, the positioning target includes the capsule endoscope, but in other embodiments, it not only includes the capsule endoscope, for example, includes the auxiliary positioning reference point.

[0130] The relative position and posture of the magnetic source relative to the capsule caused by the changes in the posture of the human body and the fluctuation of the abdomen during breathing may cause the capsule positioning results to be misplaced or fluctuate ( Figure 8 ), which affects the positioning of the capsule in the intestine and the reconstruction of the trajectory, causing the positioning tail to be blurred. In order to further enhance the stability of the positioning system, additional auxiliary positioning reference points are used to perform online calibration of the positioning results.

[0131] The principle of online calibration of positioning results is based on the change of fixed reference point represented by three-dimensional scaling transformation S and three-dimensional rotation change W around the origin. x ,s y ,s z ), which represents the three-dimensional expansion and contraction of the human abdomen in the three spatial directions of X, Y, and Z, caused by the displacement of flexible organs in the body and the rise and fall of the abdomen due to the change in lung volume during breathing; W can be uniquely represented by three rotational Euler angles, which approximately represents the influence of posture changes such as twisting and tilting of the human trunk. There are a total of 6 parameters to be determined, and at least N (N≥2) positioning reference points are required to determine the spatial distortion characteristics of this positioning.

[0132] like Figure 6-8As shown, in one embodiment of the present invention, the positioning target includes at least one main positioning target 3 and N (N≥2) auxiliary positioning targets 103, 104, 105, 106... (i.e., auxiliary positioning reference points), and the micro-electromagnetic positioning method also includes a positioning calibration method, and the specific steps include:

[0133] S4.1: Calculate the position information of N (N≥2) auxiliary positioning targets 103, 104, 105, 106, ... for multiple times within a preset time period and calculate the average position of the N (N≥2) auxiliary positioning targets;

[0134] S4.2: Calculate the position information of the main positioning target 3 and the position information of the N (N≥2) auxiliary positioning targets 103, 104, 105, 106, ... after a preset time period;

[0135] S4.3: Construct a scaling and rotational change matrix W*S to calibrate the position information of the main positioning target 3 within the target detection area.

[0136] The center of the magnetic source is taken as the coordinate origin O (in actual situations, because breathing causes the internal organs to squeeze and the abdomen to rise and fall, the magnetic source center fluctuates, and other positioning points move relative to O). At time T1, the capsule positioning point C1, and the N positioning reference points are (In actual use, only some reference points may be enabled, for example, D11 and D21); at time T2, capsule positioning point C2, the N positioning reference points are

[0137] Under the statistical average state of abdominal respiratory fluctuations, the relative positions of OD1, OD2, OD3, OD4...ODN are approximately constant. By changing the relative positions of OD1, OD2, OD3, OD4...ODN, the relative position of OC can be corrected in real time, significantly reducing the influence of the large fluctuations in the positioning result of capsule C caused by the fluctuations of the human abdomen.

[0138] Preferably, in the step S4.1, the position information of N (N≥2) auxiliary positioning targets 103, 104, 105, 106, ... is calculated multiple times within a preset time period and is obtained when the human body is in an upright standard posture.

[0139] Preferably, the preset duration is 1 minute.

[0140] Specifically, when the human body is in an upright standard posture, the average position of the positioning reference points D1, D2, D3, D4, ..., DN over a period of time (e.g., 1 minute) is counted as the standard position of the positioning result. At the next moment T2, the capsule positioning point C2 and the N positioning reference points are

[0141] The construction of the scaling and rotational change matrix W*S in step S4.3 satisfies Solve the transformation matrix by pseudo-inverse operation

[0142] in, The D N1 The position information of N (N≥2) auxiliary positioning targets obtained by multiple calculations within the preset time length, The set matrix of average positions of N (N≥2) auxiliary positioning targets is obtained by calculating the position information of N (N≥2) auxiliary positioning targets for multiple times within the preset time length; The D N2 is the location information of N (N≥2) auxiliary positioning targets calculated after the preset time period, is a collection matrix of position information of N (N≥2) auxiliary positioning targets calculated after the preset time length;

[0143] The calibrating the position information of the main positioning target in the target detection area specifically includes calibrating the position information C2 of the main positioning target calculated after a preset time period to obtain new position information C, satisfying C=W·S·C2.

[0144] The above positioning point set P is a 3xN matrix (each positioning reference point is a 3x1 vector, and N reference points constitute a 3xN matrix), and W and S are 3x3 matrices. Therefore, the instant positioning result C2 of the capsule can be calibrated as C=W·S·C2.

[0145] Preferably, the number of auxiliary positioning reference points N = 2, 3, 4. Using 2-4 positioning reference points (see Figure 7-8 ), plus a magnetic source center point as the coordinate origin O, can achieve a better correction effect of the positioning result. A large number of positioning reference points can reduce interference and provide better correction effects, but it will increase the hardware communication overhead and positioning solution overhead. In general, it is a reasonable choice to use no more than 4 positioning reference points. In actual use, you can choose to enable only some (no less than 2).

[0146] Through the above calibration method, the distortion of capsule positioning results caused by changes in the internal organs and external torso of the human body can be eliminated, and a more stable correction positioning result can be obtained.

[0147] like Figure 6 and Figure 7As shown, in one embodiment of the present invention, a micro-electromagnetic positioning system is also provided, which can excite and generate a sinusoidal magnetic field, and the positioning target can obtain a three-dimensional magnetic field component in the sinusoidal magnetic field to facilitate positioning and solving to obtain the position and posture information of the positioning target. Specifically including:

[0148] The magnetic field generating assembly 102 includes three groups of magnetic source micro electromagnetic coils arranged on the excitation magnetic core, the magnetic source micro electromagnetic coils are used to receive sinusoidal current and generate three-dimensional sinusoidal magnetic fields. The three groups of magnetic source micro electromagnetic coils are orthogonal to each other and their centers coincide with the center of the excitation magnetic core.

[0149] The positioning target includes a three-dimensional magnetic sensor for receiving the sinusoidal magnetic field and sensing the three-dimensional magnetic field component.

[0150] The positioning processing component 201 is electrically connected to the magnetic field generating component 102. The current generated by the positioning processing component 201 excites the magnetic source micro-electromagnetic coil to generate a three-dimensional sinusoidal magnetic field.

[0151] The positioning processing component 201 is configured to implement the micro-electromagnetic positioning method as described in any of the above embodiments. The micro-electromagnetic positioning method can calculate the position and posture of the positioning target in the target detection area. The micro-electromagnetic positioning method can also calibrate the position of the positioning target in the target detection area. The micro-electromagnetic positioning method is not described in detail here.

[0152] The magnetic field generating component 102 is used as a sinusoidal magnetic field generating source, and in the positioning process, it is usually used as the coordinate circle center O. The three-dimensional magnetic sensor can be a chip-type high-precision, low-noise magnetic sensor suitable for weak magnetic field environments such as AK09940, MMC5983MA, and MMC5603NJ; it is used to measure the three-dimensional magnetic field components at a spatial position.

[0153] The positioning processing component 201 can be connected to the magnetic field generating component 102 and the positioning target for communication so as to control the operation of the magnetic field generating component 102 and the positioning target. On the one hand, it controls the magnetic field generating component 102 to generate a sinusoidal magnetic field. On the other hand, it controls the three-dimensional magnetic sensor in the positioning target to sense the sinusoidal magnetic field to generate a three-dimensional magnetic field component. Finally, the positioning processing component 201 performs positioning solution to obtain the position information.

[0154] In one embodiment, if Figure 6-7As shown, the micro-electromagnetic positioning system also includes a waist belt 101, a fixed belt 202 and a connecting cable bundle 203. The positioning target includes at least a main positioning target 3 and N auxiliary positioning targets 103, 104, 105, 106... The N auxiliary positioning targets 103, 104, 105, 106... are arranged on the waist belt 101 at intervals with the magnetic field generating component 102 to form a target detection area. The positioning processing component 201 is installed on the fixed belt 202. The positioning processing component 201 is electrically connected to the magnetic field generating component 102 through the connecting cable bundle 203, and excites the magnetic field generating component 102 to generate a three-dimensional sinusoidal wave magnetic field. The main positioning target 3 is located in the target detection area.

[0155] In one embodiment, the fixing strap 202 can be represented as a leg strap, and the positioning processing component 201 is arranged on the leg strap, and is separated from the magnetic field generating component 102 and N auxiliary positioning targets 103, 104, 105, 106... on the waist belt 101, thereby forming a lightweight positioning system, and can also reduce the weight of the waist belt 101, thereby reducing interference with the positioning processing component 102.

[0156] In other embodiments, the fixing strap 202 may be represented as a strap fixed to other places, such as a wrist strap or other devices fixed to the outside of the human body.

[0157] In this way, the belt form is more lightweight, and also greatly reduces the size of the device and reduces power consumption.

[0158] The magnetic field generating component 102 generates a three-dimensional pulse magnetic field to detect the main positioning target 3, and obtains the position and posture information of the main positioning target 3. Based on the auxiliary positioning of N auxiliary positioning targets 103, 104, 105, 106..., the position of the main positioning target 3 can be further accurately obtained.

[0159] like Fig. 9 As shown, the positioning processing component 201 includes a sinusoidal pulse width modulation module 2011, which is electrically connected to each group of coils and is configured to excite the corresponding coils to generate a sinusoidal magnetic field according to three different preset magnetic field frequencies.

[0160] The positioning processing component 201 can independently provide load-carrying sinusoidal alternating current of specific frequency and amplitude to the three groups of coils through steps such as DC boosting and modulation by the sinusoidal pulse width modulation module 2011.

[0161] The system uses a DC power supply (a high-energy-density rechargeable lithium battery, such as 18650, 21700 lithium battery or lithium-ion polymer battery) to ensure overall portability. The DC power is converted into a standard sinusoidal AC power of a specific amplitude (within the safe voltage range), frequency, and phase, which is used to power the electromagnetic coil to generate a sinusoidal magnetic field. Under the same signal peak, the power consumption of the sinusoidal signal is only 1 / 2 of that of the square wave pulse signal, which can effectively reduce the power consumption of the micro-electromagnetic positioning method and increase the endurance of continuous positioning. The sinusoidal electrical signal has no mutations, and will not cause distortion of the sinusoidal magnetic field and high-frequency harmonic interference to the inductive coil, which can achieve better positioning stability and accuracy.

[0162] In one embodiment of the present invention, the positioning target may further include an inertial measurement unit for acquiring inertial measurement data, assisting positioning calculation, and improving the efficiency of positioning solution.

[0163] In one embodiment of the present invention, the positioning target may further include a main control module for obtaining three-dimensional magnetic field components and inertial measurement data and transmitting them to the positioning processing component 201 .

[0164] like Fig.10 As shown, in one embodiment of the present invention, the main positioning target 3 includes a first three-dimensional magnetic sensor 31, a first inertial measurement unit 32 and a first main control module 33, the first auxiliary positioning target 103 includes a second three-dimensional magnetic sensor 1031, a second inertial measurement unit 1032 and a second main control module 1033, the second auxiliary positioning target 104 includes a third three-dimensional magnetic sensor 1041, a third inertial measurement unit 1042 and a third main control module 1043, the third auxiliary positioning target 105 includes a fourth three-dimensional magnetic sensor 1051, a fourth inertial measurement unit 1052 and a fourth main control module 1053, the fourth auxiliary positioning target 106 includes a fifth three-dimensional magnetic sensor 1061, a fifth inertial measurement unit 1062 and a fifth main control module 1063, the Nth auxiliary positioning target includes...

[0165] Correspondingly, the positioning processing component 201 includes a positioning unit 2012, and the positioning unit 2012 can receive the feedback three-dimensional magnetic field component, and perform positioning calculation according to the three-dimensional magnetic field component to obtain position and posture information.

[0166] like Fig.10 As shown, in one embodiment of the present invention, the main positioning target 3 also includes an imaging unit 34, and the imaging unit 34 is used to capture images; the imaging unit 34 is not limited to one group, and can include multiple groups, for example: two groups of imaging units 34 distributed at both ends of the capsule can capture images in the digestive tract simultaneously, alternately or independently.

[0167] In one embodiment of the present invention, a storage medium is provided, wherein the storage medium stores a computer program, and when the computer program is executed by a processor, the steps of the micro-electromagnetic positioning method in the above embodiment are implemented.

[0168] It should be noted that the storage medium shown may be a removable storage medium 611 .

[0169] Fig.11 The structure block diagram of a computer system for implementing the storage medium of an embodiment of the present application is schematically shown.

[0170] It should be noted that Fig.11 The computer system 6 of the storage medium shown is only an example and should not bring any limitation to the functions and scope of use of the embodiments of the present application.

[0171] like Fig.11 As shown, the computer system 6 includes a central processing unit 601 (CPU), which can perform various appropriate actions and processes according to the program stored in the read-only memory 602 (ROM) or the program loaded from the storage part 608 to the random access memory 603 (RAM). Various programs and data required for system operation are also stored in the random access memory 603. The central processing unit 601, the read-only memory 602 and the random access memory 603 are connected to each other through a bus 604. An input / output interface 605 (Input / Output interface, i.e., I / O interface) is also connected to the bus 604.

[0172] The following components are connected to the input / output interface 605: an input section 606 including a keyboard, a mouse, etc.; an output section 607 including a cathode ray tube (CRT), a liquid crystal display (LCD), etc., and a speaker, etc.; a storage section 608 including a hard disk, etc.; and a communication section 609 including a network interface card such as a local area network card, a modem, etc. The communication section 609 performs communication processing via a network such as the Internet. A drive 610 is also connected to the input / output interface 605 as needed. A removable medium 611, such as a magnetic disk, an optical disk, a magneto-optical disk, a semiconductor memory, etc., is installed on the drive 610 as needed so that a computer program read therefrom is installed into the storage section 608 as needed.

[0173] Those skilled in the art can clearly understand that, for the convenience and brevity of description, the specific working processes of the above-described systems, systems and modules can refer to the corresponding processes in the aforementioned method implementation methods and will not be repeated here.

[0174] In several embodiments provided in the present application, it should be understood that the disclosed systems, systems and methods can be implemented in other ways. For example, the system implementation described above is only schematic, for example, the division of the modules is only a logical function division, and there may be other division methods in actual implementation, such as multiple modules or components can be combined or integrated into another system, or some features can be ignored or not executed. Another point is that the mutual coupling or direct coupling or communication connection shown or discussed can be an indirect coupling or communication connection through some interfaces, systems or modules, which can be electrical, mechanical or other forms. The modules described as separate components may or may not be physically separated, and the components displayed as modules may or may not be physical modules, that is, they may be located in one place, or they may be distributed on multiple network modules. Some or all of the modules can be selected according to actual needs to achieve the purpose of the present implementation scheme.

[0175] In addition, each functional module in each embodiment of the present application can be integrated into a processing module, or each module can exist physically separately, or two or more modules can be integrated into one module. The above-mentioned integrated module can be implemented in the form of hardware or in the form of hardware plus software functional modules. The above-mentioned integrated module implemented in the form of software functional modules can be stored in a computer-readable storage medium. The above-mentioned software functional modules are stored in a storage medium, including a number of instructions for a computer system (which can be a personal computer, a server, or a network system, etc.) or a processor (processor) to perform some steps of the method described in each embodiment of the present application. The aforementioned storage medium includes: various media that can store program codes, such as a USB flash drive, a mobile hard disk, a read-only memory (ROM), a random access memory (RAM), a disk or an optical disk.

[0176] Finally, it should be noted that the above implementation modes are only used to illustrate the technical solutions of the present application, rather than to limit them. Although the present application has been described in detail with reference to the aforementioned implementation modes, those skilled in the art should understand that they can still modify the technical solutions described in the aforementioned implementation modes, 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 various implementation modes of the present application.

Claims

1. A micro-electromagnetic positioning method, characterized in that: include: Sinusoidal currents with specific frequency differences are passed through three groups of magnetic source micro-electromagnetic coils simultaneously to excite three-dimensional sinusoidal magnetic fields; Acquire magnetic field data information of a positioning target in the sinusoidal magnetic field, wherein the magnetic field data information includes a three-dimensional magnetic field component sensed by the positioning target in the sinusoidal magnetic field; Fitting the three-dimensional magnetic field component of each dimension, and decomposing to obtain independent magnetic field signals of three groups of magnetic source micro-electromagnetic coils at the positioning target; The position and posture information of the positioning target are obtained according to the independent magnetic field signal.

2. The micro-electromagnetic positioning method according to claim 1, characterized in that: The sinusoidal current with a specific frequency difference passes through three sets of magnetic source micro-electromagnetic coils at the same time to excite the three-dimensional sinusoidal magnetic field, specifically including: Sinusoidal currents of different frequencies are preset, and the frequency of the sine wave current is f k Satisfy f ps ≤f k ≤f s / n, where f ps is the full-load positioning frame rate of the positioning system, f s is the sampling frequency of the magnetic sensor, and n is the number of samples that can be achieved within one cycle of a sinusoidal wave signal.

3. The micro-electromagnetic positioning method according to claim 1 or 2, characterized in that: The sinusoidal current with a specific frequency difference passes through three sets of magnetic source micro-electromagnetic coils at the same time to excite the three-dimensional sinusoidal magnetic field, specifically including: Preset sinusoidal currents of different frequencies, wherein the sinusoidal currents include a first sinusoidal current with a frequency of f1, a second sinusoidal current with a frequency of f2, and a third sinusoidal current with a frequency of f3, wherein f2=f1+δ, f3=f2+δ, and δ is a frequency difference; The corresponding magnetic source micro-electromagnetic coil is excited according to the sinusoidal current to generate the sinusoidal magnetic field.

4. The micro-electromagnetic positioning method according to claim 1, characterized in that: The fitting of the three-dimensional magnetic field component of each dimension specifically includes: performing function fitting on the magnetic field measurement values ​​of the dispersed three-dimensional magnetic field components to obtain the magnetic field intensity B in the corresponding dimension s (t); The decomposition to obtain the independent magnetic field signals of the three groups of magnetic source micro-electromagnetic coils at the positioning target includes: the magnetic field strength B after decomposition and fitting s (t), obtain the magnetic induction intensity amplitude A of the independent magnetic field signals of the three groups of magnetic source micro electromagnetic coils at the positioning target k；s , the decomposition formula is: Wherein, k represents the serial number of the magnetic source micro-electromagnetic coil, k=1, 2, 3; s=1, 2, 3, represents the three dimensions of the sinusoidal magnetic field, representing the X direction, the Y direction, and the Z direction respectively; A k；s is the magnetic induction intensity amplitude of the independent magnetic field signals of the three groups of magnetic source micro-electromagnetic coils at the positioning target to be determined and decomposed, that is, the magnetic field measurement peak value; c s is the background magnetic field component; the signal angular frequency w k , signal phase b k It is a known quantity directly obtained based on the frequency value and phase value of the current data.

5. The micro-electromagnetic positioning method according to claim 4, characterized in that: The decomposition formula is linearized to obtain the linearized decomposition formula: Among them, β 0；s X0 represents the three-dimensional magnetic field strength at the positioning target when the three groups of magnetic source micro-electromagnetic coils are not powered on, that is, the ambient magnetic field strength at the positioning target; β 1；s X1, β 2；s X2, β 3；s X3 represents the three-dimensional magnetic field strength of the independent magnetic field signals of the three groups of magnetic source micro-electromagnetic coils at the positioning target; Using a series of data at time t, {X k (t),B s (t)}, and solve the coefficient β through linear optimization k；s Then, calculate the required magnetic induction intensity amplitude A k；s and background magnetic field c s .

6. The micro-electromagnetic positioning method according to claim 4 or 5, characterized in that: Acquiring the position and attitude information of the positioning target according to the independent magnetic field signal specifically includes: The spatial distribution of magnetic induction intensity is simplified by using the magnetic dipole approximation. The calculation formula for the peak value of magnetic induction intensity is: Where μ0 is the vacuum magnetic permeability; M k is the peak value of the equivalent magnetic moment after the kth coil is energized, is the unit vector of the equivalent magnetic moment of the kth coil, k = 1, 2, 3; is the spatial position vector; is the spatial position unit vector; According to the peak value of magnetic induction intensity Obtain the theoretical value of the magnetic induction intensity peak matrix The position and attitude information of the positioning target is obtained by solving the corresponding relationship between the theoretical value of the magnetic induction intensity peak matrix and the magnetic field measurement peak in the independent magnetic field signal through a nonlinear optimization algorithm; wherein the corresponding relationship is: in, A is the sensor attitude rotation matrix; k；s Measure the peak value of the magnetic field; is the theoretical value of the magnetic induction intensity peak matrix; The nonlinear optimization algorithm is:

7. The micro-electromagnetic positioning method according to claim 1, characterized in that: Also includes: The pitch angle pitch and the roll angle roll of the positioning target are obtained, and the yaw angle yaw and the position coordinates of the positioning target are calculated according to the pitch angle pitch, the roll angle roll of the positioning target and the independent magnetic field signal.

8. The micro-electromagnetic positioning method according to claim 1, characterized in that: The positioning target includes at least one main positioning target and N auxiliary positioning targets. The micro-electromagnetic positioning method also includes a positioning calibration method, and the specific steps include: Calculate the position information of N (N≥2) auxiliary positioning targets multiple times within a preset time length and calculate the average position of the N (N≥2) auxiliary positioning targets; Calculating the position information of the main positioning target and the position information of the N (N≥2) auxiliary positioning targets after a preset time period; Construct a scaling and rotation change matrix W*S to calibrate the position information of the main positioning target in the target detection area.

9. The micro-electromagnetic positioning method according to claim 8, characterized in that: The position information of N (N≥2) auxiliary positioning targets is calculated multiple times within a preset time period, and is obtained when the human body is in an upright standard posture. The preset time period is 1 minute.

10. The micro-electromagnetic positioning method according to claim 8, characterized in that: The construction of the scaling and rotation change matrix W*S satisfies Solve the transformation matrix by pseudo-inverse operation in, The D N1 The position information of N (N≥2) auxiliary positioning targets obtained by multiple calculations within the preset time length, The set matrix of average positions of N (N≥2) auxiliary positioning targets is obtained by calculating the position information of N (N≥2) auxiliary positioning targets for multiple times within the preset time length; The D N2 is the location information of N (N≥2) auxiliary positioning targets calculated after the preset time period, is a collection matrix of position information of N (N≥2) auxiliary positioning targets calculated after the preset time length; The calibrating the position information of the main positioning target in the target detection area specifically includes calibrating the position information C2 of the main positioning target calculated after a preset time period to obtain new position information C, satisfying C=W·S·C2.

11. The micro-electromagnetic positioning method according to claim 8, 9 or 10, characterized in that: The number of auxiliary positioning targets N=2, 3, 4.

12. A micro electromagnetic positioning system, characterized in that: include: A magnetic field generating component, comprising three groups of magnetic source micro-electromagnetic coils arranged on an excitation magnetic core, wherein the magnetic source micro-electromagnetic coils are used to receive a sinusoidal current and generate a three-dimensional sinusoidal magnetic field; A positioning target includes a three-dimensional magnetic sensor for receiving the sinusoidal magnetic field and sensing a three-dimensional magnetic field component; A positioning processing component, electrically connected to the magnetic field generating component and the positioning target; The positioning processing component is configured to implement the micro-electromagnetic positioning method as described in any one of claims 1-10.

13. The micro-electromagnetic positioning system according to claim 12, characterized in that: The three groups of magnetic source micro-electromagnetic coils are orthogonal to each other, and their centers coincide with the center of the excitation magnetic core.

14. The micro-electromagnetic positioning system according to claim 12, characterized in that: It also includes a waist belt, a fixing belt and a connecting cable bundle, the positioning target includes at least a main positioning target and N auxiliary positioning targets, the N auxiliary positioning targets are spaced apart from the magnetic field generating component on the waist belt to form a target detection area, the positioning processing component is installed on the fixing belt, the positioning processing component is electrically connected to the magnetic field generating component through the connecting cable bundle, and excites the magnetic field generating component to generate a three-dimensional sinusoidal wave magnetic field, and the main positioning target is located in the target detection area.

15. The micro-electromagnetic positioning system according to claim 14, characterized in that: The fixing strap is a leg strap, and the positioning processing component is installed on the leg strap.

16. A storage medium storing a computer program, characterized in that: When the computer program is executed by a processor, the steps in the micro electromagnetic positioning system as claimed in any one of claims 1 to 11 are implemented.

Images