CN113288008A - Magnetic capsule endoscope full-attitude determination method - Google Patents
Magnetic capsule endoscope full-attitude determination method Download PDFInfo
- Publication number
- CN113288008A CN113288008A CN202110570007.7A CN202110570007A CN113288008A CN 113288008 A CN113288008 A CN 113288008A CN 202110570007 A CN202110570007 A CN 202110570007A CN 113288008 A CN113288008 A CN 113288008A
- Authority
- CN
- China
- Prior art keywords
- capsule endoscope
- permanent magnet
- magnetic
- magnetic capsule
- small
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Granted
Links
- 239000002775 capsule Substances 0.000 title claims abstract description 152
- 238000000034 method Methods 0.000 title claims abstract description 39
- 239000013598 vector Substances 0.000 claims abstract description 53
- 230000005415 magnetization Effects 0.000 claims abstract description 46
- 230000006698 induction Effects 0.000 claims description 13
- 238000005457 optimization Methods 0.000 description 4
- 238000004364 calculation method Methods 0.000 description 3
- 230000008859 change Effects 0.000 description 3
- 238000010586 diagram Methods 0.000 description 3
- 230000008569 process Effects 0.000 description 3
- 210000001035 gastrointestinal tract Anatomy 0.000 description 2
- 238000005259 measurement Methods 0.000 description 2
- 206010011409 Cross infection Diseases 0.000 description 1
- 206010029803 Nosocomial infection Diseases 0.000 description 1
- 230000004075 alteration Effects 0.000 description 1
- 230000001186 cumulative effect Effects 0.000 description 1
- 238000003745 diagnosis Methods 0.000 description 1
- 201000010099 disease Diseases 0.000 description 1
- 208000037265 diseases, disorders, signs and symptoms Diseases 0.000 description 1
- 239000003814 drug Substances 0.000 description 1
- 238000002575 gastroscopy Methods 0.000 description 1
- 230000006872 improvement Effects 0.000 description 1
- 230000003902 lesion Effects 0.000 description 1
- 230000005389 magnetism Effects 0.000 description 1
- 238000000691 measurement method Methods 0.000 description 1
- 210000000813 small intestine Anatomy 0.000 description 1
- 238000006467 substitution reaction Methods 0.000 description 1
- 230000009747 swallowing Effects 0.000 description 1
- 230000000007 visual effect Effects 0.000 description 1
Images
Classifications
-
- A—HUMAN NECESSITIES
- A61—MEDICAL OR VETERINARY SCIENCE; HYGIENE
- A61B—DIAGNOSIS; SURGERY; IDENTIFICATION
- A61B1/00—Instruments for performing medical examinations of the interior of cavities or tubes of the body by visual or photographical inspection, e.g. endoscopes; Illuminating arrangements therefor
- A61B1/04—Instruments for performing medical examinations of the interior of cavities or tubes of the body by visual or photographical inspection, e.g. endoscopes; Illuminating arrangements therefor combined with photographic or television appliances
- A61B1/041—Capsule endoscopes for imaging
-
- A—HUMAN NECESSITIES
- A61—MEDICAL OR VETERINARY SCIENCE; HYGIENE
- A61B—DIAGNOSIS; SURGERY; IDENTIFICATION
- A61B1/00—Instruments for performing medical examinations of the interior of cavities or tubes of the body by visual or photographical inspection, e.g. endoscopes; Illuminating arrangements therefor
- A61B1/00131—Accessories for endoscopes
-
- A—HUMAN NECESSITIES
- A61—MEDICAL OR VETERINARY SCIENCE; HYGIENE
- A61B—DIAGNOSIS; SURGERY; IDENTIFICATION
- A61B1/00—Instruments for performing medical examinations of the interior of cavities or tubes of the body by visual or photographical inspection, e.g. endoscopes; Illuminating arrangements therefor
- A61B1/00147—Holding or positioning arrangements
- A61B1/00158—Holding or positioning arrangements using magnetic field
-
- A—HUMAN NECESSITIES
- A61—MEDICAL OR VETERINARY SCIENCE; HYGIENE
- A61B—DIAGNOSIS; SURGERY; IDENTIFICATION
- A61B1/00—Instruments for performing medical examinations of the interior of cavities or tubes of the body by visual or photographical inspection, e.g. endoscopes; Illuminating arrangements therefor
- A61B1/04—Instruments for performing medical examinations of the interior of cavities or tubes of the body by visual or photographical inspection, e.g. endoscopes; Illuminating arrangements therefor combined with photographic or television appliances
- A61B1/045—Control thereof
-
- A—HUMAN NECESSITIES
- A61—MEDICAL OR VETERINARY SCIENCE; HYGIENE
- A61B—DIAGNOSIS; SURGERY; IDENTIFICATION
- A61B1/00—Instruments for performing medical examinations of the interior of cavities or tubes of the body by visual or photographical inspection, e.g. endoscopes; Illuminating arrangements therefor
- A61B1/273—Instruments for performing medical examinations of the interior of cavities or tubes of the body by visual or photographical inspection, e.g. endoscopes; Illuminating arrangements therefor for the upper alimentary canal, e.g. oesophagoscopes, gastroscopes
- A61B1/2736—Gastroscopes
Landscapes
- Health & Medical Sciences (AREA)
- Life Sciences & Earth Sciences (AREA)
- Surgery (AREA)
- Biomedical Technology (AREA)
- Medical Informatics (AREA)
- Optics & Photonics (AREA)
- Pathology (AREA)
- Radiology & Medical Imaging (AREA)
- Biophysics (AREA)
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- Heart & Thoracic Surgery (AREA)
- Nuclear Medicine, Radiotherapy & Molecular Imaging (AREA)
- Molecular Biology (AREA)
- Animal Behavior & Ethology (AREA)
- General Health & Medical Sciences (AREA)
- Public Health (AREA)
- Veterinary Medicine (AREA)
- Gastroenterology & Hepatology (AREA)
- Endoscopes (AREA)
Abstract
The invention discloses a method for measuring the whole posture of a magnetic capsule endoscope. Firstly, estimating the initial posture of the magnetic capsule endoscope; then adjusting the posture of the external large magnet to make the posture of the external large magnet consistent with the initial posture of the magnetic capsule endoscope; then, an external large magnet is used for controlling the magnetic capsule endoscope to rotate around the axial central shaft of the magnetic capsule endoscope, and the unit vector of the current radial magnetization direction of the permanent magnet in the rotated magnetic capsule endoscope is calculatedFinally calculating the magnetic capsule endoscopeAxial direction unit vector of permanent magnet in mirrorI.e. the current pose of the magnetic capsule endoscope is completely determined. The operation method is simple, has no accumulated error, and can solve the problem that the active movement and the positioning of the capsule need to be realized simultaneously in practical application.
Description
Technical Field
The invention relates to the technical field of medical equipment, in particular to a method for measuring the whole posture of a magnetic capsule endoscope.
Background
A wireless capsule endoscope (hereinafter referred to as capsule endoscope) is used for medical examination of the digestive tract of a human body in a swallowing mode, is a non-invasive medical examination mode, and is a revolution and future development direction in the development history of the endoscope. Compared with the traditional medical endoscope, the capsule endoscope has the advantages of no wound, no pain, convenient operation, small size, safety, no cross infection and the like, greatly relieves the pain of patients, expands the examination visual field of doctors, fills the blind areas of gastroscopy and enteroscopy, has high diagnosis value especially for suspicious small intestine lesions, and has great market application value.
In the clinical use of the capsule lens, the rapid, accurate and complete determination of all the parameters of the spatial position and the posture of the capsule lens is one of the most critical problems. The following technical advantages can be brought by completely knowing the accurate position and posture information of the capsule endoscope in the digestive tract of the human body: the doctor is helped to judge the accurate shooting position and angle of the focus tissue picture, so as to make accurate judgment on the disease; necessary position and posture data are provided for actively controlling the movement of the capsule mirror, so that important technical support is provided for doctors to autonomously control the capsule mirror to carry out all-around examination and shooting or realize medical purposes such as examination and medicine application of a specified position or route.
At present, the rapid and accurate determination of the full parameters of the space attitude of the capsule mirror has difficulties. In the existing capsule mirror pose measuring method, a magnetostatic positioning mode that a small permanent magnet is placed in a capsule mirror is adopted, so that the method has the characteristics of no need of a power supply, simplicity in implementation and no damage to a human body, and is very suitable for the short-distance and high-precision positioning requirement of the capsule mirror.
The existing magnetostatic-based capsule mirror pose measurement method is to use a permanent magnet as a magnetic source, utilize a magnetic dipole model and a correction model thereof, and calculate 6 pose parameters (3 position parameters and 3 pose parameters) of a capsule by adopting a nonlinear optimization algorithm. The magnetic positioning precision is better; however, the 3 attitude parameters (m, n, p) have a constraint relation (m)2+n2+p21) and therefore can only determine two-dimensional pose parameters in practice, and not all three-dimensional posesAnd (4) state parameters, namely the roll angle in the attitude parameters of the capsule mirror cannot be obtained. The reason is that the internal permanent magnet of the existing capsule mirror is generally an annular magnet with axial magnetism, the central axis of the magnet is arranged in the same direction as the central axis of the capsule mirror, and when the capsule mirror rotates around the self axial direction, the magnetic field direction of the axial magnetic permanent magnet is not changed, so that the posture change (namely the roll angle change) of the capsule mirror cannot be detected according to the magnetic field change.
Although some algorithms can also achieve six-dimensional magnetic positioning of rectangular permanent magnets, the rectangular permanent magnets are not well combined with capsule mirrors due to their form factor and are not suitable for use in capsule mirrors. Meanwhile, the capsule mirror working environment is completely visually isolated from the outside, so that most measurement means relying on video recognition gestures are ineffective.
Another type of existing capsule mirror pose determination method adopts three-axis angular velocity data to participate in pose solution. However, such methods have cumulative errors, namely: when the data of the angular velocity instrument is converted into an angle, an integral accumulated error exists, and the accumulated error is larger and larger along with the time, so that the measurement error is larger. Although the prior art can measure the geomagnetic vector by using a triaxial geomagnetic sensor and calibrate the angle to eliminate the accumulated error, the geomagnetic sensor cannot be used because a strong external magnetic field for driving the capsule to move exists in the use environment of the active capsule.
Therefore, how to rapidly and completely measure all the attitude parameters of the capsule mirror is a technical problem to be solved urgently by those skilled in the art.
Disclosure of Invention
In order to solve the technical problems, the invention provides a method for measuring the whole attitude of a magnetic capsule endoscope, which can simply, accurately and completely measure all attitude parameters and position parameters of the capsule endoscope.
The invention provides a method for measuring the whole posture of a magnetic capsule endoscope, which adopts the magnetic capsule endoscope, wherein a permanent magnet arranged in the capsule endoscope is a small permanent magnet which is magnetized in the radial direction; the small permanent magnet is cylindrical or annular and is fixedly arranged in the magnetic capsule endoscope or fixed on the wall of the annular magnetic capsule endoscope shell, and the axial direction of the small permanent magnet is consistent with the axial direction of the magnetic capsule endoscope; a large permanent magnet is arranged outside the capsule endoscope and is a cylindrical strong permanent magnet which is magnetized in the radial direction;
the method comprises the following steps:
step 1: estimating the initial attitude of the magnetic capsule endoscope, and determining the unit vector of the radial magnetization direction of the small permanent magnet in the magnetic capsule endoscopeAnd axial direction unit vector
The specific implementation comprises the following substeps:
step 1.1: calculating the unit vector of the radial magnetization direction of the small permanent magnet
Step 1.2: controlling the rotation of the magnetic capsule endoscope by using an external large permanent magnet according to the radial magnetization direction vector of the small permanent magnet;
step 1.3: calculating the unit vector of the radial magnetization direction of the small permanent magnet after rotation
Step 1.4: byAndcalculating the estimated axial direction unit vector of the magnetic capsule endoscope
Step 2: adjusting the posture of the external large permanent magnet to make the posture of the external large permanent magnet consistent with the current posture of the magnetic capsule endoscope;
and step 3: the magnetic capsule endoscope is controlled to rotate around the axial central shaft of the magnetic capsule endoscope by using an external large permanent magnet;
and 4, step 4: calculating the unit vector of the current radial magnetization direction of the small permanent magnet in the rotated magnetic capsule endoscope
And 5: calculating the axial direction unit vector of the magnetic capsule endoscope I.e. the current pose of the capsule endoscope is completely determined.
The invention can solve the problem of integral accumulated error in the existing method for calculating the attitude angle according to the angular velocity data, solve the problem that the existing magnetostatic positioning method can not completely measure all attitude parameters of the capsule endoscope and mainly solve the problem that the rotation angle of the capsule endoscope around the self axial direction can not be measured. The invention can completely measure all attitude parameters of the capsule endoscope; the operation method is simple, and no accumulated error exists; meanwhile, the external permanent magnet in the method can be simultaneously used for actively controlling the capsule endoscope, and the problem that the active movement of the capsule endoscope and the positioning of the capsule endoscope need to be simultaneously realized in practical application can be well solved.
Drawings
FIG. 1 is a schematic diagram of the spatial relationship between the permanent magnet inside the capsule mirror and the external large magnet, the human body and the magnetic sensor array according to the embodiment of the present invention;
FIG. 2 is a flow chart of a method embodying the present invention;
FIG. 3 is a schematic diagram of an external large magnet controlled magnetic capsule endoscope rotation according to an embodiment of the present invention;
fig. 4 is a schematic diagram of the spatial relationship between the magnetic sensor array and the xyz coordinate system and the rotation direction of the small permanent magnet according to the embodiment of the present invention.
Detailed Description
In order to facilitate the understanding and implementation of the present invention for those of ordinary skill in the art, the present invention is further described in detail with reference to the accompanying drawings and examples, it is to be understood that the embodiments described herein are merely illustrative and explanatory of the present invention and are not restrictive thereof.
The invention provides a method for measuring the whole posture of a magnetic capsule endoscope, which adopts the magnetic capsule endoscope; the permanent magnet arranged in the capsule endoscope is a small permanent magnet which is magnetized in the radial direction; the small permanent magnet is cylindrical or annular and is fixedly arranged in the magnetic capsule endoscope or fixed on the wall of the annular magnetic capsule endoscope shell, and the axial direction of the small permanent magnet is consistent with the axial direction of the magnetic capsule endoscope; the exterior of the capsule endoscope is provided with a large permanent magnet which is a cylindrical strong permanent magnet magnetized in the radial direction, as shown in figure 1.
Referring to fig. 2, the method for measuring the full attitude of the magnetic capsule endoscope provided by the invention specifically comprises the following steps:
step 1: estimating the initial attitude of the magnetic capsule endoscope, and determining the unit vector of the radial magnetization direction of the small permanent magnet in the magnetic capsule endoscopeAnd axial direction unit vector
The specific implementation comprises the following substeps:
step 1.1: calculating unit vector of radial magnetization direction of small permanent magnetThe specific process is as follows:
(1) by means of the array of magnetic sensors,detecting to obtain the current magnetic induction intensity generated by the small magnetWherein N (more than or equal to 5) is the number of the three-axis magnetic sensors in the magnetic sensor array. As shown in fig. 4, a three-dimensional rectangular coordinate system oyx is established by taking the plane of the sensor array as the XOY plane. The current value of the magnetic induction at the nth magnetic sensor is denoted asWherein, B0,nx、B0,ny、B0,nzRespectively represent the magnetic induction intensity components of the nth magnetic sensor in three directions of an x axis, a y axis and a z axis in a coordinate system OXYZ. The magnetic sensor array is fixed to the outside of the human body (e.g., below the human body), as shown in fig. 1.
(2) According to the magnetic induction intensity detected in (1)By using the method of the magnetic dipole model, the small magnet is taken as a point source, and the unit vector of the magnetization direction of the small magnet is calculated(i.e., m)0 2+n0 2+p0 21). The specific method comprises the following steps:
establishing an objective function:
wherein,b0,n=B0,nxyn-B0, nyxn,(xn,yn,zn) Is the position coordinates of the nth magnetic sensor in the OXYZ coordinate system, (a, b, c) is the position coordinates of the small magnet in the OXYZ coordinate system, m0′=m0/p0,n0′=n0/p0。
Secondly, solving the objective function by utilizing a nonlinear optimization algorithm to obtain an attitude parameter m of the small magnet (namely the magnetic capsule endoscope)0' and n0′。
Calculating unit vector of magnetization direction of small magnet according to the following formula
m0=m0′p0
n0=n0′p0
Step 1.2: controlling the rotation of the magnetic capsule endoscope by using an external large magnet according to the radial magnetization direction vector of the small magnet;
in this embodiment, the manner of controlling the rotation of the magnetic capsule endoscope by the external large magnet is as follows: first, the external large magnet is placed so that the radial magnetization direction of the large magnet is in the same direction as the radial magnetization direction (i.e., vector) of the small magnet) In the same direction, as shown in fig. 3(a), the external large magnet is then controlled to rotate counterclockwise by a slight angle of 2 ° about its own axial central axis, resulting in rotation of the magnetic field generated by the external large magnet, which drives the small magnet (together with the magnetic capsule endoscope) to rotate clockwise about its own axial central axis (the direction of rotation of the magnetic capsule endoscope is opposite to that of the external large magnet, as shown in fig. 3 (b)).
Step 1.3: calculating the unit vector of the radial magnetization direction of the small permanent magnet after rotation(m1 2+n1 2+p1 21). The specific process is as follows: shielding or removing the magnetic field of the external large magnet, and then obtaining the current magnetic induction intensity generated by the rotated small magnet through the magnetic sensor arrayThen calculating the unit vector of the current magnetization direction of the small magnet according to the following steps
Establishing an objective function:
wherein,b1,n=B1,nxyn-B1, nyxn, is the coordinate (x) of the small magnet after rotationn,yn,zn) M, the magnetic induction vector generated at the nth magnetic sensor1′=m1/p1,n1′=n1/p1。
Secondly, solving the objective function by utilizing a nonlinear optimization algorithm to obtain the attitude parameter m of the rotated small magnet (namely the magnetic capsule endoscope)1' and n1′。
Calculating the unit vector of the magnetization direction of the small magnet after rotation according to the following formula
m1=m1′p1
n1=n1′p1
Step 1.4: byAndcalculating the estimated axial direction unit vector of the magnetic capsule endoscopeThe calculation formula is as follows:
r=n0p1-n1p0
s=m1p0-m0p1
t=m0n1-m1n0
wherein,andrespectively represent unit vectors of the magnetization directions of the small magnets before and after rotation,is the predicted axial direction unit vector (i.e. the unit vector of the magnetic capsule endoscope))。
Step 2: adjusting the posture of the external big magnet to make the posture of the external big magnet consistent with the initial posture of the magnetic capsule endoscope, namely: the axial direction of the external large magnet and the estimated axial direction of the magnetic capsule endoscope (i.e. the axial direction of the magnetic capsule endoscope)) Similarly, as shown in FIG. 1, and the radial magnetization direction of the outer large magnet is the same as the current radial magnetization direction of the permanent magnet (i.e., the radial magnetization direction of the outer large magnet)) In the same direction as shown in FIG. 3 (a).
And step 3: the magnetic capsule endoscope is controlled to rotate around the axial central shaft of the magnetic capsule endoscope by an external large magnet.
In this embodiment, the manner of controlling the rotation of the magnetic capsule endoscope by the external large magnet is as follows: the external large magnet is controlled to rotate clockwise by 4 degrees around the self axial central shaft, so that the magnetic field generated by the external large magnet rotates, and the rotating magnetic field drives the small magnet (together with the magnetic capsule endoscope) to rotate anticlockwise around the self axial central shaft, as shown in figure 4. (the rotation direction of the magnetic capsule endoscope is opposite to that of the external large magnet.)
And 4, step 4: calculating the unit vector of the current radial magnetization direction of the small magnet in the rotated magnetic capsule endoscopeThe specific process is as follows:
shielding external large magnet magnetic field, and detecting by magnetic sensor arrayMeasuring the current value of the magnetic induction intensity generated by the small magnet after rotating in the step 3And establishing an objective function:
wherein,b2,n=B2,nxyn-B2, nyxn,is a small magnet in the coordinate (x)n,yn,zn) M, the magnetic induction intensity value generated at the nth magnetic sensor2′=m2/p2,n2′=n2/p2。
Solving the objective function by using a nonlinear optimization algorithm to obtain the current position coordinates (a, b, c) and the attitude parameter m of the rotated small magnet2' and n2′。
Calculating the unit vector of the current magnetization direction of the rotated small magnet according to the following formula
m2=m2′p2;
n2=n2′p2;
And 5: calculating the axial direction unit vector of the magnetic capsule endoscope I.e. the current pose of the capsule endoscope is completely determined.
The calculation formula is as follows:
r=n1p2-n2p1;
s=m2p1-m1p2;
t=m1n2-m2n1;
wherein,andunit vectors respectively representing the radial magnetization directions of the small magnets before and after the rotation (i.e., the second rotation) of step 3, as shown in fig. 4,is the unit vector of the axial direction of the magnetic capsule endoscope (i.e. the). The radial magnetization direction of the small magnet has a fixed relation with the magnetic capsule endoscope and is different from the axial direction of the magnetic capsule endoscope, so thatThereby, fromI.e. the current pose of the magnetic capsule endoscope is completely determined.
ByAndcalculating the roll angle increment of a magnetic capsule endoscope Is prepared from (A)Delta theta) is the attitude of the magnetic capsule endoscope before rotation.
In this example, useUpdatingRepeating steps 3 to 5, the posture of the magnetic capsule endoscope can be completely determined continuously.
In the present embodiment, N is 25, and the sensor coordinate (x) is known1,y1,z1)=(-0.16,-0.1685,0.017),(x2,y2,z2)=(-0.08,-0.1685,0.017),(x3,y3,z3)=(0,-0.1685,0.017),(x4,y4,z4)=(0.08,-0.1685,0.017),(x5,y5,z5)=(0.16,-0.1685,0.017),(x6,y6,z6)=(-0.16,0.0885,0.017),(x7,y7,z7)=(-0.08,0.0885,0.017),(x8,y8,z8)=(0,0.0885,0.017),(x9,y9,z9)=(0.08,0.0885,0.017),(x10,y10,z10)=(0.16,0.0885,0.017),(x11,y11,z11)=(-0.16,0.0085,0.017),(x12,y12,z12)=(-0.08,0.0085,0.017),(x13,y13,z13)=(0,0.0085,0.017),(x14,y14,z14)=(0.08,0.0085,0.017),(x15,y15,z15)=(0.16,0.0085,0.017),(x16,y16,z16)=(-0.16,-0.0715,0.017),(x17,y17,z17)=(-0.08,-0.0715,0.017),(x18,y18,z18)=(0,-0.0715,0.017),(x19,y19,z19)=(0.08,-0.0715,0.017),(x20,y20,z20)=(0.16,-0.0715,0.017),(x21,y21,z21)=(-0.16,-0.1515,0.017),(x22,y22,z22)=(-0.08,-0.1515,0.017),(x23,y23,z23)=(0,-0.1515,0.017),(x24,y24,z24)=(0.08,-0.1515,0.017),(x25,y25,z25)=(0.16,-0.1515,0.017)。
In this embodiment, the coordinates of the central point of the magnetic capsule endoscope are the same as the coordinates of the central point of the small permanent magnet, and the theoretical values are allThe magnetic capsule endoscope posture is set to be in the same direction with the positive X axis in the axial direction (the camera head end of the magnetic capsule endoscope is in the positive direction), and the radial magnetization direction is in the same direction with the positive Z axis, namely: the theoretical value of (r, s, t) is (1, 0, 0), (m, n, p) is (0, 0, 1), and the theoretical value of roll angle is 0 degrees.
Data of the No. 1 sensor is removed by setting over-small (less than 1) and over-large (over-sensor range) values as invalid valuesAndfrom the remaining 24 sensor dataAndcalculating to obtain:
ByCalculating to obtain:the coordinates (a, b, c) of the center position of the magnetic capsule endoscope are (0.002388, -0.002005, 0.118974). Then is made ofAndcalculating to obtain axial unit vector in attitude parameter of capsule lensByAndthe roll angle Δ θ is calculated to be 1.76 °, and is positive in the counterclockwise direction.
Due to theoretical value of position coordinatesTheoretical values of (r, s, t) are (1, 0, 0), (m, n, p) are (0, 0, 1), and theoretical values of roll angle are 0 °, so in this example, the capsule mirror is used Axial unit vector error | (r) in capsule mirror attitude parameters2,s2,t2) - (1, 0, 0) | (0.0026, 0.0543, 0.0463) converted to (4.13 °, 3.11 °, 2.65 °) angular errors (of the axial vectors respectively included in the three axes XYZ); the roll angle error in the attitude parameters is 1.76 degrees Δ θ -0.
The shape of the small magnet according to the present invention may be a cube having a square or polygonal cross section.
In the steps 1.1, 1.3 and 4 related by the invention, the radial magnetization direction vector of the small magnet is calculated, and the radial magnetization direction vector can be replaced by the existing magnetic dipole model and the improvement method thereof or the existing arbitrary method for calculating the magnetization direction of the magnetic source according to the magnetic induction intensity.
In step 2 according to the present invention, the posture of the external large magnet may be made to coincide with the initial posture of the magnetic capsule endoscope, and the following may be performed: the axial direction of the external large magnet and the estimated axial direction axis of the magnetic capsule endoscope (i.e. the axis of the magnetic capsule endoscope)) The two magnets are superposed (i.e. the external big magnet is coaxial with the magnetic capsule endoscope), and the radial magnetization direction of the big magnet and the radial magnetization direction of the small magnet (i.e. the radial magnetization direction of the small magnet)) The opposite is true. (in this case, in step 3, the rotation direction of the small magnet and the rotation direction of the external large magnet are the same direction.)
In step 5 designed by the present invention, the method can also be carried out byAndcalculating axial direction unit vector of magnetic capsule endoscopeThe calculation formula is as follows:
r=n0p2-n2p0;
s=m2p0-m0p2;
t=m0n2-m2n0;
it should be understood that the above description of the preferred embodiments is given for clarity and not for any purpose of limitation, and that various changes, substitutions and alterations can be made herein without departing from the spirit and scope of the invention as defined by the appended claims.
Claims (10)
1. A magnetic capsule endoscope full attitude determination method adopts a magnetic capsule endoscope; the permanent magnet arranged in the capsule endoscope is a small permanent magnet which is magnetized in the radial direction; the small permanent magnet is cylindrical or annular and is fixedly arranged in the magnetic capsule endoscope or fixed on the wall of the annular magnetic capsule endoscope shell, and the axial direction of the small permanent magnet is consistent with the axial direction of the magnetic capsule endoscope; a large permanent magnet is arranged outside the capsule endoscope and is a cylindrical strong permanent magnet which is magnetized in the radial direction;
characterized in that the method comprises the following steps:
step 1: estimating the initial attitude of the magnetic capsule endoscope, and determining the unit vector of the radial magnetization direction of the small permanent magnet in the magnetic capsule endoscopeAnd axial direction unit vector
The specific implementation comprises the following substeps:
step 1.1: calculating the unit vector of the radial magnetization direction of the small permanent magnet
Step 1.2: controlling the rotation of the magnetic capsule endoscope by using an external large permanent magnet according to the radial magnetization direction vector of the small permanent magnet;
step 1.3: calculating the unit vector of the radial magnetization direction of the small permanent magnet after rotation
Step 1.4: byAndcalculating the estimated axial direction unit vector of the magnetic capsule endoscope
Step 2: adjusting the posture of the external large permanent magnet to make the posture of the external large permanent magnet consistent with the current posture of the magnetic capsule endoscope;
and step 3: controlling the magnetic capsule endoscope to rotate around the axial central shaft by using an external large permanent magnet;
and 4, step 4: calculating the unit vector of the current radial magnetization direction of the small permanent magnet in the rotated magnetic capsule endoscope
2. The method for measuring the full attitude of a magnetic capsule endoscope according to claim 1, characterized in that: step 1.1, detecting the magnetic induction intensity generated by the small permanent magnet before rotating through a magnetic sensor arrayAccording toRegarding the small permanent magnet as a point source, and calculating the unit vector of the magnetization direction of the small permanent magnet
3. The method for measuring the full attitude of the magnetic capsule endoscope according to claim 2, characterized in that: the magnetic sensor array is composed of at least 5 triaxial magnetic sensors and is fixed outside the magnetic capsule endoscope.
4. The method for measuring the full attitude of a magnetic capsule endoscope according to claim 1, characterized in that: in step 1.2, firstly, the external large permanent magnet is placed, and the radial magnetization direction of the large permanent magnet and the radial magnetization direction of the small permanent magnet are enabled to be in the same direction; and then the external large permanent magnet is controlled to rotate by any small angle around the self axial central shaft, so that the magnetic field generated by the external large permanent magnet rotates, the rotating magnetic field drives the small permanent magnet and the magnetic capsule endoscope to rotate around the self axial central shaft together, and the rotating direction of the magnetic capsule endoscope is opposite to that of the external large magnet.
5. The method for measuring the full attitude of a magnetic capsule endoscope according to claim 1, characterized in that: in step 1.3, the magnetic induction intensity generated after the small permanent magnet rotates is detected through a magnetic sensor arrayAccording toRegarding the small permanent magnet as a point source, and calculating the unit vector of the magnetization direction of the small permanent magnet
6. The method for measuring the full attitude of a magnetic capsule endoscope according to claim 1, characterized in that: in step 1.4, the estimated axial direction unit vector of the magnetic capsule endoscope is calculated
Wherein r is n0p1-n1p0,s=m1p0-m0p1,t=m0n1-m1n0;
7. The method for measuring the full attitude of a magnetic capsule endoscope according to claim 1, characterized in that: in step 2, the axial direction of the external large permanent magnet is made to be the same as the estimated axial direction of the capsule endoscope, and the radial magnetization direction of the external large permanent magnet is made to be the same as the current radial magnetization direction of the small permanent magnet.
8. The method for measuring the full attitude of a magnetic capsule endoscope according to claim 1, characterized in that: in step 3, the external large permanent magnet is controlled to rotate by a small angle around the self axial central shaft, so that a magnetic field generated by the external large permanent magnet rotates, the rotating magnetic field drives the small permanent magnet and the magnetic capsule endoscope to rotate around the self axial central shaft, and the rotating direction of the magnetic capsule endoscope is opposite to that of the external large magnet.
9. The method for measuring the full attitude of a magnetic capsule endoscope according to claim 1,the method is characterized in that: in step 4, the magnetic induction intensity generated by the small permanent magnet after rotating in step 3 is detected through a magnetic sensor arrayAccording toRegarding the small permanent magnet as a point source, and calculating the unit vector of the magnetization direction of the small permanent magnet after rotating in the step 3Namely, it is
10. The method for measuring the full attitude of a magnetic capsule endoscope according to any one of claims 1 to 9, characterized in that: in step 5, calculating the unit vector of the magnetic capsule endoscope in the axial direction
Wherein r is n1p2-n2p1,s=m2p1-m1p2,t=m1n2-m2n1(ii) a The radial magnetization direction of the small permanent magnet has a fixed relation with the magnetic capsule endoscope and is different from the axial direction of the magnetic capsule endoscope, so that the vector of the radial magnetization direction of the small permanent magnetAnd axial direction vectorDetermining a current pose of the magnetic capsule endoscope; byAndcalculating the roll angle increment of the magnetic capsule endoscopeByDetermining the attitude of the magnetic capsule endoscope before rotation.
Priority Applications (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110570007.7A CN113288008B (en) | 2021-05-25 | 2021-05-25 | Magnetic capsule endoscope full-posture determination method |
JP2021102594A JP7270284B2 (en) | 2021-05-25 | 2021-06-21 | Operation method of magnetic capsule endoscope full-posture measurement system |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110570007.7A CN113288008B (en) | 2021-05-25 | 2021-05-25 | Magnetic capsule endoscope full-posture determination method |
Publications (2)
Publication Number | Publication Date |
---|---|
CN113288008A true CN113288008A (en) | 2021-08-24 |
CN113288008B CN113288008B (en) | 2023-07-18 |
Family
ID=77324602
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202110570007.7A Active CN113288008B (en) | 2021-05-25 | 2021-05-25 | Magnetic capsule endoscope full-posture determination method |
Country Status (2)
Country | Link |
---|---|
JP (1) | JP7270284B2 (en) |
CN (1) | CN113288008B (en) |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113917377A (en) * | 2021-10-09 | 2022-01-11 | 深圳市资福医疗技术有限公司 | Magnetic force measuring device |
CN115067863A (en) * | 2022-05-31 | 2022-09-20 | 元化智能科技(深圳)有限公司 | Wireless capsule endoscope driving system based on spherical driver |
Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
EP2135545A2 (en) * | 2008-06-19 | 2009-12-23 | Olympus Medical Systems Corporation | Magnetically guiding system and magnetically guiding method |
CN101801254A (en) * | 2007-09-11 | 2010-08-11 | 奥林巴斯医疗株式会社 | Capsule guiding system and capsule guiding method |
CN101826780A (en) * | 2009-03-07 | 2010-09-08 | 深圳先进技术研究院 | Method for driving magnet and method and system for driving capsule endoscope |
CN101842043A (en) * | 2007-10-30 | 2010-09-22 | 西门子公司 | Method for guiding a capsule endoscope and endoscope system |
US20180008131A1 (en) * | 2016-03-04 | 2018-01-11 | Olympus Corporation | Guidance apparatus and capsule medical apparatus guidance system |
CN208837887U (en) * | 2017-11-22 | 2019-05-10 | 湖北大学 | A kind of external permanent magnets coaxially control magnetic screw type capsule endoscopic device |
CN112515611A (en) * | 2020-11-30 | 2021-03-19 | 元化智能科技(深圳)有限公司 | Positioning method and device of wireless capsule endoscope and terminal equipment |
Family Cites Families (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2016157596A1 (en) * | 2015-03-31 | 2016-10-06 | オリンパス株式会社 | Capsule endoscope guidance system and capsule endoscope guidance apparatus |
-
2021
- 2021-05-25 CN CN202110570007.7A patent/CN113288008B/en active Active
- 2021-06-21 JP JP2021102594A patent/JP7270284B2/en active Active
Patent Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101801254A (en) * | 2007-09-11 | 2010-08-11 | 奥林巴斯医疗株式会社 | Capsule guiding system and capsule guiding method |
CN101842043A (en) * | 2007-10-30 | 2010-09-22 | 西门子公司 | Method for guiding a capsule endoscope and endoscope system |
EP2135545A2 (en) * | 2008-06-19 | 2009-12-23 | Olympus Medical Systems Corporation | Magnetically guiding system and magnetically guiding method |
CN101826780A (en) * | 2009-03-07 | 2010-09-08 | 深圳先进技术研究院 | Method for driving magnet and method and system for driving capsule endoscope |
US20180008131A1 (en) * | 2016-03-04 | 2018-01-11 | Olympus Corporation | Guidance apparatus and capsule medical apparatus guidance system |
CN208837887U (en) * | 2017-11-22 | 2019-05-10 | 湖北大学 | A kind of external permanent magnets coaxially control magnetic screw type capsule endoscopic device |
CN112515611A (en) * | 2020-11-30 | 2021-03-19 | 元化智能科技(深圳)有限公司 | Positioning method and device of wireless capsule endoscope and terminal equipment |
Non-Patent Citations (1)
Title |
---|
叶波 等: "胶囊内窥镜悬浮"同步"旋转控制模型研究", 科技经济市场, no. 3, pages 15 * |
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113917377A (en) * | 2021-10-09 | 2022-01-11 | 深圳市资福医疗技术有限公司 | Magnetic force measuring device |
CN115067863A (en) * | 2022-05-31 | 2022-09-20 | 元化智能科技(深圳)有限公司 | Wireless capsule endoscope driving system based on spherical driver |
CN115067863B (en) * | 2022-05-31 | 2023-03-14 | 元化智能科技(深圳)有限公司 | Wireless capsule endoscope driving system based on spherical driver |
Also Published As
Publication number | Publication date |
---|---|
JP7270284B2 (en) | 2023-05-10 |
CN113288008B (en) | 2023-07-18 |
JP2022181146A (en) | 2022-12-07 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
Song et al. | 6-D magnetic localization and orientation method for an annular magnet based on a closed-form analytical model | |
Popek et al. | Six-degree-of-freedom localization of an untethered magnetic capsule using a single rotating magnetic dipole | |
Bao et al. | Hybrid localization of microrobotic endoscopic capsule inside small intestine by data fusion of vision and RF sensors | |
CN113288008B (en) | Magnetic capsule endoscope full-posture determination method | |
CN107348931B (en) | Capsule endoscope space attitude determination system | |
JP2022547189A (en) | Flexible catheter magnetic tracking system and method using digital magnetometer | |
CN211633195U (en) | Magnetic positioning system of capsule endoscope | |
US20160037998A1 (en) | Endoscopic Operating System and Endoscopic Operation Program | |
CN112515611B (en) | Positioning method and device of wireless capsule endoscope and terminal equipment | |
CN106937860A (en) | Know the capsule endoscope system and its method of work of real-time pose | |
CN108759812B (en) | Relative positioning method for capsule robot and target to be measured in three-dimensional closed non-structural space | |
Di Natali et al. | A wireless platform for in vivo measurement of resistance properties of the gastrointestinal tract | |
CN107374566B (en) | A kind of full attitude sensing system of capsule endoscope based on variation magnetic field | |
Hu et al. | A new 6D magnetic localization technique for wireless capsule endoscope based on a rectangle magnet | |
CN115886692B (en) | Real-time positioning method, system and storage medium for magnetically-controlled suspension capsule robot | |
Li et al. | Calibrated analytical model for magnetic localization of wireless capsule endoscope based on onboard sensing | |
CN109620108B (en) | Double-hemispherical capsule robot bending intestinal visual navigation method | |
CN115067863B (en) | Wireless capsule endoscope driving system based on spherical driver | |
Liu et al. | Hybrid magnetic and vision localization technique of capsule endoscope for 3D recovery of pathological tissues | |
WO2022193411A1 (en) | Capsule endoscope system and magnetic positioning method for capsule endoscope of the system | |
CN113647893B (en) | Autonomous navigation system, device and medium for wireless capsule endoscope | |
Zhang et al. | A multimagnetometer array and inner IMU-based capsule endoscope positioning system | |
CN113545731B (en) | Capsule endoscope system | |
Wang et al. | Dynamic tracking for microrobot with active magnetic sensor array | |
Zhang et al. | Design and implementation of a highly integrated dual hemisphere capsule robot |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |