CN111207737B - Capsule robot posture measuring system and method based on three-dimensional coil - Google Patents
Capsule robot posture measuring system and method based on three-dimensional coil Download PDFInfo
- Publication number
- CN111207737B CN111207737B CN202010133126.1A CN202010133126A CN111207737B CN 111207737 B CN111207737 B CN 111207737B CN 202010133126 A CN202010133126 A CN 202010133126A CN 111207737 B CN111207737 B CN 111207737B
- Authority
- CN
- China
- Prior art keywords
- coil
- circuit
- capsule robot
- wireless
- voltage
- 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
Links
Images
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/04—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by terrestrial means
- G01C21/06—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by terrestrial means involving measuring of drift angle; involving correction for drift
-
- G—PHYSICS
- G08—SIGNALLING
- G08C—TRANSMISSION SYSTEMS FOR MEASURED VALUES, CONTROL OR SIMILAR SIGNALS
- G08C17/00—Arrangements for transmitting signals characterised by the use of a wireless electrical link
- G08C17/02—Arrangements for transmitting signals characterised by the use of a wireless electrical link using a radio link
-
- H—ELECTRICITY
- H02—GENERATION; CONVERSION OR DISTRIBUTION OF ELECTRIC POWER
- H02J—CIRCUIT ARRANGEMENTS OR SYSTEMS FOR SUPPLYING OR DISTRIBUTING ELECTRIC POWER; SYSTEMS FOR STORING ELECTRIC ENERGY
- H02J50/00—Circuit arrangements or systems for wireless supply or distribution of electric power
- H02J50/20—Circuit arrangements or systems for wireless supply or distribution of electric power using microwaves or radio frequency waves
Landscapes
- Engineering & Computer Science (AREA)
- Computer Networks & Wireless Communication (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Power Engineering (AREA)
- Automation & Control Theory (AREA)
- Near-Field Transmission Systems (AREA)
Abstract
The invention relates to a capsule robot posture measuring technology, in particular to a capsule robot posture measuring system and method based on a three-dimensional coil. The invention solves the problems that the existing capsule robot gesture measuring technology has inaccurate gesture measuring result and is not beneficial to realizing real-time gesture measurement. The capsule robot posture measuring system based on the three-dimensional coil comprises a wireless power transmitting coil A arranged outside the body, a wireless power transmitting coil B arranged outside the body, a three-dimensional wireless power receiving coil arranged on the capsule robot, an airborne circuit arranged on the capsule robot, a wireless signal receiving circuit arranged outside the body and an upper computer arranged outside the body; the wireless electric energy transmitting coil A and the wireless electric energy transmitting coil B are both Helmholtz coils and are arranged in a mutually orthogonal mode. The invention is suitable for the attitude determination of the capsule robot.
Description
Technical Field
The invention relates to a capsule robot posture measuring technology, in particular to a capsule robot posture measuring system and method based on a three-dimensional coil.
Background
The capsule robot is a micro robot which can enter the intestinal tract of a human body through the oral cavity or the anus, and can autonomously move in the intestinal tract to finish the non-invasive examination of the intestinal tract inner cavity. In the process of examination, the posture of the capsule robot changes randomly along with the change of the intestinal environment, so that the capsule robot cannot position the focus. For this reason, the posture of the capsule robot needs to be measured to realize the localization of the lesion. Under the prior art, the attitude measurement of the capsule robot is mainly carried out by adopting a nine-axis attitude sensor (consisting of a three-axis accelerometer, a three-axis gyroscope and a three-axis magnetometer). However, in practical application, the existing capsule robot attitude determination technology is limited by its own principle, and has the following problems: first, the capsule robot is powered by a wireless power transmission system (consisting of a wireless power transmitting coil and a wireless power receiving coil). In a wireless power transmission system, a transmission medium of wireless power is an alternating magnetic field, and the alternating magnetic field can cause serious magnetic interference to a three-axis magnetometer in a nine-axis attitude sensor, so that the measurement result of the three-axis magnetometer is inaccurate, and the attitude measurement result is inaccurate. Secondly, the existing capsule robot attitude measurement technology has the problem of large computation amount when the attitude angle of the capsule robot is calculated, so that the existing capsule robot attitude measurement technology is not beneficial to realizing real-time measurement of the attitude. Therefore, the system and the method for measuring the posture of the capsule robot based on the three-dimensional coil are needed to be invented, so that the problems that the posture measurement result is inaccurate and the posture is not favorable for realizing real-time measurement of the posture in the existing capsule robot posture measurement technology are solved.
Disclosure of Invention
The invention provides a capsule robot attitude determination system and method based on three-dimensional coils, and aims to solve the problems that an existing capsule robot attitude determination technology is inaccurate in attitude determination result and not beneficial to achieving real-time determination of attitude.
The invention is realized by adopting the following technical scheme:
the capsule robot attitude determination system based on the three-dimensional coil comprises a wireless electric energy transmitting coil A arranged outside a body, a wireless electric energy transmitting coil B arranged outside the body, a three-dimensional wireless electric energy receiving coil arranged on a capsule robot, an onboard circuit arranged on the capsule robot, a wireless signal receiving circuit arranged outside the body and an upper computer arranged outside the body;
the wireless electric energy transmitting coil A and the wireless electric energy transmitting coil B are Helmholtz coils and are arranged in a mutually orthogonal mode;
the three-dimensional wireless power receiving coil comprises a coil a, a coil b and a coil c;
the coil a and the coil b are both rectangular coils; the coil c is a circular coil; the coils a, b and c are mutually orthogonally arranged pairwise, and the central axis of the coil c is superposed with the central axis of the capsule robot;
the airborne circuit comprises a sampling circuit a, a sampling circuit b, a sampling circuit c, an ADC module, a main control circuit, a wireless signal transmitting circuit, a rectifying circuit a, a rectifying circuit b, a rectifying circuit c and a voltage stabilizing circuit;
the input end of the sampling circuit a is connected with one end of the coil a; the input end of the sampling circuit b is connected with one end of the coil b; the input end of the sampling circuit c is connected with one end of the coil c; the output end of the sampling circuit a, the output end of the sampling circuit b and the output end of the sampling circuit c are connected with the input end of the ADC module; the output end of the ADC module is connected with the input end of the main control circuit; the output end of the main control circuit is connected with the input end of the wireless signal transmitting circuit;
two input ends of the rectifying circuit a are respectively connected with two ends of the coil a; two input ends of the rectification circuit b are respectively connected with two ends of the coil b; two input ends of the rectification circuit c are respectively connected with two ends of the coil c; the positive output end of the rectification circuit a is connected with the positive input end of the voltage stabilizing circuit; the negative output end of the rectification circuit a is connected with the positive output end of the rectification circuit b; the negative output end of the rectification circuit b is connected with the positive output end of the rectification circuit c; the negative output end of the rectification circuit c is connected with the negative input end of the voltage stabilizing circuit; the output end of the voltage stabilizing circuit is respectively connected with the power end of the ADC module, the power end of the main control circuit and the power end of the wireless signal transmitting circuit;
the output end of the wireless signal transmitting circuit is wirelessly connected with the input end of the wireless signal receiving circuit; the output end of the wireless signal receiving circuit is connected with the input end of the upper computer.
The three-dimensional wireless power receiving coil is installed on the capsule robot through the magnetic core.
The sampling circuit a comprises a rectifier diode, a first voltage-dividing resistor and a second voltage-dividing resistor; the anode of the rectifier diode is used as the input end of the sampling circuit a; one end of the first voltage dividing resistor is connected with the cathode of the rectifier diode, and the other end of the first voltage dividing resistor is used as the output end of the sampling circuit a; one end of the second voltage-dividing resistor is connected with the cathode of the rectifier diode through the first voltage-dividing resistor, and the other end of the second voltage-dividing resistor is grounded; the structure of the sampling circuit b and the structure of the sampling circuit c are consistent with the structure of the sampling circuit a.
The resistance value of the first voltage-dividing resistor and the resistance value of the second voltage-dividing resistor are both larger than 10k omega.
The rectification circuit a, the rectification circuit b and the rectification circuit c are all full-wave rectification circuits.
The voltage stabilizing circuit is a linear low dropout voltage stabilizing chip.
The capsule robot posture measuring method based on the three-dimensional coil (the method is realized based on the capsule robot posture measuring system based on the three-dimensional coil), which is realized by adopting the following steps:
the method comprises the following steps: the wireless power transmitting coil B does not work, and the wireless power transmitting coil A starts to work; at the moment, the wireless electric energy transmitting coil A excites an alternating magnetic field, and the coil a, the coil b and the coil c respectively generate a path of induction voltage under the action of the alternating magnetic field; the three paths of induced voltages are sampled by a sampling circuit a, a sampling circuit b and a sampling circuit c respectively, then are subjected to AD conversion by an ADC module, and then are sent to an upper computer by a main control circuit, a wireless signal transmitting circuit and a wireless signal receiving circuit in sequence; in the process, the three paths of induced voltages are rectified by the rectifying circuit a, the rectifying circuit b and the rectifying circuit c respectively, then are superposed in series, and are stabilized by the voltage stabilizing circuit, so that stable working voltages are provided for the ADC module, the main control circuit and the wireless signal transmitting circuit;
step two: the wireless power transmitting coil A stops working, and the wireless power transmitting coil B starts working; at the moment, the wireless electric energy transmitting coil B excites an alternating magnetic field, and the coil a, the coil B and the coil c respectively generate a path of induction voltage under the action of the alternating magnetic field; the three paths of induced voltages are sampled by a sampling circuit a, a sampling circuit b and a sampling circuit c respectively, then are subjected to AD conversion by an ADC module, and then are sent to an upper computer by a main control circuit, a wireless signal transmitting circuit and a wireless signal receiving circuit in sequence; in the process, the three paths of induced voltages are rectified by the rectifying circuit a, the rectifying circuit b and the rectifying circuit c respectively, then are superposed in series, and are stabilized by the voltage stabilizing circuit, so that stable working voltages are provided for the ADC module, the main control circuit and the wireless signal transmitting circuit;
step three: the upper computer calculates the roll angle alpha, the pitch angle beta and the course angle gamma of the capsule robot in real time according to the induced voltage, the parameters of the alternating magnetic field and the parameters of the three-dimensional wireless power receiving coil, and displays and stores the calculation results in real time, so that the posture of the capsule robot is measured in real time; the specific calculation formula is as follows:
in formulae (1) to (6): epsilon aA 、ε bA 、ε cA Respectively representing the amplitudes of induction voltages generated by the coil a, the coil b and the coil c when the wireless power transmitting coil A works; epsilon aB 、ε bB 、ε cB Respectively representing the amplitudes of induction voltages generated by the coil a, the coil B and the coil c when the wireless power transmitting coil B works;ω A respectively representing the amplitude and the frequency of an alternating magnetic field excited by the wireless electric energy transmitting coil A; />ω B Respectively representing the amplitude and the frequency of an alternating magnetic field excited by the wireless electric energy transmitting coil B; n is a 、S a 、μ a Respectively showing the number of turns of the coil a, the enclosed area of a single turn and the effective magnetic conductivity of the enclosed area; n is b 、S b 、μ b Respectively showing the number of turns of the coil b, the enclosed area of a single turn and the effective magnetic conductivity of the enclosed area; n is c 、S c 、μ c Respectively showing the number of turns of the coil c, the enclosed area of a single turn and the effective magnetic conductivity of the enclosed area; />ω A 、/>ω B 、n a 、S a 、μ a 、n b 、S b 、μ b 、n c 、S c 、μ c Are all known amounts;
step four: and repeating the first step to the third step, thereby continuously measuring the posture of the capsule robot in real time.
Compared with the existing capsule robot attitude determination technology, the capsule robot attitude determination system and method based on the three-dimensional coil have the following advantages: firstly, the invention does not adopt a nine-axis attitude sensor, but directly utilizes the induced voltage of the three-dimensional wireless power receiving coil to realize the attitude determination of the capsule robot, so that the capsule robot cannot be interfered by the alternating magnetic field of a wireless power transmission system, and the attitude determination result is more accurate. Secondly, the method can realize the attitude angle calculation of the capsule robot by only utilizing simple trigonometric function operation, so that the calculation amount is smaller, and the method is favorable for realizing the real-time measurement of the attitude.
The invention effectively solves the problems that the attitude determination result of the existing capsule robot attitude determination technology is inaccurate and is not beneficial to realizing real-time determination of the attitude, and is suitable for the attitude determination of the capsule robot.
Drawings
FIG. 1 is a schematic structural diagram of a capsule robot attitude determination system based on three-dimensional coils according to the present invention.
Fig. 2 is a schematic diagram of a single-turn model of a wireless power transmitting coil a and a wireless power transmitting coil B according to the present invention.
Fig. 3 is a schematic diagram of a single-turn model of a three-dimensional wireless power receiving coil according to the present invention.
Fig. 4 is a schematic structural view of a three-dimensional wireless power receiving coil and a magnetic core according to the present invention.
Fig. 5 is a schematic view of the installation of the three-dimensional wireless power receiving coil and the magnetic core on the capsule robot in the invention.
Detailed Description
The capsule robot posture measuring system based on the three-dimensional coil comprises a wireless power transmitting coil A arranged outside the body, a wireless power transmitting coil B arranged outside the body, a three-dimensional wireless power receiving coil arranged on the capsule robot, an airborne circuit arranged on the capsule robot, a wireless signal receiving circuit arranged outside the body and an upper computer arranged outside the body;
the wireless electric energy transmitting coil A and the wireless electric energy transmitting coil B are both Helmholtz coils and are arranged orthogonally to each other;
the three-dimensional wireless power receiving coil comprises a coil a, a coil b and a coil c;
the coil a and the coil b are both rectangular coils; the coil c is a circular coil; the coils a, b and c are mutually orthogonally arranged pairwise, and the central axis of the coil c is superposed with the central axis of the capsule robot;
the airborne circuit comprises a sampling circuit a, a sampling circuit b, a sampling circuit c, an ADC module, a main control circuit, a wireless signal transmitting circuit, a rectifying circuit a, a rectifying circuit b, a rectifying circuit c and a voltage stabilizing circuit;
the input end of the sampling circuit a is connected with one end of the coil a; the input end of the sampling circuit b is connected with one end of the coil b; the input end of the sampling circuit c is connected with one end of the coil c; the output end of the sampling circuit a, the output end of the sampling circuit b and the output end of the sampling circuit c are connected with the input end of the ADC module; the output end of the ADC module is connected with the input end of the main control circuit; the output end of the main control circuit is connected with the input end of the wireless signal transmitting circuit;
two input ends of the rectifying circuit a are respectively connected with two ends of the coil a; two input ends of the rectifying circuit b are respectively connected with two ends of the coil b; two input ends of the rectifying circuit c are respectively connected with two ends of the coil c; the positive output end of the rectification circuit a is connected with the positive input end of the voltage stabilizing circuit; the negative output end of the rectification circuit a is connected with the positive output end of the rectification circuit b; the negative output end of the rectification circuit b is connected with the positive output end of the rectification circuit c; the negative output end of the rectification circuit c is connected with the negative input end of the voltage stabilizing circuit; the output end of the voltage stabilizing circuit is respectively connected with the power end of the ADC module, the power end of the main control circuit and the power end of the wireless signal transmitting circuit;
the output end of the wireless signal transmitting circuit is wirelessly connected with the input end of the wireless signal receiving circuit; the output end of the wireless signal receiving circuit is connected with the input end of the upper computer.
The three-dimensional wireless power receiving coil is installed on the capsule robot through the magnetic core.
The sampling circuit a comprises a rectifier diode, a first voltage-dividing resistor and a second voltage-dividing resistor; the anode of the rectifier diode is used as the input end of the sampling circuit a; one end of the first voltage-dividing resistor is connected with the cathode of the rectifier diode, and the other end of the first voltage-dividing resistor is used as the output end of the sampling circuit a; one end of the second voltage-dividing resistor is connected with the cathode of the rectifier diode through the first voltage-dividing resistor, and the other end of the second voltage-dividing resistor is grounded; the structure of the sampling circuit b and the structure of the sampling circuit c are consistent with the structure of the sampling circuit a.
The resistance value of the first voltage-dividing resistor and the resistance value of the second voltage-dividing resistor are both larger than 10k omega.
The rectification circuit a, the rectification circuit b and the rectification circuit c are all full-wave rectification circuits.
The voltage stabilizing circuit is a linear low dropout voltage stabilizing chip.
The capsule robot posture measuring method based on the three-dimensional coil (the method is realized based on the capsule robot posture measuring system based on the three-dimensional coil), which is realized by adopting the following steps:
the method comprises the following steps: the wireless power transmitting coil B does not work, and the wireless power transmitting coil A starts to work; at the moment, the wireless electric energy transmitting coil A excites an alternating magnetic field, and the coil a, the coil b and the coil c respectively generate a path of induction voltage under the action of the alternating magnetic field; the three paths of induction voltages are sampled by a sampling circuit a, a sampling circuit b and a sampling circuit c respectively, then subjected to AD conversion by an ADC module, and then sent to an upper computer through a main control circuit, a wireless signal transmitting circuit and a wireless signal receiving circuit in sequence; in the process, the three paths of induction voltages are rectified by the rectifying circuit a, the rectifying circuit b and the rectifying circuit c respectively, then are superposed in series, and are stabilized by the voltage stabilizing circuit, so that stable working voltage is provided for the ADC module, the main control circuit and the wireless signal transmitting circuit;
step two: the wireless power transmitting coil A stops working, and the wireless power transmitting coil B starts working; at the moment, the wireless electric energy transmitting coil B excites an alternating magnetic field, and the coil a, the coil B and the coil c respectively generate a path of induction voltage under the action of the alternating magnetic field; the three paths of induced voltages are sampled by a sampling circuit a, a sampling circuit b and a sampling circuit c respectively, then are subjected to AD conversion by an ADC module, and then are sent to an upper computer by a main control circuit, a wireless signal transmitting circuit and a wireless signal receiving circuit in sequence; in the process, the three paths of induced voltages are rectified by the rectifying circuit a, the rectifying circuit b and the rectifying circuit c respectively, then are superposed in series, and are stabilized by the voltage stabilizing circuit, so that stable working voltages are provided for the ADC module, the main control circuit and the wireless signal transmitting circuit;
step three: the upper computer calculates the roll angle alpha, the pitch angle beta and the course angle gamma of the capsule robot in real time according to the induced voltage, the parameters of the alternating magnetic field and the parameters of the three-dimensional wireless power receiving coil, and displays and stores the calculation results in real time, so that the posture of the capsule robot is measured in real time; the specific calculation formula is as follows:
in formulae (1) to (6): epsilon aA 、ε bA 、ε cA Respectively representing the amplitudes of induction voltages generated by the coil a, the coil b and the coil c when the wireless power transmitting coil A works; epsilon aB 、ε bB 、ε cB Respectively representing the amplitudes of induction voltages generated by the coil a, the coil B and the coil c when the wireless power transmitting coil B works;ω A respectively representing the amplitude and the frequency of an alternating magnetic field excited by the wireless electric energy transmitting coil A; />ω B Respectively representing wireless electric energyThe amplitude and frequency of the alternating magnetic field excited by the transmitting coil B; n is a 、S a 、μ a Respectively showing the number of turns of the coil a, the enclosed area of a single turn and the effective magnetic conductivity of the enclosed area; n is a radical of an alkyl radical b 、S b 、μ b Respectively showing the number of turns of the coil b, the enclosed area of a single turn and the effective magnetic conductivity of the enclosed area; n is c 、S c 、μ c Respectively showing the number of turns of the coil c, the enclosed area of a single turn and the effective magnetic conductivity of the enclosed area; />ω A 、/>ω B 、n a 、S a 、μ a 、n b 、S b 、μ b 、n c 、S c 、μ c Are all known amounts;
step four: and repeating the first step to the third step, thereby continuously measuring the posture of the capsule robot in real time.
While specific embodiments of the invention have been described above, it will be understood by those skilled in the art that these are by way of example only, and that the scope of the invention is defined by the appended claims. Various changes and modifications to these embodiments may be made by those skilled in the art without departing from the spirit and scope of the invention, and these changes and modifications are within the scope of the invention.
Claims (6)
1. A capsule robot posture measuring method based on three-dimensional coils is characterized in that: the method is realized based on a capsule robot posture measuring system based on a three-dimensional coil, and the system comprises a wireless electric energy transmitting coil A arranged outside the body, a wireless electric energy transmitting coil B arranged outside the body, a three-dimensional wireless electric energy receiving coil arranged on the capsule robot, an onboard circuit arranged on the capsule robot, a wireless signal receiving circuit arranged outside the body and an upper computer arranged outside the body;
the wireless electric energy transmitting coil A and the wireless electric energy transmitting coil B are Helmholtz coils and are arranged in a mutually orthogonal mode;
the three-dimensional wireless power receiving coil comprises a coil a, a coil b and a coil c;
the coil a and the coil b are both rectangular coils; the coil c is a circular coil; the coils a, b and c are mutually orthogonally arranged pairwise, and the central axis of the coil c is superposed with the central axis of the capsule robot;
the airborne circuit comprises a sampling circuit a, a sampling circuit b, a sampling circuit c, an ADC module, a main control circuit, a wireless signal transmitting circuit, a rectifying circuit a, a rectifying circuit b, a rectifying circuit c and a voltage stabilizing circuit;
the input end of the sampling circuit a is connected with one end of the coil a; the input end of the sampling circuit b is connected with one end of the coil b; the input end of the sampling circuit c is connected with one end of the coil c; the output end of the sampling circuit a, the output end of the sampling circuit b and the output end of the sampling circuit c are connected with the input end of the ADC module; the output end of the ADC module is connected with the input end of the main control circuit; the output end of the main control circuit is connected with the input end of the wireless signal transmitting circuit;
two input ends of the rectifying circuit a are respectively connected with two ends of the coil a; two input ends of the rectifying circuit b are respectively connected with two ends of the coil b; two input ends of the rectifying circuit c are respectively connected with two ends of the coil c; the positive output end of the rectification circuit a is connected with the positive input end of the voltage stabilizing circuit; the negative output end of the rectification circuit a is connected with the positive output end of the rectification circuit b; the negative output end of the rectification circuit b is connected with the positive output end of the rectification circuit c; the negative output end of the rectification circuit c is connected with the negative input end of the voltage stabilizing circuit; the output end of the voltage stabilizing circuit is respectively connected with the power end of the ADC module, the power end of the main control circuit and the power end of the wireless signal transmitting circuit;
the output end of the wireless signal transmitting circuit is wirelessly connected with the input end of the wireless signal receiving circuit; the output end of the wireless signal receiving circuit is connected with the input end of the upper computer;
the method is realized by adopting the following steps:
the method comprises the following steps: the wireless power transmitting coil B does not work, and the wireless power transmitting coil A starts to work; at the moment, the wireless electric energy transmitting coil A excites an alternating magnetic field, and the coil a, the coil b and the coil c respectively generate a path of induction voltage under the action of the alternating magnetic field; the three paths of induced voltages are sampled by a sampling circuit a, a sampling circuit b and a sampling circuit c respectively, then are subjected to AD conversion by an ADC module, and then are sent to an upper computer by a main control circuit, a wireless signal transmitting circuit and a wireless signal receiving circuit in sequence; in the process, the three paths of induced voltages are rectified by the rectifying circuit a, the rectifying circuit b and the rectifying circuit c respectively, then are superposed in series, and are stabilized by the voltage stabilizing circuit, so that stable working voltages are provided for the ADC module, the main control circuit and the wireless signal transmitting circuit;
step two: the wireless power transmitting coil A stops working, and the wireless power transmitting coil B starts working; at the moment, the wireless electric energy transmitting coil B excites an alternating magnetic field, and the coil a, the coil B and the coil c respectively generate a path of induction voltage under the action of the alternating magnetic field; the three paths of induced voltages are sampled by a sampling circuit a, a sampling circuit b and a sampling circuit c respectively, then are subjected to AD conversion by an ADC module, and then are sent to an upper computer by a main control circuit, a wireless signal transmitting circuit and a wireless signal receiving circuit in sequence; in the process, the three paths of induced voltages are rectified by the rectifying circuit a, the rectifying circuit b and the rectifying circuit c respectively, then are superposed in series, and are stabilized by the voltage stabilizing circuit, so that stable working voltages are provided for the ADC module, the main control circuit and the wireless signal transmitting circuit;
step three: the upper computer calculates the roll angle alpha, the pitch angle beta and the course angle gamma of the capsule robot in real time according to the induced voltage, the parameters of the alternating magnetic field and the parameters of the three-dimensional wireless power receiving coil, and displays and stores the calculation results in real time, so that the posture of the capsule robot is measured in real time; the specific calculation formula is as follows:
in formulae (1) to (6): epsilon aA 、ε bA 、ε cA Respectively representing the amplitudes of induction voltages generated by the coil a, the coil b and the coil c when the wireless power transmitting coil A works; epsilon aB 、ε bB 、ε cB Respectively representing the amplitudes of induction voltages generated by the coil a, the coil B and the coil c when the wireless electric energy transmitting coil B works;ω A respectively representing the amplitude and the frequency of an alternating magnetic field excited by the wireless electric energy transmitting coil A;ω B respectively representing the amplitude and the frequency of an alternating magnetic field excited by the wireless electric energy transmitting coil B; n is a 、S a 、μ a Respectively showing the number of turns of the coil a, the enclosed area of a single turn and the effective magnetic conductivity of the enclosed area; n is b 、S b 、μ b Each representing a coil bThe number of turns, the area enclosed by the single turn and the effective magnetic conductivity of the enclosed area; n is c 、S c 、μ c Respectively showing the number of turns of the coil c, the enclosed area of a single turn and the effective magnetic conductivity of the enclosed area;ω A 、ω B 、n a 、S a 、μ a 、n b 、S b 、μ b 、n c 、S c 、μ c are all known amounts;
step four: and repeating the first step to the third step, thereby continuously measuring the posture of the capsule robot in real time.
2. The three-dimensional coil-based capsule robot pose measurement method of claim 1, wherein: the three-dimensional wireless power receiving coil is installed on the capsule robot through the magnetic core.
3. The three-dimensional coil-based capsule robot pose measurement method of claim 1, wherein: the sampling circuit a comprises a rectifier diode, a first voltage-dividing resistor and a second voltage-dividing resistor; the anode of the rectifier diode is used as the input end of the sampling circuit a; one end of the first voltage dividing resistor is connected with the cathode of the rectifier diode, and the other end of the first voltage dividing resistor is used as the output end of the sampling circuit a; one end of the second voltage-dividing resistor is connected with the cathode of the rectifier diode through the first voltage-dividing resistor, and the other end of the second voltage-dividing resistor is grounded; the structure of the sampling circuit b and the structure of the sampling circuit c are consistent with the structure of the sampling circuit a.
4. The three-dimensional coil-based capsule robot pose measurement method of claim 3, wherein: the resistance value of the first voltage-dividing resistor and the resistance value of the second voltage-dividing resistor are both larger than 10k omega.
5. The three-dimensional coil-based capsule robot pose measurement method of claim 1, wherein: the rectification circuit a, the rectification circuit b and the rectification circuit c are all full-wave rectification circuits.
6. The three-dimensional coil-based capsule robot pose measurement method of claim 1, wherein: the voltage stabilizing circuit is a linear low dropout voltage stabilizing chip.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010133126.1A CN111207737B (en) | 2020-03-01 | 2020-03-01 | Capsule robot posture measuring system and method based on three-dimensional coil |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010133126.1A CN111207737B (en) | 2020-03-01 | 2020-03-01 | Capsule robot posture measuring system and method based on three-dimensional coil |
Publications (2)
Publication Number | Publication Date |
---|---|
CN111207737A CN111207737A (en) | 2020-05-29 |
CN111207737B true CN111207737B (en) | 2023-03-24 |
Family
ID=70786815
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202010133126.1A Active CN111207737B (en) | 2020-03-01 | 2020-03-01 | Capsule robot posture measuring system and method based on three-dimensional coil |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN111207737B (en) |
Families Citing this family (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113241240B (en) * | 2021-05-25 | 2022-03-08 | 上海交通大学 | Three-dimensional receiving coil device for wireless energy transmission of capsule endoscopy robot |
Citations (12)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2005052637A (en) * | 2003-07-18 | 2005-03-03 | Pentax Corp | Capsule type device and capsule type device driving control system |
CN102130514A (en) * | 2011-03-30 | 2011-07-20 | 上海北京大学微电子研究院 | Wireless power supply device of diagnosis and treatment system |
DE102011078500A1 (en) * | 2011-07-01 | 2013-01-03 | Siemens Aktiengesellschaft | Method for controlling endoscope capsule in liquid-filled cavity in stomach or intestinal tract of patient, involves exerting force on plane in direction depending on magnitude of another former force |
CN103637803A (en) * | 2013-11-14 | 2014-03-19 | 上海交通大学 | Permanent magnet and induction coil based capsule endoscopy space positioning system and positioning method |
CN105662318A (en) * | 2016-01-08 | 2016-06-15 | 大连理工大学 | Man-machine interaction control method for space universal rotating magnetic field |
CN106549508A (en) * | 2016-11-11 | 2017-03-29 | 大连理工大学 | A kind of orientation wireless energy transfer method of the universal alternating magnetic field of space linear polarization |
CN106937860A (en) * | 2017-04-12 | 2017-07-11 | 重庆金山医疗器械有限公司 | Know the capsule endoscope system and its method of work of real-time pose |
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 |
CN107491093A (en) * | 2017-07-13 | 2017-12-19 | 华北水利水电大学 | A kind of high-power supply path Tracking Recognition device and method |
CN108042094A (en) * | 2017-12-22 | 2018-05-18 | 宜宾学院 | The alignment system and its localization method of Wireless capsule endoscope 5DOF |
CN110327011A (en) * | 2019-06-26 | 2019-10-15 | 大连理工大学 | A kind of double hemisphere capsule robot attitude detecting methods based on magnetic vector error calibration image |
CN110702064A (en) * | 2019-09-16 | 2020-01-17 | 中国矿业大学 | Unmanned aircraft attitude information acquisition method and system based on magnetic induction |
Family Cites Families (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP6351756B2 (en) * | 2014-12-18 | 2018-07-04 | 株式会社パイオラックス | Capsule endoscopy device |
-
2020
- 2020-03-01 CN CN202010133126.1A patent/CN111207737B/en active Active
Patent Citations (12)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2005052637A (en) * | 2003-07-18 | 2005-03-03 | Pentax Corp | Capsule type device and capsule type device driving control system |
CN102130514A (en) * | 2011-03-30 | 2011-07-20 | 上海北京大学微电子研究院 | Wireless power supply device of diagnosis and treatment system |
DE102011078500A1 (en) * | 2011-07-01 | 2013-01-03 | Siemens Aktiengesellschaft | Method for controlling endoscope capsule in liquid-filled cavity in stomach or intestinal tract of patient, involves exerting force on plane in direction depending on magnitude of another former force |
CN103637803A (en) * | 2013-11-14 | 2014-03-19 | 上海交通大学 | Permanent magnet and induction coil based capsule endoscopy space positioning system and positioning method |
CN105662318A (en) * | 2016-01-08 | 2016-06-15 | 大连理工大学 | Man-machine interaction control method for space universal rotating magnetic field |
CN106549508A (en) * | 2016-11-11 | 2017-03-29 | 大连理工大学 | A kind of orientation wireless energy transfer method of the universal alternating magnetic field of space linear polarization |
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 |
CN106937860A (en) * | 2017-04-12 | 2017-07-11 | 重庆金山医疗器械有限公司 | Know the capsule endoscope system and its method of work of real-time pose |
CN107491093A (en) * | 2017-07-13 | 2017-12-19 | 华北水利水电大学 | A kind of high-power supply path Tracking Recognition device and method |
CN108042094A (en) * | 2017-12-22 | 2018-05-18 | 宜宾学院 | The alignment system and its localization method of Wireless capsule endoscope 5DOF |
CN110327011A (en) * | 2019-06-26 | 2019-10-15 | 大连理工大学 | A kind of double hemisphere capsule robot attitude detecting methods based on magnetic vector error calibration image |
CN110702064A (en) * | 2019-09-16 | 2020-01-17 | 中国矿业大学 | Unmanned aircraft attitude information acquisition method and system based on magnetic induction |
Non-Patent Citations (4)
Title |
---|
A capsule robot powered by wireless power transmission: Design of its receiving coil;Gao, Jinyang;《SENSORS AND ACTUATORS A-PHYSICAL》;第234卷;133-142 * |
A novel and compatible sensing coil for a capsule in Wireless Capsule Endoscopy for real time localization;Islam, Mohd. Noor;《IEEE SENSORS 2014 Proceedings》;1-4 * |
基于矩形赫姆霍兹线圈的胶囊机器人驱动***设计;朱兆铭;《中国优秀硕士学位论文全文数据库信息科技辑》(第02期);I140-678 * |
胶囊机器人无线能量传输***设计;杨凯;《北京生物医学工程》;第35卷(第05期);510-515 * |
Also Published As
Publication number | Publication date |
---|---|
CN111207737A (en) | 2020-05-29 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN106983487B (en) | The positioning system and its localization method of Wireless capsule endoscope three-dimensional position and 3 d pose | |
Kilinc et al. | A system for wireless power transfer of micro-systems in-vivo implantable in freely moving animals | |
CN111207737B (en) | Capsule robot posture measuring system and method based on three-dimensional coil | |
CN109737941B (en) | Human body motion capture method | |
WO2013127311A1 (en) | Method for measuring displacement of planar motor rotor | |
CN111953089B (en) | Wireless charging system receiving coil positioning method based on mutual inductance disturbance | |
CN111256692B (en) | Capsule robot attitude determination system and method based on sensor and one-dimensional coil | |
Ghotbi et al. | 3-Coil orientation insensitive wireless power transfer for capsule endoscope | |
US7061469B2 (en) | Method of data input into a computer | |
CN106549508B (en) | A kind of orientation wireless energy transfer method of the universal alternating magnetic field of space linear polarization | |
JP2007268034A (en) | Method and device for measuring biological signal | |
CN105455806A (en) | Brain magnetic signal probe, sensor and collecting system based on GMI effect | |
Zhuang et al. | Omnidirectional wireless power transfer system using modified saddle-shaped coil pair for implantable capsule robots | |
CN203749415U (en) | Wireless tracking device for digestive tract target objects | |
Hashi et al. | Wireless magnetic motion capture system for multi-marker detection | |
CN116625363A (en) | Multichannel six-degree-of-freedom electromagnetic positioning tracking method | |
Gao et al. | Analysis of connection way of a three-dimensional receiving coil onboard a capsule robot for wireless power transmission | |
CN108553072B (en) | Digital positioning system and method for digestive tract electronic capsule | |
CN103698741A (en) | Radio frequency power supply electromagnetic positioning probe | |
CN210155307U (en) | Three-axis bidirectional compensation type magnetic field measuring device | |
RU2542793C1 (en) | Device to determine position of object in space | |
Çark et al. | 3D electromagnetic positioning optimization by means of deep learning | |
CN206891447U (en) | A kind of dynamically tuned gyro, DTG and its angular position pick up | |
RU2413957C2 (en) | Method of determining linear position and orientation of mobile object | |
RU225819U1 (en) | Device for determining the orientation angles of an object in space |
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 |