[go: up one dir, main page]

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 PDF

Info

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
Application number
CN202310952260.8A
Other languages
Chinese (zh)
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.)
Fudan University
Original Assignee
Fudan 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 Fudan University filed Critical Fudan University
Priority to CN202310952260.8A priority Critical patent/CN116784771A/en
Publication of CN116784771A publication Critical patent/CN116784771A/en
Pending legal-status Critical Current

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/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/041Capsule 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

The application discloses a capsule robot magnetic driving system design and control method, which relates to the technical field of medical detection equipment, and comprises a magnetic coupling device module, a control module and a motor module, wherein the magnetic coupling device module and the motor module are connected through a fixing component, the control module is connected with the motor module through signals, the magnetic coupling device module comprises a main permanent magnet unit, a secondary permanent magnet unit and a capsule robot, the motor module drives the main permanent magnet unit to rotate to generate a stable rotating magnetic field, the main permanent magnet unit generates non-contact magnetic acting force on the secondary permanent magnet unit inside the capsule robot under the action of the rotating magnetic field, the capsule robot synchronously rotates with an external rotating magnetic field to realize movement, the control module comprises a PC end and an operating handle, and the operating handle regulates and controls the motor module to control the movement of the capsule robot of the magnetic coupling device module. The application has the advantages of stable magnetic driving of the capsule robot and accurate and convenient control of the capsule robot.

Description

一种胶囊机器人磁驱动系统设计及控制方法Design and control method of magnetic drive system for capsule robot

技术领域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)

