CN108042094B - Positioning system and positioning method for freedom degree of wireless capsule endoscope 5 - Google Patents

Positioning system and positioning method for freedom degree of wireless capsule endoscope 5 Download PDF

Info

Publication number
CN108042094B
CN108042094B CN201711405987.5A CN201711405987A CN108042094B CN 108042094 B CN108042094 B CN 108042094B CN 201711405987 A CN201711405987 A CN 201711405987A CN 108042094 B CN108042094 B CN 108042094B
Authority
CN
China
Prior art keywords
coil
capsule endoscope
wireless capsule
wireless
module
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.)
Active
Application number
CN201711405987.5A
Other languages
Chinese (zh)
Other versions
CN108042094A (en
Inventor
阳万安
成奎
戴厚德
胡超
蔡乐才
苏诗荐
陈冬君
李彦
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Yibin University
Original Assignee
Yibin University
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Yibin University filed Critical Yibin University
Priority to CN201711405987.5A priority Critical patent/CN108042094B/en
Publication of CN108042094A publication Critical patent/CN108042094A/en
Application granted granted Critical
Publication of CN108042094B publication Critical patent/CN108042094B/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • AHUMAN NECESSITIES
    • A61MEDICAL OR VETERINARY SCIENCE; HYGIENE
    • A61BDIAGNOSIS; SURGERY; IDENTIFICATION
    • A61B1/00Instruments 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/04Instruments 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/041Capsule endoscopes for imaging
    • AHUMAN NECESSITIES
    • A61MEDICAL OR VETERINARY SCIENCE; HYGIENE
    • A61BDIAGNOSIS; SURGERY; IDENTIFICATION
    • A61B1/00Instruments 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/00002Operational features of endoscopes
    • A61B1/00011Operational features of endoscopes characterised by signal transmission
    • A61B1/00016Operational features of endoscopes characterised by signal transmission using wireless means
    • AHUMAN NECESSITIES
    • A61MEDICAL OR VETERINARY SCIENCE; HYGIENE
    • A61BDIAGNOSIS; SURGERY; IDENTIFICATION
    • A61B1/00Instruments 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/00131Accessories for endoscopes
    • AHUMAN NECESSITIES
    • A61MEDICAL OR VETERINARY SCIENCE; HYGIENE
    • A61BDIAGNOSIS; SURGERY; IDENTIFICATION
    • A61B1/00Instruments 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/00147Holding or positioning arrangements
    • A61B1/00158Holding or positioning arrangements using magnetic field
    • AHUMAN NECESSITIES
    • A61MEDICAL OR VETERINARY SCIENCE; HYGIENE
    • A61BDIAGNOSIS; SURGERY; IDENTIFICATION
    • A61B1/00Instruments 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/04Instruments 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/045Control thereof
    • AHUMAN NECESSITIES
    • A61MEDICAL OR VETERINARY SCIENCE; HYGIENE
    • A61BDIAGNOSIS; SURGERY; IDENTIFICATION
    • A61B1/00Instruments 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/273Instruments 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/2736Gastroscopes
    • AHUMAN NECESSITIES
    • A61MEDICAL OR VETERINARY SCIENCE; HYGIENE
    • A61BDIAGNOSIS; SURGERY; IDENTIFICATION
    • A61B1/00Instruments 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/31Instruments 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 rectum, e.g. proctoscopes, sigmoidoscopes, colonoscopes
    • AHUMAN NECESSITIES
    • A61MEDICAL OR VETERINARY SCIENCE; HYGIENE
    • A61BDIAGNOSIS; SURGERY; IDENTIFICATION
    • A61B5/00Measuring for diagnostic purposes; Identification of persons
    • A61B5/07Endoradiosondes

Landscapes

  • Health & Medical Sciences (AREA)
  • Life Sciences & Earth Sciences (AREA)
  • Surgery (AREA)
  • Engineering & Computer Science (AREA)
  • General Health & Medical Sciences (AREA)
  • Biomedical Technology (AREA)
  • Public Health (AREA)
  • Veterinary Medicine (AREA)
  • Medical Informatics (AREA)
  • Molecular Biology (AREA)
  • Biophysics (AREA)
  • Animal Behavior & Ethology (AREA)
  • Pathology (AREA)
  • Physics & Mathematics (AREA)
  • Heart & Thoracic Surgery (AREA)
  • Nuclear Medicine, Radiotherapy & Molecular Imaging (AREA)
  • Optics & Photonics (AREA)
  • Radiology & Medical Imaging (AREA)
  • Gastroenterology & Hepatology (AREA)
  • Computer Networks & Wireless Communication (AREA)
  • Measurement Of The Respiration, Hearing Ability, Form, And Blood Characteristics Of Living Organisms (AREA)
  • Endoscopes (AREA)

Abstract

The invention provides a positioning system of 5 degrees of freedom of a wireless capsule endoscope and a positioning method thereof, comprising a transmitting coil, a sampling module, a position and direction calculating module, a wireless transmitting module, an external wireless receiving module and a wireless capsule endoscope positioned in a human body, wherein the transmitting coil is arranged outside the human body and is in triaxial quadrature; therefore, an equation set is established to calculate the three-dimensional position and the three-dimensional posture, the method is convenient to integrate, the single-shaft induction coil occupies little space of the wireless capsule endoscope, the wireless capsule endoscope can be positioned in real time and continuously, the follow-up operation is convenient, the safety and the reliability are realized, and the cost is low.

Description

Positioning system and positioning method for freedom degree of wireless capsule endoscope 5
[ field of technology ]
The invention relates to a magnetic positioning technology, in particular to a positioning system and a positioning method for the degree of freedom of a wireless capsule endoscope 5.
[ background Art ]
Currently, after the wireless capsule endoscope enters the alimentary canal of a human body, the wireless capsule endoscope freely moves under the combined action of gravity and peristalsis of the gastrointestinal tract, and the wireless capsule endoscope lacks real-time and accurate positioning. Therefore, the pose control work of the wireless capsule endoscope cannot be effectively performed; because the image has no position and direction matching information of the lens, digestive tract reconstruction work cannot be carried out; without real-time positioning data, the physician cannot confirm whether the capsule is stuck during the examination.
The Given Imaging company has used the radio frequency technology to locate the wireless capsule endoscope earlier, including Chongqing Jinshan technology Co. And (3) sticking 8 or more wireless radio frequency antennas on the surface of a human body, receiving radio frequency signals emitted by the in-vivo wireless capsule endoscope, establishing an equation set according to a radio frequency signal propagation model, and solving the equation set through an algorithm to obtain the position of the wireless capsule endoscope. The method has low positioning precision, the average positioning precision is 37.7 mm, and the clinical application effect is poor.
A wireless capsule endoscope permanent magnet positioning method is proposed, a small permanent magnet is embedded in the wireless capsule endoscope, or a permanent magnet ring is sleeved outside the capsule, a magnetic field sensor array is arranged around a human body to collect a multipoint magnetic field, an equation set is established according to a permanent magnet space distribution model, and the position of the wireless capsule endoscope is obtained by solving the equation set through an algorithm; the permanent magnet positioning has the advantages of high precision and high speed. However, the permanent magnet positioning has a relatively large defect that the positioning distance is short, and the effective detection distance of the permanent magnet capable of being put into the existing capsule is about 10cm, so that the requirement of human body size is difficult to meet.
It has also been proposed to arrange two triaxial induction coils in the capsule, and to make the permanent magnet reciprocate outside the capsule under the action of the vibration module to generate a varying magnetic field, and the two triaxial induction coils in the capsule output induced electromotive force; however, two triaxial induction coils occupy more space of the capsule.
Imaging examinations such as X-ray imaging, CT (computed tomography) imaging and MRI (magnetic resonance) imaging can also be used to locate wireless capsule endoscopes. However, X-ray imaging and CT imaging have radiation damage, and are not suitable for long-time positioning; MRI imaging is currently costly.
[ invention ]
In order to solve the defects in the prior art, the invention provides a wireless capsule endoscope 5 degree-of-freedom positioning system and a positioning method thereof based on an alternating magnetic field, wherein the wireless capsule endoscope adopts a triaxial transmitting coil and a uniaxial induction coil. The single-shaft coil occupies little space of the wireless capsule endoscope, is convenient to integrate, can be positioned in real time, is safe and reliable, has low cost, and has the advantage of providing convenience for subsequent operation.
In order to achieve the above purpose, the invention adopts the following technical scheme:
the invention provides a first vision-improving and wireless capsule endoscope 5-degree-of-freedom positioning system, which comprises a transmitting coil, a sampling module, a position and direction calculation module, an external wireless receiving module and a wireless capsule endoscope, wherein the transmitting coil, the sampling module, the position and direction calculation module, the external wireless receiving module and the wireless capsule endoscope are arranged outside a human body and are in triaxial orthogonality; the transmitting coil consists of a triaxial orthogonal coil I, a triaxial orthogonal coil II and a triaxial orthogonal coil III, the coil I, the coil II and the coil III sequentially transmit signals with fixed frequencies, the coil I, the coil II and the coil III sequentially transmit signals with 6 different frequencies and amplitudes to form a period, namely, each coil transmits signals with 2 different frequencies and amplitudes in one period.
Further, the wireless capsule endoscope further comprises a signal amplifying module and an analog-to-digital conversion module; the single-shaft induction coil is directly connected with the signal amplification module, and the signal amplification module is directly connected with the wireless transmission module.
Further, the wireless capsule endoscope is also provided with an acquisition filter module for filtering noise of acquired signals, and the external wireless receiving module is also connected with a receiving filter module for filtering noise of received sampling signals.
Further, the uniaxial induction coil is arranged on or in a direction parallel to a central axis of the wireless capsule endoscope.
Further, the coil I transmits 2 signals with different frequencies and amplitudes at fixed time intervals; then, the coil II transmits 2 signals with different frequencies and amplitudes from the coil I according to fixed time intervals; finally, the coil III transmits 2 signals with different frequencies and amplitudes from the coil I and the coil II at fixed time intervals.
Further, the coil I, the coil II and the coil III sequentially emit signals with 1 different frequency and amplitude; then, the coil I, the coil II and the coil III sequentially emit a signal with different frequency and amplitude from the previous signal.
The second object of the present invention is to provide a method for positioning the degree of freedom of a wireless capsule endoscope 5, in which a single-axis induction coil and a wireless transmission module are provided, comprising the steps of:
the method comprises the following steps that 1, a three-axis orthogonal transmitting coil is arranged outside a human body, and the transmitting coil consists of a three-axis orthogonal coil I, a three-axis orthogonal coil II and a three-axis orthogonal coil III;
step 2, taking a coordinate system OXYZ established by three axes of the transmitting coil as a reference coordinate system, wherein the coordinate of a center point of the single-axis induction coil in the OXYZ coordinate system is (x, y, z), and converting the coordinate into the position of the center of the wireless capsule endoscope in the reference coordinate system; the direction vector of the uniaxial induction coil in the OXYZ coordinate system is (vx, vy, vz) and represents the direction of the wireless capsule endoscope; the coordinates (x, y, z) and the direction vectors (vx, vy, vz) of the center point of the single-axis induction coil are positioning parameters;
step 3, after power-on, the coil I, the coil II and the coil III of the transmitting coil sequentially transmit 2 signals with different frequencies and amplitudes in each period;
step 4, an amplifying module in the wireless capsule endoscope amplifies the output voltage of the single-shaft induction coil;
step 5, the analog-to-digital conversion module in the wireless capsule endoscope samples the amplified output voltage;
step 6, a wireless transmitting module in the wireless capsule endoscope transmits a sampling signal;
step 7, the in-vitro wireless receiving module receives the sampling signal and sends the sampling signal to the position and direction calculating module;
and 8, calculating the position and direction information of the wireless capsule endoscope by a position and direction calculation module, wherein the process is as follows:
solving 6 unknown parameters (x, y, z, vx, vy, vz) of the position and the direction of the wireless capsule endoscope;
each axis of the triaxial transmitting coil is equivalent to a magnetic dipole, and the magnetic dipole generates magnetic flux density at the center of the uniaxial induction coil inside the wireless capsule endoscope according to the Bioshaval lawThree orthogonal components along the X, Y, Z axis of the reference coordinate system ozz are shown in equations (1), (2), (3):
wherein (x, y, z) is the position of the center of the uniaxial induction coil, (m, n, p) is the direction vector of each axis of the transmission coil, (a, B, c) is the position of the transmission coil, B T Is a constant related to the transmit coil, L is the distance of the sense coil from the transmit coil, L is as shown in equation (4):
magnetic flux densityIncluded angle with the direction vector of the uniaxial induction coil, magnetic flux density +.>The projection vector on the induction coil unit direction vector is as shown in formula (5):
wherein (vx, vy, vz) is the unit direction vector of the uniaxial induction coil,three orthogonal components along the X, Y, Z axis of the reference coordinate system ozz are shown in equations (6), (7), and (8), respectively:
the uniaxial induction coil outputs a voltage signal, and the induced electromotive force generated by the uniaxial induction coil is shown as formula (9) according to faraday's law of electromagnetic induction:
wherein N is the number of turns of the uniaxial induction coil, phi is the magnetic flux passing through the curved surface S, and t is the time;
since the uniaxial induction coil is small, the volume thereof can be ignored, and the magnetic flux density of the uniaxial induction coil is considered to be equal everywhere, so that the formula (9) becomes the formula (10):
because ofThe direction is the same as that of the uniaxial induction coil, so that the following formula (11) is obtained:
if a sinusoidal signal of known frequency is emitted, other signals of known frequency can of course be used, which cannot be used to define the signal employed for the emission, the magnetic flux density is described as shown in equation (12):
wherein,for maximum amplitude when the magnetic flux density is taken as a vector, ω is the angular frequency of the sinusoidal signal, +.>Is the initial phase of the sinusoidal signal;
thus, a relation between the output voltage value and the magnetic flux density of the uniaxial induction coil can be obtained, as shown in formula (13):
wherein B' max Is thatThe maximum amplitude of the projection vector on the unit direction vector (vx, vy, vz) where the uniaxial induction coil is located;
the output voltage signal of the single-axis induction coil is a cosine signal with the same frequency as the transmitting signal, and the amplitude of the signal is taken to establish an equation set, so that E T = - ωn·s, equation (14) is obtained:
ε max =-ωN·B' max ·S=E T ·B' max (14)
wherein ε max Is the maximum value of the induced electromotive force;
the amplitude of the cosine signal is extracted by the fast Fourier transform, and other methods can be used, so that the mode of extracting the amplitude of the cosine signal cannot be limited;
the triaxial transmitting coils sequentially transmit sinusoidal signals with respective amplitude and frequency, and in one period, the uniaxial induction coil outputs 6 groups of voltage signals, so that 6 equations can be established, and 6 unknown parameters describing the position and the direction of the wireless capsule endoscope are solved; since the direction vector (vx, vy, vz) of the single axis induction coil is a unit vector, a constraint equation is added as shown in equation (15):
vx 2 +vy 2 +vz 2 =1 (15)
setting epsilon i ' max (i=1, 2, 3, 4, 5, 6) is the output voltage amplitude of the uniaxial induction coil in the wireless capsule endoscope, ε imax Is a theoretical expression of the amplitude, and the definition error E is shown in formula (16):
the optimization algorithm, such as the Levenberg-Marquardt algorithm, can be used, but other methods can be used, and the adopted optimization algorithm can not be limited by the optimization algorithm; minimizing E, the position and direction parameters (x, y, z, vx, vy, vz) of the wireless capsule endoscope can be solved;
and 9, the position and direction calculation module sends the pose information of the wireless capsule endoscope to the display terminal to reflect the pose of the current wireless capsule endoscope in real time, so that the wireless capsule endoscope is convenient for an operator to observe or subsequently apply.
Further, the step 5 further includes: the acquisition filtering module arranged in the wireless capsule endoscope carries out noise filtering on the sampled signals.
Further, the step 7 further includes: the external wireless receiving module is also connected with a receiving filtering module for filtering noise of the received sampling signals.
Further, the transmitting frequency and amplitude modes of the coil I, the coil II and the coil III of the transmitting coil in the step 3 are as follows: firstly, a coil I transmits 2 signals with different frequencies and amplitudes at fixed time intervals; then, the coil II transmits 2 signals with different frequencies and amplitudes from the coil I according to fixed time intervals; finally, the coil III transmits 2 signals with different frequencies and amplitudes from the coil I and the coil II at fixed time intervals.
Further, the transmitting frequency and amplitude modes of the coil I, the coil II and the coil III of the transmitting coil in the step 3 are as follows: firstly, a coil I, a coil II and a coil III sequentially transmit signals with 1 different frequency and amplitude; then, the coil I, the coil II and the coil III sequentially emit a signal with different frequency and amplitude from the previous signal.
The beneficial effects of the invention are as follows:
the invention is based on alternating magnetic field, arrange the transmitting coil of triaxial orthogonality near human body, arrange a single-axis induction coil in the wireless capsule endoscope, set up reference coordinate system OXYZ with three axes that the transmitting coil is located, the single-axis induction coil central point is (x, y, z) in the coordinate system of OXYZ, can convert it into the position in reference coordinate system of the wireless capsule endoscope center; the direction vector of the uniaxial induction coil in the OXYZ coordinate system is (vx, vy, vz) and can represent the direction of the wireless capsule endoscope; the coordinates (x, y, z) and the direction vectors (vx, vy, vz) of the center point of the single axis induction coil are parameters of the positioning.
The coil I, the coil II and the coil III of the transmitting coil sequentially transmit 6 signals with different frequencies and amplitudes, and the coil I, the coil II and the coil III transmit 6 signals, which is called a period; the tri-axial coils transmit signals corresponding to the same in different periods. The single-axis induction coil can output 6 voltage signals with different frequencies and amplitudes in one period, so that an equation set containing 6 equations can be established, and the equation set is solved by adopting an optimization algorithm to obtain positioning parameters, so that 5-degree-of-freedom (position: 3-degree-of-freedom, direction: 2-degree-of-freedom) measurement is realized.
Through adopting a triaxial transmitting coil, a unipolar induction coil, unipolar induction coil occupies wireless capsule endoscope space is few, and is integrated convenient, but real-time positioning, safe and reliable, low cost can provide convenience for follow-up operation.
[ description of the drawings ]
FIG. 1 is an enlarged schematic view of the in vitro triaxial transmitting coil and the internal uniaxial coil arrangement of a wireless capsule endoscope according to the present invention;
fig. 2 is a positioning flow chart of the present invention.
[ detailed description ] of the invention
In order that the above objects, features and advantages of the invention will be readily understood, a more particular description of the invention will be rendered by reference to the appended drawings.
The positioning system of the freedom degree of the wireless capsule endoscope 5 is shown in fig. 1, and comprises a transmitting coil, a sampling module, a position and direction calculation module, an external wireless receiving module and a wireless capsule endoscope which are arranged outside a human body and are orthogonal in three axes, wherein the wireless capsule endoscope is internally provided with a single-axis induction coil and a wireless transmitting module, and the single-axis induction coil is arranged in the wireless capsule endoscope as shown in a part a in fig. 1; the three-axis orthogonal transmitting coil and the single-axis induction coil arranged in the wireless capsule endoscope form a magnetic circuit through an alternating magnetic field, the sampling module is directly connected with the single-axis induction coil arranged in the wireless capsule endoscope, the wireless transmitting module arranged in the wireless capsule endoscope is connected with the external wireless receiving module through wireless signals, and the position and direction calculating module is directly connected with the external wireless receiving module; the transmitting coil consists of a triaxial orthogonal coil I, a triaxial orthogonal coil II and a triaxial orthogonal coil III, wherein the coil I, the coil II and the coil III sequentially transmit signals with fixed frequencies, the coil I, the coil II and the coil III sequentially transmit signals with 6 different frequencies and amplitudes to form a period, namely, each coil transmits signals with 2 different frequencies and amplitudes in one period; the transmitting coil and the wireless capsule endoscope form a magnetic circuit through an alternating magnetic field, the wireless capsule endoscope is connected with the external wireless receiving module through wireless signals, and the pose calculating module is directly connected with the external wireless receiving module.
The wireless capsule endoscope also comprises a signal amplification module and an analog-to-digital (AD) conversion module, wherein the single-shaft induction coil is directly connected with the signal amplification module, and the signal amplification module is directly connected with the wireless transmission module; the wireless capsule endoscope is also internally provided with an acquisition filter module for filtering noise of acquired signals, and the external wireless receiving module is also connected with a receiving filter module for filtering noise of received sampling signals.
Continuing with fig. 1, the uniaxial induction coil is disposed on or parallel to the central axis of the wireless capsule endoscope; as shown in part b of fig. 1, the uniaxial induction coil is arranged in a direction parallel to the central axis of the wireless capsule endoscope; as shown in part c of fig. 1, the uniaxial induction coil is arranged on the central axis of the wireless capsule endoscope.
The transmitting frequency and amplitude in the coil I, the coil II and the coil III of the transmitting coil are transmitted in two modes, and one mode is as follows: firstly, a coil I transmits 2 signals with different frequencies and amplitudes at fixed time intervals; then, the coil II transmits 2 signals with different frequencies and amplitudes from the coil I according to fixed time intervals; finally, the coil III transmits 2 signals with different frequencies and amplitudes from the coil I and the coil II at fixed time intervals. Another way is: firstly, a coil I, a coil II and a coil III sequentially transmit signals with 1 different frequency and amplitude; then, the coil I, the coil II and the coil III sequentially emit a signal with different frequency and amplitude from the previous signal.
As shown in fig. 2, the positioning method of the degree of freedom of the wireless capsule endoscope 5 according to this embodiment is provided with a single-axis induction coil and a wireless transmission module, and includes the following steps:
the method comprises the following steps that 1, a three-axis orthogonal transmitting coil is arranged outside a human body, and the transmitting coil consists of a three-axis orthogonal coil I, a three-axis orthogonal coil II and a three-axis orthogonal coil III;
step 2, taking a coordinate system OXYZ established by three axes of the transmitting coil as a reference coordinate system, wherein the coordinate of a center point of the single-axis induction coil in the OXYZ coordinate system is (x, y, z), and converting the coordinate into the position of the center of the wireless capsule endoscope in the reference coordinate system; the direction vector of the uniaxial induction coil in the OXYZ coordinate system is (vx, vy, vz) and represents the direction of the wireless capsule endoscope; the coordinates (x, y, z) and the direction vectors (vx, vy, vz) of the center point of the single-axis induction coil are positioning parameters;
step 3, after power-on, the coil I, the coil II and the coil III of the transmitting coil sequentially transmit 2 signals with different frequencies and amplitudes in each period;
step 4, an amplifying module in the wireless capsule endoscope amplifies the output voltage of the single-shaft induction coil;
step 5, the analog-to-digital (AD) conversion module in the wireless capsule endoscope samples the amplified output voltage, and the step 5 also comprises a collection filtering module arranged in the wireless capsule endoscope for noise filtering of the sampled signals;
step 6, a wireless transmitting module in the wireless capsule endoscope transmits a sampling signal;
step 7, the in-vitro wireless receiving module receives the sampling signal and sends the sampling signal to the position and direction calculating module; in the step, the external wireless receiving module is also connected with a receiving filtering module for filtering noise of the received sampling signal;
and 8, calculating the position and direction information of the wireless capsule endoscope by a position and direction calculation module, wherein the process is as follows:
solving 6 unknown parameters (x, y, z, vx, vy, vz) of the position and the direction of the wireless capsule endoscope;
each axis of the triaxial transmitting coil is equivalent to a magnetic dipole, and the magnetic dipole generates magnetic flux density at the center of the uniaxial induction coil inside the wireless capsule endoscope according to the Bioshaval lawThree orthogonal components along the X, Y, Z axis of the reference coordinate system ozz are shown in equations (1), (2), (3):
where (x, y, z) is the position of the center of the uniaxial induction coil, (m, n,p) is the direction vector of each axis of the transmitting coil, (a, B, c) is the position of the transmitting coil, B T Is a constant related to the transmit coil, L is the distance of the sense coil from the transmit coil, L is as shown in equation (4):
magnetic flux densityIncluded angle with the direction vector of the uniaxial induction coil, magnetic flux density +.>The projection vector on the induction coil unit direction vector is as shown in formula (5):
wherein (vx, vy, vz) is the unit direction vector of the uniaxial induction coil,three orthogonal components along the X, Y, Z axis of the reference coordinate system ozz are shown in equations (6), (7), and (8), respectively:
the uniaxial induction coil outputs a voltage signal, and the induced electromotive force generated by the uniaxial induction coil is shown as formula (9) according to faraday's law of electromagnetic induction:
wherein N is the number of turns of the uniaxial induction coil, phi is the magnetic flux passing through the curved surface S, t is time, and the induced electromotive force epsilon is the change rate of the magnetic flux density;
since the uniaxial induction coil is small, the volume thereof can be ignored, and the magnetic flux density of the uniaxial induction coil is considered to be equal everywhere, so that the formula (9) becomes the formula (10):
because ofThe direction is the same as that of the uniaxial induction coil, so that the following formula (11) is obtained:
if a sinusoidal signal of known frequency is emitted, other signals of known frequency can of course be used, which cannot be used to define the signal employed for the emission, the magnetic flux density is described as shown in equation (12):
wherein,for maximum amplitude when the magnetic flux density is taken as a vector, ω is the angular frequency of the sinusoidal signal, +.>Is the initial phase of the sinusoidal signal;
thus, a relation between the output voltage value and the magnetic flux density of the uniaxial induction coil can be obtained, as shown in formula (13):
wherein B' max Is thatThe maximum amplitude of the projection vector on the unit direction vector (vx, vy, vz) where the uniaxial induction coil is located;
the output voltage signal of the single-axis induction coil is a cosine signal with the same frequency as the transmitting signal, and the amplitude of the signal is taken to establish an equation set, so that E T = - ωn·s, equation (14) is obtained:
ε max =-ωN·B' max ·S=E T ·B' max (14)
wherein ε max Is the maximum value of the induced electromotive force;
the amplitude of the cosine signal is extracted by the fast Fourier transform, and other methods can be used, so that the mode of extracting the amplitude of the cosine signal cannot be limited;
the triaxial transmitting coils sequentially transmit sinusoidal signals with respective amplitude and frequency, and in one period, the uniaxial induction coil outputs 6 groups of voltage signals, so that 6 equations can be established, and 6 unknown parameters describing the position and the direction of the wireless capsule endoscope are solved; since the direction vector (vx, vy, vz) of the single axis induction coil is a unit vector, a constraint equation is added as shown in equation (15):
vx 2 +vy 2 +vz 2 =1 (15)
set epsilon' imax (i=1, 2, 3, 4, 5, 6) is the output voltage amplitude of the uniaxial induction coil in the wireless capsule endoscope, ε imax Is a theoretical expression of the amplitude, and the definition error E is shown in formula (16):
the optimization algorithm, such as the Levenberg-Marquardt algorithm, can be used, but other methods can be used, and the adopted optimization algorithm can not be limited by the optimization algorithm; minimizing E, the position and direction parameters (x, y, z, vx, vy, vz) of the wireless capsule endoscope can be solved;
and 9, the position and direction calculation module sends the pose information of the wireless capsule endoscope to the display terminal to reflect the pose of the current wireless capsule endoscope in real time, so that the wireless capsule endoscope is convenient for an operator to observe or subsequently apply.
The above embodiments are merely preferred embodiments of the present invention, and are not intended to limit the scope of the present invention, except as exemplified in the detailed description, all equivalent changes according to the principles of the present invention shall be included in the scope of the present invention.

Claims (11)

1. The utility model provides a wireless capsule endoscope 5 positioning system of degree of freedom, including setting up outside the human body and triaxial quadrature transmitting coil, position and direction calculation module, external wireless receiving module and be located internal wireless capsule endoscope, its characterized in that:
the wireless capsule endoscope is internally provided with a single-axis induction coil, a sampling module and a wireless transmitting module, wherein a magnetic circuit is formed by a triaxial orthogonal transmitting coil and the single-axis induction coil arranged in the wireless capsule endoscope through an alternating magnetic field, the sampling module is directly connected with the single-axis induction coil arranged in the wireless capsule endoscope, the wireless transmitting module arranged in the wireless capsule endoscope is connected with an external wireless receiving module through wireless signals, and the position and direction calculating module is directly connected with the external wireless receiving module;
the transmitting coil consists of a coil I, a coil II and a coil III which are orthogonal in triaxial, the coil I, the coil II and the coil III sequentially transmit signals with respective frequencies, and the coil I, the coil II and the coil III sequentially transmit signals with 6 different frequencies and amplitudes to form a period, namely, each coil transmits signals with 2 different frequencies and amplitudes in one period.
2. The system for locating the degree of freedom of a wireless capsule endoscope 5 of claim 1, wherein the wireless capsule endoscope further comprises a signal amplification module and an analog to digital conversion module; the single-shaft induction coil is directly connected with the signal amplification module, and the signal amplification module is directly connected with the sampling module.
3. The positioning system of the degree of freedom of the wireless capsule endoscope 5 according to claim 1 or 2, wherein the wireless capsule endoscope is further provided with an acquisition filter module for filtering the acquired signal, and the external wireless receiving module is further connected with a receiving filter module for noise filtering the received sampling signal.
4. The system for positioning the degrees of freedom of a wireless capsule endoscope 5 according to claim 1, wherein said single axis induction coil is arranged on or in a direction parallel to the central axis of the wireless capsule endoscope.
5. The system for locating the degrees of freedom of a wireless capsule endoscope 5 according to claim 1, wherein said coil I transmits 2 signals of different frequency and amplitude at fixed time intervals; then, the coil II transmits 2 signals with different frequencies and amplitudes from the coil I according to fixed time intervals; finally, the coil III transmits 2 signals with different frequencies and amplitudes from the coil I and the coil II at fixed time intervals.
6. The system for locating the degrees of freedom of a wireless capsule endoscope 5 according to claim 1, wherein said coil I, coil II, coil III sequentially emit signals of 1 different frequency and amplitude; then, the coil I, the coil II and the coil III sequentially emit a signal with different frequency and amplitude from the previous signal.
7. The method for positioning the degree of freedom of the wireless capsule endoscope 5 is characterized by comprising the following steps of:
the method comprises the following steps that 1, a three-axis orthogonal transmitting coil is arranged outside a human body, and the transmitting coil consists of a three-axis orthogonal coil I, a three-axis orthogonal coil II and a three-axis orthogonal coil III;
step 2, taking a coordinate system OXYZ established by three axes of the transmitting coil as a reference coordinate system, wherein the coordinate of a center point of the single-axis induction coil in the OXYZ coordinate system is (x, y, z), and converting the coordinate into the position of the center of the wireless capsule endoscope in the reference coordinate system; the direction vector of the uniaxial induction coil in the OXYZ coordinate system is (vx, vy, vz) and represents the direction of the wireless capsule endoscope; the coordinates (x, y, z) and the direction vectors (vx, vy, vz) of the center point of the single-axis induction coil are positioning parameters;
step 3, after power-on, the coil I, the coil II and the coil III of the transmitting coil sequentially transmit 2 signals with different frequencies and amplitudes in each period;
step 4, an amplifying module in the wireless capsule endoscope amplifies the output voltage of the single-shaft induction coil;
step 5, the analog-to-digital conversion module in the wireless capsule endoscope samples the amplified output voltage;
step 6, a wireless transmitting module in the wireless capsule endoscope transmits a sampling signal;
step 7, the in-vitro wireless receiving module receives the sampling signal and sends the sampling signal to the position and direction calculating module;
and 8, calculating the position and direction information of the wireless capsule endoscope by a position and direction calculation module, wherein the process is as follows:
solving 6 unknown parameters (x, y, z, vx, vy, vz) of the position and the direction of the wireless capsule endoscope;
each axis of the triaxial transmitting coil is equivalent to a magnetic dipole, and the magnetic dipole generates magnetic flux density at the center of the uniaxial induction coil inside the wireless capsule endoscope according to the Bioshaval law Three orthogonal components along the X, Y, Z axis of the reference coordinate system ozz are shown in equations (1), (2), (3):
wherein (x, y, z) is the position of the center of the uniaxial induction coil, (m, n, p) is the direction vector of each axis of the transmission coil, (a, B, c) is the position of the transmission coil, B T Is a constant related to the transmit coil, L is the distance of the sense coil from the transmit coil, L is as shown in equation (4):
magnetic flux densityIncluded angle with the direction vector of the uniaxial induction coil, magnetic flux density +.>The projection vector on the induction coil unit direction vector is shown in formula (5):
wherein (vx, vy, vz) is the unit direction vector of the uniaxial induction coil,three orthogonal components along the X, Y, Z axis of the reference coordinate system ozz are shown in equations (6), (7), and (8), respectively:
the uniaxial induction coil outputs a voltage signal, and the induced electromotive force generated by the uniaxial induction coil is shown as formula (9) according to faraday's law of electromagnetic induction:
wherein N is the number of turns of the uniaxial induction coil, phi is the magnetic flux passing through the curved surface S, and t is the time;
since the uniaxial induction coil is very small, its volume can be ignored, and the magnetic flux density of the uniaxial induction coil is considered to be equal everywhere, so equation (9) becomes as shown in equation (10):
because ofThe direction is the same as that of the uniaxial induction coil, so that the following formula (11) is obtained:
if a sinusoidal signal of known frequency is emitted, the magnetic flux density is described as shown in equation (12):
wherein,for maximum amplitude when the magnetic flux density is taken as a vector, ω is the angular frequency of the sinusoidal signal, +.>Is the initial phase of the sinusoidal signal;
thus, a relation between the output voltage value and the magnetic flux density of the uniaxial induction coil can be obtained, as shown in formula (13):
wherein B' max Is thatThe maximum amplitude of the projection vector on the unit direction vector (vx, vy, vz) where the uniaxial induction coil is located;
the output voltage signal of the single-axis induction coil is a cosine signal with the same frequency as the transmitting signal, and the amplitude of the signal is taken to establish an equation set, so that E T = - ωn·s, equation (14) is obtained:
ε max =-ωN·B' max ·S=E T ·B' max (14)
wherein ε max Is the maximum value of the induced electromotive force;
extracting the amplitude of the cosine signal by using fast Fourier transformation;
the triaxial transmitting coils sequentially transmit sinusoidal signals with respective amplitude and frequency, and in one period, the uniaxial induction coil outputs 6 groups of voltage signals, so that 6 equations can be established, and 6 unknown parameters describing the position and the direction of the wireless capsule endoscope are solved; since the direction vector (vx, vy, vz) of the single axis induction coil is a unit vector, a constraint equation is added as shown in equation (15):
vx 2 +vy 2 +vz 2 =1 (15)
set epsilon' imax (i=1, 2, 3, 4, 5, 6) is the output voltage amplitude of the uniaxial induction coil in the wireless capsule endoscope, ε imax Is a theoretical expression of the amplitude, and the definition error E is shown in formula (16):
the position and direction parameters (x, y, z, vx, vy, vz) of the wireless capsule endoscope can be solved by utilizing an optimization algorithm to minimize E;
and 9, the position and direction calculation module sends the pose information of the wireless capsule endoscope to the display terminal to reflect the pose of the current wireless capsule endoscope in real time, so that the wireless capsule endoscope is convenient for an operator to observe or subsequently apply.
8. The method for positioning the degrees of freedom of the wireless capsule endoscope 5 according to claim 7, wherein the step 5 further comprises: the acquisition filtering module arranged in the wireless capsule endoscope carries out noise filtering on the sampled signals.
9. The method for positioning the degrees of freedom of the wireless capsule endoscope 5 according to claim 7, wherein the step 7 further comprises: the external wireless receiving module is also connected with a receiving filtering module for filtering noise of the received sampling signals.
10. The method for positioning the degrees of freedom of the wireless capsule endoscope 5 according to claim 7, wherein the transmitting frequency and amplitude modes of the coil I, the coil II and the coil III of the transmitting coil in the step 3 are as follows: firstly, a coil I transmits 2 signals with different frequencies and amplitudes at fixed time intervals; then, the coil II transmits 2 signals with different frequencies and amplitudes from the coil I according to fixed time intervals; finally, the coil III transmits 2 signals with different frequencies and amplitudes from the coil I and the coil II at fixed time intervals.
11. The method for positioning the degrees of freedom of the wireless capsule endoscope 5 according to claim 7, wherein the transmitting frequency and amplitude modes of the coil I, the coil II and the coil III of the transmitting coil in the step 3 are as follows: firstly, a coil I, a coil II and a coil III sequentially transmit signals with 1 different frequency and amplitude; then, the coil I, the coil II and the coil III sequentially emit a signal with different frequency and amplitude from the previous signal.
CN201711405987.5A 2017-12-22 2017-12-22 Positioning system and positioning method for freedom degree of wireless capsule endoscope 5 Active CN108042094B (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201711405987.5A CN108042094B (en) 2017-12-22 2017-12-22 Positioning system and positioning method for freedom degree of wireless capsule endoscope 5

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201711405987.5A CN108042094B (en) 2017-12-22 2017-12-22 Positioning system and positioning method for freedom degree of wireless capsule endoscope 5

Publications (2)

Publication Number Publication Date
CN108042094A CN108042094A (en) 2018-05-18
CN108042094B true CN108042094B (en) 2024-02-13

Family

ID=62131593

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201711405987.5A Active CN108042094B (en) 2017-12-22 2017-12-22 Positioning system and positioning method for freedom degree of wireless capsule endoscope 5

Country Status (1)

Country Link
CN (1) CN108042094B (en)

Families Citing this family (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN110292347B (en) * 2019-07-24 2022-06-03 河南省人民医院 Auxiliary examination device for digestive system department
CN111256692B (en) * 2020-03-01 2023-03-10 中北大学 Capsule robot attitude determination system and method based on sensor and one-dimensional coil
CN111207737B (en) * 2020-03-01 2023-03-24 中北大学 Capsule robot posture measuring system and method based on three-dimensional coil
CN111839431B (en) * 2020-07-24 2024-03-01 福建世新机器人科技有限公司 Wireless capsule robot system and control method
CN114543645B (en) * 2022-02-21 2024-01-30 成都思瑞定生命科技有限公司 Magnetic field target positioning system and method
CN115153412B (en) * 2022-09-09 2022-11-04 北京华信佳音医疗科技发展有限责任公司 Colonoscope system and control method thereof

Citations (14)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN1620985A (en) * 2004-12-16 2005-06-01 上海交通大学 In vitro electro-magnetism excitation positioning system for remotely monitoring capsule swallowed in digestive tract
CN1679444A (en) * 2004-04-07 2005-10-12 奥林巴斯株式会社 In vivo position display system
JP2008275395A (en) * 2007-04-26 2008-11-13 Asahi Kasei Electronics Co Ltd Position attitude detection system, its detection method, and position attitude detection device
WO2008138962A1 (en) * 2007-05-16 2008-11-20 Siemens Aktiengesellschaft Miniaturized device
JP2009061013A (en) * 2007-09-05 2009-03-26 Fujifilm Corp Capsule endoscope position detecting device, position detecting method, and capsule endoscope system
CN101478910A (en) * 2006-06-29 2009-07-08 奥林巴斯医疗株式会社 Capsule medical device and capsule medical device system
CN101513340A (en) * 2009-03-19 2009-08-26 上海交通大学 Capsule endoscope system of energy supply in vitro
CN101909541A (en) * 2008-01-17 2010-12-08 西门子公司 Coil arrangement for guiding a magnetic element in a working space
CN101975938A (en) * 2010-09-03 2011-02-16 中国科学院深圳先进技术研究院 Five-dimensional positioning method and system based on radio-frequency signals
CN102188246A (en) * 2010-03-10 2011-09-21 北方数字化技术公司 Magnetic tracking system, device and method
JP2014166306A (en) * 2013-01-30 2014-09-11 Yamaha Corp Position recognition device for capsule type endoscope
CN106983487A (en) * 2017-03-14 2017-07-28 宜宾学院 The alignment system and its localization method of Wireless capsule endoscope three-dimensional position and 3 d pose
CN107348931A (en) * 2017-05-27 2017-11-17 重庆金山医疗器械有限公司 A kind of capsule endoscope spatial attitude assay method, system and device
CN208598353U (en) * 2017-12-22 2019-03-15 宜宾学院 The positioning system of Wireless capsule endoscope 5DOF

Family Cites Families (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US7623904B2 (en) * 2003-08-06 2009-11-24 Olympus Corporation Medical apparatus, medical apparatus guide system, capsule type medical apparatus, and capsule type medical apparatus guide apparatus

Patent Citations (14)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN1679444A (en) * 2004-04-07 2005-10-12 奥林巴斯株式会社 In vivo position display system
CN1620985A (en) * 2004-12-16 2005-06-01 上海交通大学 In vitro electro-magnetism excitation positioning system for remotely monitoring capsule swallowed in digestive tract
CN101478910A (en) * 2006-06-29 2009-07-08 奥林巴斯医疗株式会社 Capsule medical device and capsule medical device system
JP2008275395A (en) * 2007-04-26 2008-11-13 Asahi Kasei Electronics Co Ltd Position attitude detection system, its detection method, and position attitude detection device
WO2008138962A1 (en) * 2007-05-16 2008-11-20 Siemens Aktiengesellschaft Miniaturized device
JP2009061013A (en) * 2007-09-05 2009-03-26 Fujifilm Corp Capsule endoscope position detecting device, position detecting method, and capsule endoscope system
CN101909541A (en) * 2008-01-17 2010-12-08 西门子公司 Coil arrangement for guiding a magnetic element in a working space
CN101513340A (en) * 2009-03-19 2009-08-26 上海交通大学 Capsule endoscope system of energy supply in vitro
CN102188246A (en) * 2010-03-10 2011-09-21 北方数字化技术公司 Magnetic tracking system, device and method
CN101975938A (en) * 2010-09-03 2011-02-16 中国科学院深圳先进技术研究院 Five-dimensional positioning method and system based on radio-frequency signals
JP2014166306A (en) * 2013-01-30 2014-09-11 Yamaha Corp Position recognition device for capsule type endoscope
CN106983487A (en) * 2017-03-14 2017-07-28 宜宾学院 The alignment system and its localization method of Wireless capsule endoscope three-dimensional position and 3 d pose
CN107348931A (en) * 2017-05-27 2017-11-17 重庆金山医疗器械有限公司 A kind of capsule endoscope spatial attitude assay method, system and device
CN208598353U (en) * 2017-12-22 2019-03-15 宜宾学院 The positioning system of Wireless capsule endoscope 5DOF

Non-Patent Citations (2)

* Cited by examiner, † Cited by third party
Title
Li, M ; Song, S等.A New Calibration Method for Magnetic Sensor Array for Tracking Capsule Endoscope.IEEE International Conference on Robotics and Biomimetics (ROBIO).2009,第1-4卷1561. *
无线胶囊内镜的精确定位跟踪技术;尤晓赫;《中国优秀硕士学位论文全文数据库 (工程科技Ⅱ辑)》(第2017年第08期);C030-21 *

Also Published As

Publication number Publication date
CN108042094A (en) 2018-05-18

Similar Documents

Publication Publication Date Title
CN108042094B (en) Positioning system and positioning method for freedom degree of wireless capsule endoscope 5
CN103637803B (en) Based on capsule endoscope space positioning system and the localization method of permanent magnetism and induction coil
CN100594840C (en) Method and system for tracking internal mini device
KR100954650B1 (en) Encapsulated medical device
CN106983487B (en) The positioning system and its localization method of Wireless capsule endoscope three-dimensional position and 3 d pose
EP1731093B1 (en) System for detecting position in examinee
JP4520198B2 (en) In-subject position display system
JP4286127B2 (en) In-subject position detection system
Hu et al. Locating intra-body capsule object by three-magnet sensing system
US7398117B2 (en) System for detecting position of capsule endoscope in subject
WO2021048837A1 (en) Magnetic flexible catheter tracking system and method using digital magnetometers
Song et al. Magnetic tracking of wireless capsule endoscope in mobile setup based on differential signals
JP5165161B2 (en) Location information estimation system
JP2019080934A (en) Position tracking system
Chandra et al. Localization of an RF source inside the human body for wireless capsule endoscopy
CN107205612B (en) Position detecting system and method for detecting position
CN1481754A (en) System and position tracing method for dynamic positioning and tracing internal miniature apparatus
Pham et al. A real-time localization system for an endoscopic capsule
CN208598353U (en) The positioning system of Wireless capsule endoscope 5DOF
Guo et al. Wireless localization for a capsule endoscopy: Techniques and solutions
Li et al. Calibrated analytical model for magnetic localization of wireless capsule endoscope based on onboard sensing
CN201052144Y (en) Dressing article with detecting unit
Guo et al. Optimization of multilayer cylindrical coils in a wireless localization system to track a capsule-shaped micro-device
CN114159163A (en) Soft-lens-oriented magnetic navigation system and method
Guo et al. A position telemetric method for implantable microcapsules in the gastrointestinal tract

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