CN116784771A - Design and control method of magnetic drive system for capsule robot - Google Patents
Design and control method of magnetic drive system for capsule robot Download PDFInfo
- Publication number
- CN116784771A CN116784771A CN202310952260.8A CN202310952260A CN116784771A CN 116784771 A CN116784771 A CN 116784771A CN 202310952260 A CN202310952260 A CN 202310952260A CN 116784771 A CN116784771 A CN 116784771A
- Authority
- CN
- China
- Prior art keywords
- motor
- capsule robot
- permanent magnet
- module
- control
- 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.)
- Pending
Links
Classifications
-
- A—HUMAN NECESSITIES
- A61—MEDICAL OR VETERINARY SCIENCE; HYGIENE
- A61B—DIAGNOSIS; SURGERY; IDENTIFICATION
- A61B1/00—Instruments for performing medical examinations of the interior of cavities or tubes of the body by visual or photographical inspection, e.g. endoscopes; Illuminating arrangements therefor
- A61B1/00147—Holding or positioning arrangements
- A61B1/00158—Holding or positioning arrangements using magnetic field
-
- A—HUMAN NECESSITIES
- A61—MEDICAL OR VETERINARY SCIENCE; HYGIENE
- A61B—DIAGNOSIS; SURGERY; IDENTIFICATION
- A61B1/00—Instruments for performing medical examinations of the interior of cavities or tubes of the body by visual or photographical inspection, e.g. endoscopes; Illuminating arrangements therefor
- A61B1/04—Instruments for performing medical examinations of the interior of cavities or tubes of the body by visual or photographical inspection, e.g. endoscopes; Illuminating arrangements therefor combined with photographic or television appliances
- A61B1/041—Capsule endoscopes for imaging
Landscapes
- Health & Medical Sciences (AREA)
- Life Sciences & Earth Sciences (AREA)
- Surgery (AREA)
- Nuclear Medicine, Radiotherapy & Molecular Imaging (AREA)
- Biomedical Technology (AREA)
- Optics & Photonics (AREA)
- Pathology (AREA)
- Radiology & Medical Imaging (AREA)
- Biophysics (AREA)
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- Heart & Thoracic Surgery (AREA)
- Medical Informatics (AREA)
- Molecular Biology (AREA)
- Animal Behavior & Ethology (AREA)
- General Health & Medical Sciences (AREA)
- Public Health (AREA)
- Veterinary Medicine (AREA)
- Toys (AREA)
Abstract
Description
技术领域Technical field
本发明涉及医疗检测设备技术领域,具体涉及一种胶囊机器人磁驱动系统设计及控制方法。The invention relates to the technical field of medical testing equipment, and specifically to a design and control method of a capsule robot magnetic drive system.
技术背景technical background
胶囊机器人作为人体胃肠道内的一种无创、无痛诊疗工具,能够有效提高检查舒适性和患者耐受力,使体内胃肠道等盲区内的检查成为可能,且当检测肠道肿瘤和胃肠道病变时,无线胶囊机器人也比磁共振成像系统更准确,利用永磁铁和磁场的相互作用,利用电磁控制系统驱动胶囊机器人的灵活运动,电磁场的应用已经证明了其在临床的功能性优势,而且外磁场驱动的胶囊机器人可不受机器人内部空间约束,可高度微型化,便于临床应用。As a non-invasive and painless diagnosis and treatment tool in the human gastrointestinal tract, capsule robots can effectively improve the comfort of examination and patient tolerance, making it possible to examine blind areas such as the gastrointestinal tract in the body, and when detecting intestinal tumors and gastric cancer In the case of intestinal lesions, wireless capsule robots are also more accurate than magnetic resonance imaging systems. They use the interaction between permanent magnets and magnetic fields, and use electromagnetic control systems to drive the flexible movement of capsule robots. The application of electromagnetic fields has proven its functional advantages in clinical practice. , and the capsule robot driven by an external magnetic field is not constrained by the internal space of the robot, and can be highly miniaturized to facilitate clinical application.
目前,外磁场驱动系统可分为电磁线圈驱动系统和永磁体驱动系统,电磁线圈驱动系统往往需要医师有较高操作水准且成本高昂,而永磁体驱动系统相对来说较为简便更加适用,相关技术中用于胶囊机器人的永磁体驱动系统在对胶囊机器人进行磁驱动时往往不够稳定,而且对位于人体内的胶囊机器人的控制也不够精确便捷,存在改进之处。At present, external magnetic field drive systems can be divided into electromagnetic coil drive systems and permanent magnet drive systems. Electromagnetic coil drive systems often require doctors to have a high level of operation and are costly, while permanent magnet drive systems are relatively simple and more applicable. Related technologies The permanent magnet drive system used in capsule robots is often not stable enough when magnetically driving the capsule robot, and the control of the capsule robot inside the human body is not precise and convenient enough, so there is room for improvement.
发明内容Contents of the invention
本发明的目的在于提供一种胶囊机器人磁驱动系统的设计及控制方法,以解决上述背景中提出的问题。The purpose of the present invention is to provide a design and control method for a magnetic drive system of a capsule robot to solve the problems raised in the above background.
为实现上述目的,本发明提供如下技术方案:In order to achieve the above objects, the present invention provides the following technical solutions:
一种胶囊机器人磁驱动系统的设计及控制方法,包括磁耦合装置模块、控制模块和电机模块,所述磁耦合装置模块和所述电机模块的衔接处设置有固定组件,所述电机模块驱动所述磁耦合装置模块进行磁耦合,所述控制模块与所述电机模块信号连接,所述控制模块控制所述电机模块进而实现对所述磁耦合装置模块的驱动控制;A design and control method for a magnetic drive system of a capsule robot, including a magnetic coupling device module, a control module and a motor module. A fixed component is provided at the connection between the magnetic coupling device module and the motor module. The motor module drives all The magnetic coupling device module performs magnetic coupling, the control module is signal-connected to the motor module, and the control module controls the motor module to realize drive control of the magnetic coupling device module;
所述磁耦合装置模块包括主永磁体单元、从永磁体单元和胶囊机器人,所述从永磁体单元设置在所述胶囊机器人内部中心处,所述电机模块驱动所述主永磁体单元旋转产生稳定旋转磁场,在旋转磁场的作用下所述主永磁体单元对所述胶囊机器人内部的从永磁体单元产生非接触磁作用力,所述胶囊机器人与外部的旋转磁场同步旋转,实现前进、后退与转向运动;The magnetic coupling device module includes a master permanent magnet unit, a slave permanent magnet unit and a capsule robot. The slave permanent magnet unit is disposed at the center of the capsule robot. The motor module drives the master permanent magnet unit to rotate to produce a stable Under the action of the rotating magnetic field, the main permanent magnet unit generates a non-contact magnetic force on the slave permanent magnet unit inside the capsule robot. The capsule robot rotates synchronously with the external rotating magnetic field to realize forward, backward and steering movement;
所述控制模块包括PC端和操作手柄,所述PC端与所述胶囊机器人信号连接,用于接收胶囊机器人的视觉反馈信号,所述操作手柄与所述电机模块信号连接,用于对所述电机模块进行调控从何控制所述磁耦合装置模块的胶囊机器人的运动。The control module includes a PC end and an operating handle. The PC end is connected to the capsule robot via signals and is used to receive visual feedback signals from the capsule robot. The operating handle is connected to the motor module via signals and is used to control the capsule robot. The motor module regulates how to control the movement of the capsule robot of the magnetic coupling device module.
优选的,所述电机模块设置为直流电机,所述直流电机与所述控制手柄信号连接,由所述控制手柄进行控制,所述直流电机的一侧设有输出轴,所述输出轴与所述固定组件嵌套设置且固定连接,所述固定组件又与所述主永磁体单元固定连接,用于固定直流电机和所述主永磁体单元,使产生的旋转磁场更加稳定。Preferably, the motor module is configured as a DC motor, the DC motor is signal-connected to the control handle and is controlled by the control handle. An output shaft is provided on one side of the DC motor, and the output shaft is connected to the control handle. The fixed components are nested and fixedly connected, and are fixedly connected to the main permanent magnet unit for fixing the DC motor and the main permanent magnet unit to make the generated rotating magnetic field more stable.
优选的,所述主永磁体单元包括两块主永磁体,所述主永磁体呈圆柱状且对称设置,充磁方向为厚度方向充磁,所述两块对称设置的主永磁体在所述直流电机的驱动下可产生稳定的叠加旋转磁场,所述从永磁体单元包括一块圆柱状的从永磁体,所述从永磁体的充磁方向为径向充磁,所述从永磁体设置在所述胶囊机器人的内部中心处。Preferably, the main permanent magnet unit includes two main permanent magnets, the main permanent magnets are cylindrical and symmetrically arranged, and the magnetization direction is the thickness direction. The two symmetrically arranged main permanent magnets are in the A stable superimposed rotating magnetic field can be generated under the drive of a DC motor. The slave permanent magnet unit includes a cylindrical slave permanent magnet. The magnetizing direction of the slave permanent magnet is radial magnetization. The slave permanent magnet is arranged on At the inner center of the capsule robot.
优选的,所述固定组件包括联轴器和紧固螺栓,所述联轴器的一侧与所述直流电机的输出轴嵌套设置并通过紧固螺栓进行固定,所述联轴器另一侧分别与所述两块主永磁体固定连接并通过紧固螺栓进行固定。Preferably, the fixing assembly includes a coupling and fastening bolts. One side of the coupling is nested with the output shaft of the DC motor and fixed by fastening bolts. The other side of the coupling is The sides are respectively fixedly connected to the two main permanent magnets and fixed by fastening bolts.
优选的,所述胶囊机器人采用3D打印制造,外部设置有一圈外螺纹,所述外螺纹上的螺旋凹槽用于将液体对所述胶囊机器人的压力转变为轴向压力,驱动所述胶囊机器人向前或向后运动。Preferably, the capsule robot is manufactured by 3D printing, and is provided with a circle of external threads on the outside. The spiral groove on the external thread is used to convert the pressure of the liquid on the capsule robot into axial pressure to drive the capsule robot. Forward or backward movement.
优选的,所述操作手柄包括电机驱动器、电机控制器和控制面板,所述电机驱动器和所述电机控制器用于对所述直流电机的无线驱动控制,所述控制面板用于对所述直流电机进行转速及转向的精确控制,且能显示所述直流电机的指令状态及运行状态。Preferably, the operating handle includes a motor driver, a motor controller and a control panel, the motor driver and the motor controller are used for wireless drive control of the DC motor, and the control panel is used for wireless drive control of the DC motor. It can precisely control the speed and steering, and can display the command status and operating status of the DC motor.
优选的,所述控制面板包括速度调节旋钮、转向调节按键、停止按键、开关键和数码显示屏,所述速度调节旋钮和所述转向旋钮用于控制所述直流电机的转向及速度,从而调控所述两块主永磁体产生的旋转磁场,进一步控制胶囊机器人的转向和速度,所述停止按键用于控制所述直流电机停止运作,旋转磁场消失,胶囊机器人停止运动,所述数码显示屏用于显示所述操作手柄正在执行的指令及直流电机的旋转状态及速度值。Preferably, the control panel includes a speed adjustment knob, a steering adjustment button, a stop button, an on/off key and a digital display. The speed adjustment knob and the steering knob are used to control the steering and speed of the DC motor, thereby regulating The rotating magnetic field generated by the two main permanent magnets further controls the steering and speed of the capsule robot. The stop button is used to control the DC motor to stop operating. The rotating magnetic field disappears and the capsule robot stops moving. The digital display screen uses In order to display the instructions being executed by the operating handle and the rotation status and speed value of the DC motor.
优选的,所述速度调节旋钮设置为正向旋转和反向旋转,当正向旋转速度调节旋钮时,所述直流电机速度增加,所述胶囊机器人也会随之加速旋转,所述数码显示屏显示此时的指令状态及所述直流电机的转速值,且电机的转速在达到最大保护限定转速值后不再增加;当反向旋转速度调节旋钮时,所述直流电机速度减小,所述胶囊机器人也会随之减速旋转,所述数码显示屏显示指令状态及所述直流电机的转速值,随着速度调节旋钮继续旋转,达到0位后,电机的速度不再变化。Preferably, the speed adjustment knob is set to rotate forward and reversely. When the speed adjustment knob is rotated forward, the speed of the DC motor increases, and the capsule robot will also accelerate rotation accordingly, and the digital display screen The command status and the speed value of the DC motor at this time are displayed, and the speed of the motor will no longer increase after reaching the maximum protection limit speed value; when the speed adjustment knob is rotated in the reverse direction, the speed of the DC motor decreases, and the speed of the DC motor decreases. The capsule robot will also decelerate and rotate accordingly, and the digital display screen will display the command status and the speed value of the DC motor. As the speed adjustment knob continues to rotate, after reaching the 0 position, the speed of the motor will no longer change.
优选的,所述转向调节按键设置为正转按键和反转按键,在控制面板按下正转按键,所述直流电机开始转动,所述胶囊机器人随着所述主永磁体产生的旋转磁场而旋转,所述数码显示屏显示所述直流电机为正转及转动速度数值,在控制面板按下反转按键,所述直流电机转动的方向与正向转动的方向相反,所述胶囊机器人随之反方向旋转,所述数码显示屏显示所述直流电机为反转及转动速度数值。Preferably, the steering adjustment button is set as a forward rotation button and a reverse rotation button. When the forward rotation button is pressed on the control panel, the DC motor starts to rotate, and the capsule robot rotates along with the rotating magnetic field generated by the main permanent magnet. Rotate, the digital display screen displays the forward rotation and rotation speed value of the DC motor. Press the reverse button on the control panel. The direction of rotation of the DC motor is opposite to the direction of forward rotation, and the capsule robot then rotates. Rotate in the opposite direction, and the digital display screen displays the reverse rotation and rotation speed value of the DC motor.
优选的,所述直流电机采用有线或者无线锂电池供电,设置在配套外壳内部,所述固定组件也设置在配套外壳内部,所述两块主永磁体设置在所述配套外壳外部。Preferably, the DC motor is powered by a wired or wireless lithium battery and is arranged inside the matching housing. The fixing component is also arranged inside the matching housing. The two main permanent magnets are arranged outside the matching housing.
与现有技术相比,本发明的有益效果是:Compared with the prior art, the beneficial effects of the present invention are:
1.通过控制模块的操作手柄和PC端相互配合,操作手柄与电机模块信号连接实现对电机模块的稳定调控,操作手柄通过操控电机模块的旋转速度及旋转方向,进而对与电机模块固定连接的主永磁体单元产生的旋转磁场进行操控,达到对内部设有从永磁体单元的胶囊机器人的操控,配合PC端接收到的来自胶囊机器人的视觉反馈信号,可以实时观测胶囊机器人所处环境并对其进行操控,操作手柄的使用使得与电机模块固定连接的主永磁体单元产生的旋转磁场产生更加稳定,对胶囊机器人的操控也更稳定便捷。1. Through the cooperation of the operating handle of the control module and the PC end, the operating handle is connected to the motor module signal to achieve stable control of the motor module. The operating handle controls the rotation speed and direction of the motor module, and then controls the fixed connection with the motor module. The rotating magnetic field generated by the main permanent magnet unit is controlled to control the capsule robot with the slave permanent magnet unit inside. With the visual feedback signal from the capsule robot received by the PC, the environment of the capsule robot can be observed in real time and analyzed. For its control, the use of the operating handle makes the rotating magnetic field generated by the main permanent magnet unit fixedly connected to the motor module more stable, and the control of the capsule robot is also more stable and convenient.
2.操作手柄包括电机驱动器、电机控制器和控制面板,通过电机驱动器和电机控制器对直流电机的操控更稳定,控制面板包括速度调节旋钮、转向调节按键、停止按键和数码显示屏,通过速度调节旋钮、转向调节按键、停止按键可以对直流电机进行更精确地调控,数码显示屏可以显示当前控制面板的指令转态及直流电机的转动速度值,从何实现对胶囊机器人的精确操控。2. The operating handle includes a motor driver, a motor controller and a control panel. The motor driver and motor controller control the DC motor more stably. The control panel includes a speed adjustment knob, a steering adjustment button, a stop button and a digital display. Through the speed adjustment knob, the control panel The adjustment knob, steering adjustment button, and stop button can control the DC motor more accurately. The digital display can display the current command transition state of the control panel and the rotation speed value of the DC motor, thereby achieving precise control of the capsule robot.
附图说明Description of the drawings
图1是本发明一种胶囊机器人磁驱动的设计及控制方法的磁耦合模块和电机模块的结构图;Figure 1 is a structural diagram of a magnetic coupling module and a motor module of a magnetic drive design and control method for a capsule robot according to the present invention;
图2是本发明一种胶囊机器人磁驱动的设计及控制方法的控制模块的结构图;Figure 2 is a structural diagram of a control module of a capsule robot magnetic drive design and control method according to the present invention;
图3是本发明一种胶囊机器人磁驱动的设计及控制方法的胶囊机器人的结构图;Figure 3 is a structural diagram of a capsule robot with a magnetic drive design and control method according to the present invention;
图4是本发明一种胶囊机器人磁驱动的设计及控制方法的整体控制原理图;Figure 4 is an overall control principle diagram of the design and control method of the magnetic drive of a capsule robot according to the present invention;
图中:1、磁耦合装置模块;11、主永磁体单元;111、主永磁体;12、从永磁体单元;121、从永磁体;13、胶囊机器人;131、外螺纹;2、控制模块;21、PC端;22、操作手柄;221、电机驱动器;222、电机控制器;223、控制面板;2231、速度调节旋钮;2232、转向调节按键;22321、正转按键;22322、反转按键;2233、停止按键;2234、数码显示屏;2232、开关键;3、电机模块;31、直流电机;311、输出轴;4、固定组件;41、联轴器;42、紧固螺栓;5、配套外壳。In the picture: 1. Magnetic coupling device module; 11. Master permanent magnet unit; 111. Master permanent magnet; 12. Slave permanent magnet unit; 121. Slave permanent magnet; 13. Capsule robot; 131. External thread; 2. Control module ; 21. PC side; 22. Operating handle; 221. Motor driver; 222. Motor controller; 223. Control panel; 2231. Speed adjustment knob; 2232. Steering adjustment button; 22321. Forward rotation button; 22322. Reverse button ; 2233. Stop button; 2234. Digital display; 2232. On/off key; 3. Motor module; 31. DC motor; 311. Output shaft; 4. Fixed components; 41. Coupling; 42. Fastening bolts; 5 , matching shell.
具体实施方式Detailed ways
下面结合实施例及附图1对本发明作进一步的详细说明,但本发明的实施方式不仅限于此。The present invention will be further described in detail below with reference to the embodiments and Figure 1, but the implementation of the present invention is not limited thereto.
以下结合附图对本申请作进一步详细说明。The present application will be further described in detail below in conjunction with the accompanying drawings.
本发明公开了一种胶囊机器人磁驱动系统的设计及控制方法,包括磁耦合装置模块1、控制模块2和电机模块3,磁耦合装置模块1和电机模块3通过固定组件4衔接,电机模块3驱动磁耦合装置模块1进行磁耦合,控制模块2与电机模块3信号连接,控制模块2控制电机模块3从何实现对磁耦合装置模块1的驱动控制。The invention discloses a design and control method of a magnetic drive system of a capsule robot, which includes a magnetic coupling device module 1, a control module 2 and a motor module 3. The magnetic coupling device module 1 and the motor module 3 are connected through a fixing component 4, and the motor module 3 The magnetic coupling device module 1 is driven to perform magnetic coupling, the control module 2 is connected with the motor module 3 via signals, and the control module 2 controls where the motor module 3 controls the drive control of the magnetic coupling device module 1 .
参照图1,磁耦合装置模块1包括主永磁体单元11、从永磁体单元12和胶囊机器人13,从永磁体单元12设置在胶囊机器人13内部中心处,电机模块3驱动主永磁体单元11旋转产生稳定旋转磁场,在旋转磁场的作用下主永磁体单元11对胶囊机器人13内部的从永磁体单元12产生非接触磁作用力,胶囊机器人13与外部的旋转磁场同步旋转,实现前进、后退与转向运动;电机模块3设置为直流电机31,直流电机31的一侧设有输出轴311,输出轴311与固定组件4嵌套设置且固定连接,固定组件4又与主永磁体单元11固定连接,用于固定直流电机31和主永磁体单元11,使产生的旋转磁场更加稳定。Referring to Figure 1, the magnetic coupling device module 1 includes a master permanent magnet unit 11, a slave permanent magnet unit 12 and a capsule robot 13. The slave permanent magnet unit 12 is disposed at the center of the interior of the capsule robot 13. The motor module 3 drives the master permanent magnet unit 11 to rotate. A stable rotating magnetic field is generated. Under the action of the rotating magnetic field, the main permanent magnet unit 11 generates a non-contact magnetic force on the slave permanent magnet unit 12 inside the capsule robot 13. The capsule robot 13 rotates synchronously with the external rotating magnetic field to realize forward, backward and Steering movement; the motor module 3 is configured as a DC motor 31. One side of the DC motor 31 is provided with an output shaft 311. The output shaft 311 is nested and fixedly connected to the fixed component 4. The fixed component 4 is in turn fixedly connected to the main permanent magnet unit 11. , used to fix the DC motor 31 and the main permanent magnet unit 11 to make the generated rotating magnetic field more stable.
实际运用中,直流电机31启动后,由于主永磁体单元11与直流电机31通过和固定组件4固定连接,主永磁体单元11在直流电机31的驱动下能产生更稳定的旋转磁场,而且产生的旋转磁场可由直流电机31进行调控,内部设有从永磁体121的胶囊机器人13在这种稳定的旋转磁场的作用下会同步旋转,通过对直流电机31调控即可实现对胶囊机器人13前进、后退以及转向的稳定操控。In actual use, after the DC motor 31 is started, since the main permanent magnet unit 11 and the DC motor 31 are fixedly connected to the fixed component 4, the main permanent magnet unit 11 can generate a more stable rotating magnetic field driven by the DC motor 31, and generate The rotating magnetic field can be controlled by the DC motor 31. The capsule robot 13 with the permanent magnet 121 inside will rotate synchronously under the action of this stable rotating magnetic field. By controlling the DC motor 31, the capsule robot 13 can move forward and forward. Stable control of reverse and steering.
参照图1,主永磁体单元11包括两块主永磁体111,主永磁体111呈圆柱状且对称设置,充磁方向为厚度方向充磁,两块对称设置的主永磁体111在直流电机31的驱动下可产生稳定的叠加旋转磁场,从永磁体121单元12包括一块圆柱状的从永磁体121,从永磁体121的充磁方向为径向充磁,从永磁体121设置在胶囊机器人13的内部中心处。Referring to Figure 1, the main permanent magnet unit 11 includes two main permanent magnets 111. The main permanent magnets 111 are cylindrical and symmetrically arranged. The magnetizing direction is the thickness direction. The two symmetrically arranged main permanent magnets 111 are in the DC motor 31. A stable superimposed rotating magnetic field can be generated under the driving of the slave permanent magnet 121. The unit 12 includes a cylindrical slave permanent magnet 121. The magnetizing direction of the slave permanent magnet 121 is radial magnetization. The slave permanent magnet 121 is arranged on the capsule robot 13. at the inner center.
实际运用中,两块主永磁体111在直流电机31驱动下叠加产生的旋转磁场对从永磁体121的非接触磁作用力更强,保证胶囊机器人13位于人体内时能够稳定收到非接触磁作用力,不易出现断触情况,从永磁体121设置在胶囊机器人13的中心处也使得胶囊机器人13各部位受到的磁作用力均匀,在操控过程中不易出现因受力不均造成的位置偏移,控制效果差的情况。In actual use, the rotating magnetic field generated by the superposition of the two main permanent magnets 111 driven by the DC motor 31 exerts a stronger non-contact magnetic force on the slave permanent magnet 121, ensuring that the capsule robot 13 can stably receive non-contact magnetism when it is inside the human body. The magnetic force applied to each part of the capsule robot 13 is uniform, and position deviation caused by uneven force is less likely to occur during the control process. Shift, poor control effect.
参照图1,固定组件4包括联轴器41和紧固螺栓42,联轴器41的一侧与直流电机31的输出轴311嵌套设置并通过紧固螺栓42进行固定,联轴器41另一侧分别与两块主永磁体111固定连接并通过紧固螺栓42进行固定,直流电机31采用有线或者无线锂电池供电,设置在配套外壳5内部,固定组件4和两块主永磁体111设置在配套外壳5外部。Referring to Figure 1, the fixing assembly 4 includes a coupling 41 and fastening bolts 42. One side of the coupling 41 is nested with the output shaft 311 of the DC motor 31 and fixed by the fastening bolts 42. The other side of the coupling 41 One side is fixedly connected to the two main permanent magnets 111 and fixed by fastening bolts 42. The DC motor 31 is powered by a wired or wireless lithium battery and is set inside the matching housing 5. The fixing component 4 and the two main permanent magnets 111 are set Outside the matching housing 5.
实际运用中,直流电机31依靠输出轴311带动两块主永磁体111旋转,联轴器41在其中起到衔接和固定的作用,保证了主永磁体111旋转过程中的稳定和安全性,紧固螺栓42又进一步进行固定,对旋转磁场的稳定产生进行双重固定保护,直流电机31使用锂电池供电,可进行无线和有线两种方式充电,使直流电机31的电源电量得到保证,直流电机31设置在配套外壳5内起到对电机的保护和隔离作用。In actual use, the DC motor 31 relies on the output shaft 311 to drive the two main permanent magnets 111 to rotate, and the coupling 41 plays a role in connecting and fixing them, ensuring the stability and safety of the main permanent magnets 111 during the rotation. The fastening bolts 42 are further fixed to provide double fixation protection for the stable generation of the rotating magnetic field. The DC motor 31 is powered by a lithium battery and can be charged wirelessly and wiredly, so that the power supply of the DC motor 31 is guaranteed. The DC motor 31 It is arranged in the matching housing 5 to protect and isolate the motor.
参照图1和图2,控制模块2包括PC端21和操作手柄22,PC端21与胶囊机器人13信号连接,用于接收胶囊机器人13的视觉反馈信号,操作手柄22与电机模块3信号连接,用于对电机模块3进行调控从何控制磁耦合装置模块1的胶囊机器人13的运动,操作手柄22包括电机驱动器221、电机控制器222和控制面板223,电机驱动器221和电机控制器222用于对直流电机31的无线驱动控制,控制面板223用于对直流电机31进行转速及转向的精确控制,且能显示直流电机31的指令状态及运行状态。Referring to Figures 1 and 2, the control module 2 includes a PC terminal 21 and an operating handle 22. The PC terminal 21 is signal-connected to the capsule robot 13 for receiving visual feedback signals from the capsule robot 13. The operating handle 22 is signal-connected to the motor module 3. For regulating the motor module 3 and controlling the movement of the capsule robot 13 of the magnetic coupling device module 1, the operating handle 22 includes a motor driver 221, a motor controller 222 and a control panel 223. The motor driver 221 and the motor controller 222 are used to control the movement of the capsule robot 13 of the magnetic coupling device module 1. For wireless drive control of the DC motor 31, the control panel 223 is used to precisely control the rotation speed and steering of the DC motor 31, and can display the command status and operating status of the DC motor 31.
实际应用中,通过操作手柄22启动直流电机31,操作手柄22设有的电机驱动器221和电机控制器222加强稳固操作手柄22对主流电机的无线调控,直流电机31启动后,主永磁体111产生旋转磁场,操作手柄22实现对胶囊机器人13的操控,配合PC端21接收到的胶囊机器人13所述的位置环境,通过控制面板223即可对胶囊机器人13进行精确控制。In practical applications, the DC motor 31 is started through the operating handle 22. The motor driver 221 and the motor controller 222 provided on the operating handle 22 strengthen and stabilize the wireless control of the mainstream motor by the operating handle 22. After the DC motor 31 is started, the main permanent magnet 111 generates Rotate the magnetic field and operate the handle 22 to control the capsule robot 13. According to the position environment of the capsule robot 13 received by the PC terminal 21, the capsule robot 13 can be accurately controlled through the control panel 223.
参照图1和图2,控制面板223包括速度调节旋钮2231、转向调节按键2232、停止按键2233、开关键2232和数码显示屏2234,速度调节旋钮2231和转向旋钮用于控制直流电机31的转向及转速,从而调控两块主永磁体111产生的旋转磁场,进一步控制胶囊机器人13的转向和旋转速度,停止按键2233用于控制直流电机31停止运作,旋转磁场消失,胶囊机器人13停止运动,数码显示屏2234用于显示操作手柄22正在执行的指令及直流电机31的旋转状态及速度值。Referring to Figures 1 and 2, the control panel 223 includes a speed adjustment knob 2231, a steering adjustment button 2232, a stop button 2233, a switch key 2232 and a digital display 2234. The speed adjustment knob 2231 and the steering knob are used to control the steering and rotation of the DC motor 31. rotation speed, thereby regulating the rotating magnetic field generated by the two main permanent magnets 111, and further controlling the steering and rotation speed of the capsule robot 13. The stop button 2233 is used to control the DC motor 31 to stop operating, the rotating magnetic field disappears, and the capsule robot 13 stops moving, and the digital display The screen 2234 is used to display the instructions being executed by the operating handle 22 and the rotation status and speed value of the DC motor 31 .
实际应用中,通过控制面板223上速度调节旋钮2231、转向调节按键2232和停止按键2233对直流电机31进行调控,直流电机31影响主永磁体111产生的旋转磁场,从何调控内部含有从永磁体121的胶囊机器人13,通过控制面板223上的数码显示屏2234还可以进一步观察到直流电机31此时正在执行的指令,包括正反向转向和转动速度值。In practical applications, the DC motor 31 is controlled through the speed adjustment knob 2231, the steering adjustment button 2232 and the stop button 2233 on the control panel 223. The DC motor 31 affects the rotating magnetic field generated by the main permanent magnet 111, and how to control the internal secondary permanent magnets. 121 of the capsule robot 13, through the digital display 2234 on the control panel 223, you can further observe the instructions being executed by the DC motor 31 at this time, including forward and reverse steering and rotation speed values.
参照图1和图2,速度调节旋钮2231设置为正向旋转和反向旋转,当正向旋转速度调节旋钮2231时,直流电机31速度增加,胶囊机器人13也会随之加速旋转,数码显示屏2234显示此时的指令状态及直流电机31的速度值,且电机的转速在达到最大保护限定转速值后不再增加;当反向旋转速度调节旋钮2231时,直流电机31速度减小,胶囊机器人13也会随之减速旋转,数码显示屏2234显示指令状态及直流电机31的速度值,随着速度调节旋钮2231继续旋转,达到0位后,电机的速度不再变化。Referring to Figures 1 and 2, the speed adjustment knob 2231 is set to forward rotation and reverse rotation. When the speed adjustment knob 2231 is rotated forward, the speed of the DC motor 31 increases, and the capsule robot 13 will also accelerate and rotate accordingly. The digital display 2234 displays the command status and the speed value of the DC motor 31 at this time, and the motor speed will no longer increase after reaching the maximum protection limit speed value; when the speed adjustment knob 2231 is rotated in the reverse direction, the speed of the DC motor 31 decreases, and the capsule robot 13 will also decelerate and rotate accordingly. The digital display screen 2234 displays the command status and the speed value of the DC motor 31. As the speed adjustment knob 2231 continues to rotate, after reaching the 0 position, the speed of the motor no longer changes.
实际应用中,通过操作手柄22控制面板223上的速度调节旋钮2231即可对直流电机31的转速进行调控,从何影响胶囊机器人13的旋转速度,实现对胶囊机器人13的加速或减速调控,比如正向旋转速度调节旋钮2231,直流电机31的转速会增加,胶囊机器人13随之加速旋转,实现胶囊机器人13的加速;反向旋转速度调节旋钮2231,直流电机31的转速会减小,胶囊机器人13随之减速旋转,实现胶囊机器人13的减速,同时在数码显示屏2234上能观测到直流电机31的转速值。In practical applications, the speed adjustment knob 2231 on the control panel 223 of the handle 22 can be used to regulate the speed of the DC motor 31, thereby affecting the rotation speed of the capsule robot 13, and realizing the acceleration or deceleration control of the capsule robot 13, such as When the speed adjustment knob 2231 is rotated forward, the speed of the DC motor 31 will increase, and the capsule robot 13 will accelerate accordingly, realizing the acceleration of the capsule robot 13; when the speed adjustment knob 2231 is rotated in the reverse direction, the speed of the DC motor 31 will decrease, and the capsule robot 13 will be accelerated. 13 then decelerates and rotates to realize the deceleration of the capsule robot 13. At the same time, the speed value of the DC motor 31 can be observed on the digital display 2234.
参照图1和图2,转向调节按键2232设置为正转按键22321和反转按键22322,在控制面板223按下正转按键22321,直流电机31开始转动,胶囊机器人13随着主永磁体111产生的旋转磁场而旋转,数码显示屏2234显示直流电机31为正转及旋转速度数值,在控制面板223按下反转按键22322,直流电机31转动的方向与正向转动的方向相反,胶囊机器人13随之反方向旋转,数码显示屏2234显示直流电机31为反转及旋转速度数值。Referring to Figures 1 and 2, the steering adjustment button 2232 is set as a forward rotation button 22321 and a reverse rotation button 22322. Press the forward rotation button 22321 on the control panel 223, the DC motor 31 starts to rotate, and the capsule robot 13 is generated along with the main permanent magnet 111. The digital display 2234 displays the forward rotation and rotation speed value of the DC motor 31. Press the reverse button 22322 on the control panel 223. The DC motor 31 rotates in the opposite direction to the forward rotation. The capsule robot 13 Following the reverse rotation, the digital display screen 2234 displays the reverse rotation and rotation speed values of the DC motor 31 .
实际应用中,通过控制面板223上的转向调节按键2232控制胶囊机器人13正向运动或者反向运动,按下正转按键22321,直流电机31正常开始转动,胶囊机器人13正向旋转;按下反转按键22322,直流电机31反向转动,与正向转动的方向相反,胶囊机器人13反向旋转,实现变向,同时在数码显示屏2234上能观测到直流电机31的正反转状态。In practical applications, the forward or reverse movement of the capsule robot 13 is controlled through the steering adjustment button 2232 on the control panel 223. Press the forward button 22321, the DC motor 31 starts to rotate normally, and the capsule robot 13 rotates forward; press the reverse button. Turn the button 22322, the DC motor 31 rotates in the reverse direction, which is opposite to the forward rotation direction, and the capsule robot 13 rotates in the reverse direction to achieve direction change. At the same time, the forward and reverse rotation status of the DC motor 31 can be observed on the digital display 2234.
参照图3,胶囊机器人13采用3D打印制造,外部设置有一圈外螺纹131,外螺纹131上的螺旋凹槽用于将液体对胶囊机器人13的压力转变为轴向压力,有利于驱动胶囊机器人13向前或向后运动。Referring to Figure 3, the capsule robot 13 is manufactured by 3D printing, and is provided with a circle of external threads 131 on the outside. The spiral groove on the external thread 131 is used to convert the pressure of the liquid on the capsule robot 13 into axial pressure, which is beneficial to driving the capsule robot 13. Forward or backward movement.
参照图4,本发明一种胶囊机器人磁驱动系统的设计及控制方法的控制方法分为以下步骤:Referring to Figure 4, the design and control method of a capsule robot magnetic drive system of the present invention is divided into the following steps:
步骤一,按下控制面板223开关键2232,操作手柄22开始工作Step 1, press the switch key 2232 on the control panel 223, and the operating handle 22 starts to work
步骤二,按下控制面板223上的正转按键22321,直流电机31启动且正向旋转;Step 2: Press the forward rotation button 22321 on the control panel 223 to start the DC motor 31 and rotate forward;
步骤三,正向顺时针旋转控制面板223上的旋转速度调节旋钮2231,电机转速增加,胶囊机器人13也会随之加速旋转;Step 3: Rotate the rotation speed adjustment knob 2231 on the control panel 223 forward and clockwise. As the motor speed increases, the capsule robot 13 will also accelerate its rotation;
步骤四,反向逆时针旋转控制面板223上的旋转速度调节旋钮2231,电机转速减小,胶囊机器人13也会随之减速旋转;Step 4: Rotate the rotation speed adjustment knob 2231 on the control panel 223 counterclockwise. The motor speed will decrease, and the capsule robot 13 will also decelerate and rotate accordingly;
步骤五,按下控制面板223上的反转按键22322,直流电机31反向转动,与直流电机31正向转动的方向相反,胶囊机器人13反向旋转,实现变向;Step five, press the reverse button 22322 on the control panel 223, the DC motor 31 rotates in the reverse direction, which is opposite to the forward rotation direction of the DC motor 31, and the capsule robot 13 rotates in the reverse direction to achieve direction change;
步骤六,按下控制面板223上的暂停按键,直流电机31停止转动,胶囊机器人13停止旋转停滞;Step 6: Press the pause button on the control panel 223, the DC motor 31 stops rotating, and the capsule robot 13 stops rotating;
步骤七,检测结束再次按下控制面板223上的开关键2232,操作手柄22关闭。Step 7: After the detection is completed, press the switch key 2232 on the control panel 223 again to close the operating handle 22.
本申请实施例一种胶囊机器人磁驱动系统的设计和控制方法的实施原理为:通过操作手柄22对直流电机31进行启动调控,直流电机31转动,带动与直流电机31通过固定组件4固定连接的两块主永磁体111旋转产生旋转磁场,位于胶囊机器人13内部中心处的从永磁体121在旋转磁场的作用下受到非接触磁作用力,胶囊机器人13与外部的旋转磁场同步旋转,实现由操作手柄22对胶囊机器人13的操控,且操作手柄22上的电机驱动器221、电机控制器222使得操作手柄22与直流电机31的无线信号连接更稳定,控制面板223上的速度调节旋钮2231、转向调节按键2232、停止按键2233实现对直流电机31进行更精确地转速及转向调控,从何能够实现对胶囊机器人13更精确地调控。The implementation principle of the design and control method of the magnetic drive system of a capsule robot in the embodiment of the present application is as follows: the DC motor 31 is started and regulated through the operating handle 22, the DC motor 31 rotates, and drives the DC motor 31 fixedly connected through the fixing assembly 4. The two main permanent magnets 111 rotate to generate a rotating magnetic field. The slave permanent magnet 121 located at the center of the interior of the capsule robot 13 receives a non-contact magnetic force under the action of the rotating magnetic field. The capsule robot 13 rotates synchronously with the external rotating magnetic field to achieve operation. The handle 22 controls the capsule robot 13, and the motor driver 221 and motor controller 222 on the operating handle 22 make the wireless signal connection between the operating handle 22 and the DC motor 31 more stable. The speed adjustment knob 2231 and steering adjustment on the control panel 223 The button 2232 and the stop button 2233 enable more precise rotational speed and steering control of the DC motor 31, thereby enabling more precise control of the capsule robot 13.
以上均为本申请的较佳实施例,并非依此限制本申请的保护范围,故:凡依本申请的结构、形状、原理所做的等效变化,均应涵盖于本申请的保护范围之内。The above are all preferred embodiments of the present application, and are not intended to limit the scope of protection of the present application. Therefore, any equivalent changes made based on the structure, shape, and principle of the present application shall be covered by the scope of protection of the present application. Inside.
Claims (10)
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN202310952260.8A CN116784771A (en) | 2023-08-01 | 2023-08-01 | Design and control method of magnetic drive system for capsule robot |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN202310952260.8A CN116784771A (en) | 2023-08-01 | 2023-08-01 | Design and control method of magnetic drive system for capsule robot |
Publications (1)
| Publication Number | Publication Date |
|---|---|
| CN116784771A true CN116784771A (en) | 2023-09-22 |
Family
ID=88034983
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN202310952260.8A Pending CN116784771A (en) | 2023-08-01 | 2023-08-01 | Design and control method of magnetic drive system for capsule robot |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN116784771A (en) |
Cited By (1)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN113116278A (en) * | 2021-04-20 | 2021-07-16 | 河南工学院 | Magnetic coupling control device, system and method of capsule robot |
Citations (2)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN101022758A (en) * | 2004-09-21 | 2007-08-22 | 奥林巴斯株式会社 | Medical device guiding system |
| CN113116278A (en) * | 2021-04-20 | 2021-07-16 | 河南工学院 | Magnetic coupling control device, system and method of capsule robot |
-
2023
- 2023-08-01 CN CN202310952260.8A patent/CN116784771A/en active Pending
Patent Citations (2)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN101022758A (en) * | 2004-09-21 | 2007-08-22 | 奥林巴斯株式会社 | Medical device guiding system |
| CN113116278A (en) * | 2021-04-20 | 2021-07-16 | 河南工学院 | Magnetic coupling control device, system and method of capsule robot |
Cited By (1)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN113116278A (en) * | 2021-04-20 | 2021-07-16 | 河南工学院 | Magnetic coupling control device, system and method of capsule robot |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| Mahoney et al. | Generating rotating magnetic fields with a single permanent magnet for propulsion of untethered magnetic devices in a lumen | |
| EP3258877B1 (en) | Medical support arm device and medical system | |
| Mahoney et al. | Control of untethered magnetically actuated tools using a rotating permanent magnet in any position | |
| US20090281387A1 (en) | Capsule-type medical apparatus, guidance system and guidance method therefor, and intrasubject insertion apparatus | |
| Sun et al. | Preliminary study of a legged capsule robot actuated wirelessly by magnetic torque | |
| Wang et al. | Selective motion control of a novel magnetic-driven minirobot with targeted drug sustained-release function | |
| WO2005122866A1 (en) | Capsule type endoscope control system | |
| US8496573B2 (en) | Steerable capsule apparatus and method | |
| CN116784771A (en) | Design and control method of magnetic drive system for capsule robot | |
| Liu et al. | Design of a magnetic actuated fully insertable robotic camera system for single-incision laparoscopic surgery | |
| WO2022198809A1 (en) | Ball joint drive-based puncture surgery robot master hand and system | |
| EP4070756A1 (en) | Treatment assistance equipment | |
| CN204618172U (en) | Based on the hand-held capsule endoscope control device of magnetic active control | |
| CN117084797A (en) | Main end operator force feedback device and method of vascular interventional surgery robot | |
| Cao et al. | A dual-functional capsule robot for drug delivery and tissue biopsy based on magnetic torsion spring technology | |
| CN115005975A (en) | Master hand clamping device capable of simultaneously superposing force feedback and tactile vibration feedback and control method thereof | |
| Wright et al. | A spherical-magnet end-effector for robotic magnetic manipulation | |
| Ye et al. | Research on coaxial control of magnetic spiral-type capsule endoscope | |
| CN114403775A (en) | Endoscopy examination system, endoscope, medical electric chair and examination method | |
| Guo et al. | Design of a novel drug-delivery module for active locomotive intestinal capsule endoscopy | |
| Guo et al. | Study on the active movement capsule robot for biopsy | |
| WO2016132689A1 (en) | Medical support arm device and medical system | |
| WO2021129221A1 (en) | Magnetic spiral capsule endoscope, magnetic spiral capsule endoscope control system and control method therefor | |
| Liu et al. | A Computer‐Aided Teleoperation System for Intuitively Controlling the Behavior of a Magnetic Millirobot within a Stomach Phantom | |
| CN215017030U (en) | Magnetic coupling control device and magnetic coupling system of capsule robot |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| PB01 | Publication | ||
| PB01 | Publication | ||
| SE01 | Entry into force of request for substantive examination | ||
| SE01 | Entry into force of request for substantive examination |