1.一种胶囊机器人磁驱动系统设计及控制方法,其特征在于,包括磁耦合装置模块(1)、控制模块(2)和电机模块(3),所述磁耦合装置模块(1)和所述电机模块(3)的衔接处设置有固定组件(4),所述电机模块(3)驱动所述磁耦合装置模块(1)进行磁耦合,所述控制模块(2)与所述电机模块(3)信号连接,所述控制模块(2)控制所述电机模块(3)进何实现对所述磁耦合装置模块(1)的驱动控制;1. A capsule robot magnetic drive system design and control method, characterized in that it includes a magnetic coupling device module (1), a control module (2) and a motor module (3). The magnetic coupling device module (1) and the A fixed component (4) is provided at the connection point of the motor module (3). The motor module (3) drives the magnetic coupling device module (1) to perform magnetic coupling. The control module (2) and the motor module (3) Signal connection, the control module (2) controls the motor module (3) to realize the drive control of the magnetic coupling device module (1); 所述磁耦合装置模块(1)包括主永磁体单元(11)、从永磁体单元(12)和胶囊机器人(13),所述从永磁体单元(12)设置在所述胶囊机器人(13)内部中心处,所述电机模块(3)驱动所述主永磁体单元(11)旋转产生稳定旋转磁场,在旋转磁场的作用下所述主永磁体单元(11)对所述胶囊机器人(13)内部的从永磁体单元(12)产生非接触磁作用力,所述胶囊机器人(13)与外部的旋转磁场同步旋转,实现前进、后退与转向运动;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 arranged on the capsule robot (13). At the inner center, the motor module (3) drives the main permanent magnet unit (11) to rotate to generate a stable rotating magnetic field. Under the action of the rotating magnetic field, the main permanent magnet unit (11) affects the capsule robot (13). The internal permanent magnet unit (12) generates non-contact magnetic force, and the capsule robot (13) rotates synchronously with the external rotating magnetic field to achieve forward, backward and turning movements; 所述控制模块(2)包括PC端(21)和操作手柄(22),所述PC端(21)与所述胶囊机器人(13)信号连接,用于接收胶囊机器人(13)的视觉反馈信号,所述操作手柄(22)与所述电机模块(3)信号连接,用于对所述电机模块(3)进行调控从何控制所述磁耦合装置模块(1)的胶囊机器人(13)的运动。The control module (2) includes a PC terminal (21) and an operating handle (22). The PC terminal (21) is signally connected to the capsule robot (13) and is used to receive visual feedback signals from the capsule robot (13). , the operating handle (22) is signally connected to the motor module (3), and is used to regulate the motor module (3) and control the capsule robot (13) of the magnetic coupling device module (1). sports. 2.根据权利要求1所述的一种胶囊机器人磁驱动系统设计及控制方法,其特征在于,所述电机模块(3)设置为直流电机(31),所述直流电机(31)与所述操作手柄(22)信号连接,由所述操作手柄(22)进行控制,所述直流电机(31)的一侧设有输出轴(311),所述输出轴(311)与所述固定组件(4)嵌套设置且固定连接,所述固定组件(4)又与所述主永磁体单元(11)固定连接,用于固定直流电机(31)和所述主永磁体单元(11),使产生的旋转磁场更加稳定。2. A capsule robot magnetic drive system design and control method according to claim 1, characterized in that the motor module (3) is configured as a DC motor (31), and the DC motor (31) and the The operating handle (22) is connected with signals and controlled by the operating handle (22). An output shaft (311) is provided on one side of the DC motor (31), and the output shaft (311) is connected to the fixed component (311). 4) Nested arrangement and fixed connection, the fixing component (4) is fixedly connected to the main permanent magnet unit (11), and is used to fix the DC motor (31) and the main permanent magnet unit (11), so that The resulting rotating magnetic field is more stable. 3.根据权利要求1所述的一种胶囊机器人磁驱动系统设计及控制方法,其特征在于,所述主永磁体单元(11)包括两块主永磁体(111),所述主永磁体(111)呈圆柱状且对称设置,充磁方向为厚度方向充磁,所述两块对称设置的主永磁体(111)在所述直流电机(31)的驱动下可产生稳定的叠加旋转磁场,所述从永磁体单元(12)包括一块圆柱状的从永磁体(121),所述从永磁体(121)的充磁方向为径向充磁,所述从永磁体(121)设置在所述胶囊机器人(13)的内部中心处。3. A capsule robot magnetic drive system design and control method according to claim 1, characterized in that the main permanent magnet unit (11) includes two main permanent magnets (111), and the main permanent magnet (111) 111) is cylindrical and arranged symmetrically, and the magnetization direction is the thickness direction. The two symmetrically arranged main permanent magnets (111) can generate a stable superposed rotating magnetic field driven by the DC motor (31). The slave permanent magnet unit (12) includes a cylindrical slave permanent magnet (121), the magnetizing direction of the slave permanent magnet (121) is radial magnetization, and the slave permanent magnet (121) is arranged at At the inner center of the capsule robot (13). 4.根据权利要求2所述的一种胶囊机器人磁驱动系统设计及控制方法,其特征在于,所述固定组件(4)包括联轴器(41)和紧固螺栓(42),所述联轴器(41)的一侧与所述直流电机(31)的输出轴(311)嵌套设置并通过紧固螺栓(42)进行固定,所述联轴器(41)另一侧分别与所述两块主永磁体(111)固定连接并通过紧固螺栓(42)进行固定。4. A capsule robot magnetic drive system design and control method according to claim 2, characterized in that the fixed component (4) includes a coupling (41) and a fastening bolt (42), and the coupling One side of the shaft device (41) is nested with the output shaft (311) of the DC motor (31) and fixed by fastening bolts (42), and the other side of the coupling (41) is respectively connected with the output shaft (311) of the DC motor (31). The two main permanent magnets (111) are fixedly connected and fixed by fastening bolts (42). 5.根据权利要求1所述的一种胶囊机器人磁驱动系统设计及控制方法,其特征在于,所述胶囊机器人(13)采用3D打印制造,外部设置有一圈外螺纹(131),所述外螺纹(131)上的螺旋凹槽用于将液体对所述胶囊机器人(13)的压力转变为轴向压力,驱动所述胶囊机器人(13)向前或向后运动。5. The design and control method of a capsule robot magnetic drive system according to claim 1, characterized in that 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 thread (131) is used to convert the pressure of the liquid on the capsule robot (13) into axial pressure, driving the capsule robot (13) to move forward or backward. 6.根据权利要求4所述的一种胶囊机器人磁驱动系统设计及控制方法,其特征在于,所述操作手柄(22)包括电机驱动器(221)、电机控制器(222)和控制面板(223),所述电机驱动器(221)和所述电机控制器(222)用于对所述直流电机(31)的无线驱动控制,所述控制面板(223)用于对所述直流电机(31)进行转速及转向的精确控制,且能显示所述直流电机(31)的指令状态及转速值。6. A capsule robot magnetic drive system design and control method according to claim 4, characterized in that 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 for wireless drive control of the DC motor (31), and the control panel (223) is used for wireless drive control of the DC motor (31) It can accurately control the rotation speed and steering, and can display the command status and rotation speed value of the DC motor (31). 7.根据权利要求6所述的一种胶囊机器人磁驱动系统设计及控制方法,其特征在于,所述控制面板(223)包括速度调节旋钮(2231)、转向调节按键(2232)、停止按键(2233)、开关键(2232)和数码显示屏(2234),所述速度调节旋钮(2231)和所述转向调节按键(2232)用于控制所述直流电机(31)的转向及转动速度,从而调控所述主永磁体(111)产生的旋转磁场,进一步控制胶囊机器人(13)的转向和旋转速度,所述停止按键(2233)用于操控所述直流电机(31)停止运作,旋转磁场消失,胶囊机器人(13)停止运动,所述数码显示屏(2234)用于显示所述操作手柄(22)正在执行的指令及直流电机(31)的转动状态及转速值。7. A capsule robot magnetic drive system design and control method according to claim 6, characterized in that the control panel (223) includes a speed adjustment knob (2231), a steering adjustment button (2232), a stop button ( 2233), switch key (2232) and digital display screen (2234), the speed adjustment knob (2231) and the steering adjustment button (2232) are used to control the steering and rotation speed of the DC motor (31), thereby Regulate the rotating magnetic field generated by the main permanent magnet (111) to further control 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 and the rotating magnetic field disappears. , the capsule robot (13) stops moving, and the digital display 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). 8.根据权利要求7所述的一种胶囊机器人磁驱动系统设计及控制方法,其特征在于,所述速度调节旋钮(2231)设置为正向旋转和反向旋转,当正向旋转速度调节旋钮(2231)时,所述直流电机(31)速度增加,所述胶囊机器人(13)随之加速旋转,所述数码显示屏(2234)显示此时的指令状态及所述直流电机(31)的转速值,且电机的转速在达到最大保护限定转速值后不再增加;当反向旋转速度调节旋钮(2231)时,所述直流电机(31)速度减小,所述胶囊机器人(13)随之减速旋转,所述数码显示屏(2234)显示指令状态及所述直流电机(31)的转速值,随着速度调节旋钮(2231)继续旋转,达到0位后,所述主流电机(31)的转动速度不再变化。8. A capsule robot magnetic drive system design and control method according to claim 7, characterized in that the speed adjustment knob (2231) is set to forward rotation and reverse rotation. When the speed adjustment knob is rotated forward, (2231), the speed of the DC motor (31) increases, the capsule robot (13) accelerates and rotates accordingly, and the digital display screen (2234) displays the command status and the status of the DC motor (31) at this time. The speed value, 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) then decelerate and rotate, 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 mainstream motor (31) The rotation speed no longer changes. 9.根据权利要求7所述的一种胶囊机器人磁驱动系统设计及控制方法,其特征在于,所述转向调节按键(2232)设置为正转按键(22321)和反转按键(22322),在控制面板(223)按下正转按键(22321),所述直流电机(31)开始转动,所述胶囊机器人(13)随着所述主永磁体(111)产生的旋转磁场而旋转,所述数码显示屏(2234)显示所述直流电机(31)为正转及旋转速度数值,在控制面板(223)按下反转按键(22322),所述直流电机(31)转动的方向与正向旋转的方向相反,所述胶囊机器人(13)随之反方向旋转,所述数码显示屏(2234)显示所述直流电机(31)为反转及转动速度数值。9. A capsule robot magnetic drive system design and control method according to claim 7, characterized in that the steering adjustment button (2232) is set as a forward button (22321) and a reverse button (22322). When the forward rotation button (22321) is pressed on the control panel (223), the DC motor (31) starts to rotate, and the capsule robot (13) rotates with the rotating magnetic field generated by the main permanent magnet (111). The digital display screen (2234) displays the forward rotation and rotation speed value of the DC motor (31). Press the reverse button (22322) on the control panel (223), and the direction of rotation of the DC motor (31) is the same as the forward direction. The direction of rotation is opposite, and the capsule robot (13) rotates in the opposite direction accordingly, and the digital display screen (2234) displays the reverse rotation and rotation speed values of the DC motor (31). 10.根据权利要求9所述的一种胶囊机器人磁驱动系统设计及控制方法,其特征在于,所述直流电机(31)采用有线或者无线锂电池供电,所述直流电机外部设置有配套外壳(5)内部,所述固定组件(4)也设置在所述配套外壳(5)内部,所述两块主永磁体(111)设置在所述配套外壳(5)外部。10. A capsule robot magnetic drive system design and control method according to claim 9, characterized in that the DC motor (31) is powered by a wired or wireless lithium battery, and a matching shell ( 5) Inside, the fixing component (4) is also arranged inside the matching housing (5), and the two main permanent magnets (111) are arranged outside the matching housing (5).
CN202310952260.8A 2023-08-01 2023-08-01 Design and control method of magnetic drive system for capsule robot Pending CN116784771A (en)

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)

* Cited by examiner, † Cited by third party
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)

* Cited by examiner, † Cited by third party
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

Patent Citations (2)

* Cited by examiner, † Cited by third party
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)

* Cited by examiner, † Cited by third party
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