WO2023236492A1 - Wobble doll-like capsule robot - Google Patents

Wobble doll-like capsule robot Download PDF

Info

Publication number
WO2023236492A1
WO2023236492A1 PCT/CN2022/139557 CN2022139557W WO2023236492A1 WO 2023236492 A1 WO2023236492 A1 WO 2023236492A1 CN 2022139557 W CN2022139557 W CN 2022139557W WO 2023236492 A1 WO2023236492 A1 WO 2023236492A1
Authority
WO
WIPO (PCT)
Prior art keywords
housing
tumbler
capsule
robot
magnetic field
Prior art date
Application number
PCT/CN2022/139557
Other languages
French (fr)
Chinese (zh)
Inventor
尚万峰
李宇璐
吴新宇
Original Assignee
中国科学院深圳先进技术研究院
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 中国科学院深圳先进技术研究院 filed Critical 中国科学院深圳先进技术研究院
Publication of WO2023236492A1 publication Critical patent/WO2023236492A1/en

Links

Images

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
    • AHUMAN NECESSITIES
    • A61MEDICAL OR VETERINARY SCIENCE; HYGIENE
    • A61BDIAGNOSIS; SURGERY; IDENTIFICATION
    • A61B1/00Instruments for performing medical examinations of the interior of cavities or tubes of the body by visual or photographical inspection, e.g. endoscopes; Illuminating arrangements therefor
    • A61B1/273Instruments for performing medical examinations of the interior of cavities or tubes of the body by visual or photographical inspection, e.g. endoscopes; Illuminating arrangements therefor for the upper alimentary canal, e.g. oesophagoscopes, gastroscopes
    • A61B1/2736Gastroscopes

Definitions

  • capsule robots As micro-robots are used more and more widely in the biomedical industry, traditional medical instruments are slowly becoming intelligent, and the demand for capsule robots is growing rapidly. Compared with traditional gastroscopes, colonoscopy causes discomfort, and with the help of With the magnetically controlled capsule gastroscopy robot, the subject can complete a painless, non-invasive, and anesthesia-free examination without the need for intubation. Capsule microrobots perform non-invasive examinations and small-injury surgeries in the human gastrointestinal tract, which are of great significance for reducing patient pain, improving the safety of examinations and surgeries, and reducing medical costs.
  • capsule robots for gastrointestinal examination.
  • the miniature digestive tract capsule endoscope developed by people uses the peristalsis of the digestive tract to inspect the entire area, and the inspection image is transmitted wirelessly by an embedded micro camera.
  • wirelessly controlled capsule robots based on embedded image processing can already perform non-invasive diagnosis and treatment of the stomach and achieve clinical applications; this has greatly improved patients' acceptance of gastrointestinal examinations, improved the efficiency of medical examinations, and enabled earlier Discover and solve problems, effectively reducing the probability of disease progression.
  • the current capsule robot cannot be called completely unmanned control, nor can it be called a completely automatic system, because in the narrow environments of the esophagus and intestines, the capsule robot still has visual blind spots. , and it is prone to rolling in the intestines and stomach, and there are problems with inaccurate positioning and orientation.
  • the main problems that exist are how to achieve more precise control and find structural designs suitable for different organ environments to design new capsule robots.
  • Magnetic drive control mainly uses two operating modes: magnetic force and magnetic moment; magnetic force control mainly uses a permanent magnet to provide a gradient magnetic field to apply magnetic force to make the capsule robot flip in the intestines and stomach.
  • the magnetic moment is driven by a rotating magnetic field or the use of a current coil.
  • the passive double-hemisphere capsule robot can achieve rolling walking in the active mode, and "hover" posture adjustment at a fixed point in the passive mode.
  • the conversion of active and passive motion modes is carried out through a multi-dimensional rotating magnetic field.
  • a fixed-point "hover" posture adjustment dynamic model was established using the Lagrange equation, which can effectively realize clinical applications such as fixed-point targeted therapy.
  • these existing capsule robots have multiple structures but are not targeted. They are widely used in different working environments. Most of the existing capsule robots place micro cameras inside the capsule robot. When inspecting lesions, it is necessary to detect the lesions. Click to take a picture. At this time, the direction and position of the capsule robot must be kept constant. However, due to the peristalsis of the gastrointestinal tract, it is difficult for conventional capsule robots to achieve precise positioning through the structure of the capsule robot itself.
  • This application provides a tumbler capsule robot, including:
  • the housing is arranged in the form of a cylinder with one end open, and raised structures are provided at both ends of the sides in the length direction of the housing, and the raised structures are used to maintain the balance of the robot; Both ends of the housing in the length direction are configured as ellipses.
  • One end of the opening of the housing is connected to a cylindrical shell cover that matches the housing.
  • the housing and the shell cover form a closed tumbler structure.
  • the tumbler structure For maintaining the positioning or orientation of the robot in the same direction;
  • the Halbach magnetic field module is arranged to fit the inner wall of the housing, and the Halbach magnetic field module is eccentrically arranged in the housing;
  • the shell cover is in the form of a tank body.
  • the technical solution adopted in the embodiment of the present application also includes: the end of the shell cover away from the shell is in a convex shape.
  • the technical solution adopted in the embodiment of this application also includes: the inner diameter of the housing and the cover is 12mm, the integrated circuit control board is a cuboid of 8mm*25mm*2mm, and the visual detection module is a cube with two side lengths of 7-10mm.
  • FIG. 2 is a cross-sectional view of the tumbler capsule robot of the present application.
  • FIG. 7 is a schematic diagram of the tumbler capsule robot of the present application after being stressed
  • the reference numbers are: 1-shell, 2-shell cover, 3-Halbach magnetic field module, 4-integrated circuit control board, 5-visual detection module, 6-battery module, 7-convex structure, 8-convex .
  • capsule robots In the field of medical use of capsule robots, the functions that capsule robots can achieve are the focus of our attention; currently, most capsule robots still use the original cylindrical structure.
  • This structure can be used in some small and narrow environments. For example, in the esophagus and intestines, the capsule cannot be kept stable in the same direction as required, and problems such as rolling and turning are prone to occur. It is necessary to rely on human operation and set parameters to adjust the direction of the fixed capsule robot. This method reduces the work of the capsule robot. Efficiency, prone to problems such as inaccurate orientation and positioning.
  • Module 5 uses binocular vision to collect images; through the magnetic field control of Halbach magnetic field module 3, the robot's balance angle and positioning orientation are controlled; in this application, protruding structures are provided at both ends of the sides in the length direction of the housing 1 for To maintain the balance of the robot, both ends of the housing 1 in the length direction are set into elliptical tumbler structures to maintain the robot's positioning or orientation in the same direction; the Halbach magnetic field module 3 is eccentrically placed in the housing and the integrated circuit control board 4 is placed It is lower than the center of mass of the shell 1 so that the gravity of the capsule robot is biased to one side. Through the structural performance combined with the magnetic control of the Halbach magnetic field module 3, continuous directional positioning is achieved to improve the efficiency of the robot. The attitude adjustment is flexible and can be applied to different working environments. .
  • the tumbler structure of the present application can be divided into two parts, the shell part 1 and the shell cover part 2.
  • the open end of the shell 1 is connected to a cylindrical shell cover that matches the shell 1 2.
  • the side of the cover 2 is set as an elliptical protrusion 8, and the cover 2 is closed on the housing 1, so that the housing 1 forms a machine casing with a closed cavity; the part of the housing 1 is similar to a "safety lock"
  • the structure of the capsule robot is a tumbler structure, that is, the end of the shell cover 2 away from the opening is an elliptical protrusion 8, and the end of the shell 1 away from the opening is an elliptical protrusion 8, as shown in Figure 1; the overall capsule robot
  • the assembly diagram, as shown in Figure 4 constitutes a monostable structure as a whole.
  • the relationship between the geometric shape and the static balance finger is structurally optimized to maintain the monostable state.
  • the structure designs a complete capsule robot into two parts. , it is convenient to install the required modules into it, and in subsequent experimental use, if any problem is found in the module, it can be replaced immediately.
  • the Halbach magnetic field module 3 and other modules required for control are put into the capsule robot structure to establish a three-dimensional model; through experiments, the best placement position is found, and the Halbach magnetic field module 3 is arranged at the bottom of the tumbler structure according to rules.
  • the position of the micro battery module 6 is placed in the housing 1.
  • the integrated circuit control board 4 and the visual detection module 5 are arranged in sequence on the Halbach magnetic field module 3.
  • the assembly diagram of the complete capsule robot is shown in Figures 2 and 4; If new control modules or other functional modules are added later, the existing tumbler structure can still be optimized to achieve continuous positioning in the same direction.
  • the overall length of the tumbler capsule robot is 28mm and the height is 15mm; the inner diameters of the shell cover 2 and the shell 1 are equal, and the diameter of the inscribed circle is set to 10-14, preferably 12mm; the visual detection module 5 is set to Two equal cubes with a side length of 7-10mm, preferably a cube with a length of 8mm. If other modules are added later, the area of the visual detection module 5 can be placed for optimization; the integrated circuit control board 4 is a cuboid of 8mm*25mm*2mm, located at Above the Halbach magnetic field module 3; the Halbach magnetic field module 3 includes 3-8 cubes with a side length of 2 mm arranged and connected in sequence. Preferably, the Halbach magnetic field module 3 is composed of 5 cubes with a side length of 2 mm.
  • the five small cubes in the Halbach magnetic field module 3 are glued in the set direction.
  • the integrated circuit control board 4 and the visual detection module 5 are glued on top of the Halbach magnetic field module 3 in turn;
  • the battery module 6 is located on the shell cover 2 Inside the tank, double-sided tape is used for pasting; a rechargeable capacitor battery is used, and the battery module 6 and the integrated circuit control board 4 are connected through wires;
  • the capsule shell is printed using 3D printing technology, which is more environmentally friendly.
  • the distance between the original contact point A and the current contact point A 1 is R ⁇ , and the position vector of the counterweight O relative to the original contact point A can be expressed as:
  • the moment M 2 formed by its own counterweight resists the external force.
  • the two moments are in opposite directions. When they are equal, a dynamic balance is achieved; subsequently, as F continues to decrease, it gradually approaches 0. , only the moment M 2 exists at this time; relying on the moment M 2 makes the capsule robot return to the original equilibrium point, that is, the balance between gravity and supporting force; the moment arm acted by the external force F is set to l 1 ; the moment arm acted by the gravity of the counterweight Equivalent to the distance from point O to A 1 , set to l 2 ; after the robot is stressed, the center of gravity O changes, causing l 2 to also change; the equations of M 1 and M 2 are expressed as follows:
  • the center of mass O of the counterweight rotates and may be above or below the center of the inscribed circle.
  • the positive sign means it is above the center of the circle, and the negative sign means it is below.
  • the amplitude of the swing depends on the size of the counterweight.
  • the mass of the battery module 6 is lighter than the mass of other parts, so the battery module 6 has little effect on the amplitude of the swing; the battery module 6 does not affect the stability of the entire capsule robot. sports.
  • the existing control method of capsule robots basically relies on humans.
  • the robot is basically controlled by humans to perform positioning and orientation detection and take pictures and samples of the lesion points.
  • Most of the capsule robots reach the positioning points based on experience. In this process, it is difficult to maintain the targeted positioning.
  • the direction to be detected does not change, so it is impossible to guarantee that the state will always be maintained during manual debugging; for the detection of lesions, it is difficult to achieve continuous positioning in the same direction, making the existing capsule robots less efficient.
  • this application conducts a stress analysis on the tumbler structure based on theoretical mechanics to obtain a capsule robot; combined with magnetic control, the control angle can be adjusted in real time according to the state of the capsule robot.
  • the Halbach magnetic field module 3 By controlling the Halbach magnetic field module 3, it can be applied in different environments.
  • This application applies to a new type of tumbler capsule robot that can perform fixed-point positioning and inspection in the human environment. Compared with other capsule robots, it can achieve continuous positioning in the same direction only through structural performance, which greatly improves the working efficiency of the capsule robot.
  • the control device is micro and adopts a tumbler structure.
  • the tumbler shell structure is made of environmentally friendly materials combined with 3D printing technology.
  • the overall size is small, light in weight, and the surface is smooth.

Abstract

A wobble doll-like capsule robot, relating to the field of medical instruments. The wobble doll-like capsule robot comprises: a housing (1), the housing (1) being configured as a cylinder having one end being an opening; protruding structures (7) are arranged at two ends of lateral sides in a length direction of the housing (1), the protruding structures (7) being used for keeping the balance of the robot; the two ends in the length direction of the housing (1) are configured to be elliptical; the opening end of the housing (1) is connected to a cylindrical housing cover (2) matched with the housing (1); the housing (1) and the housing cover (2) form a sealed wobble doll-like structure, and the wobble doll-like structure is used for keeping the robot positioned or oriented in the same direction. A Halbach magnetic field module (3) is eccentrically arranged in the housing (1), and an integrated circuit control board (4) is arranged at a position lower than the center of mass of the housing (1), thereby offsetting the center of gravity of the capsule robot and enabling continuous directional positioning by means of the described structural properties in combination with the magnetic control of the Halbach magnetic field module (3). Thus the efficiency of the robot is improved, and the posture adjustment is flexible, and the robot is suitable for different working environments.

Description

一种不倒翁胶囊机器人A tumbler capsule robot 技术领域Technical field
本申请属于医疗器械技术领域,特别涉及一种不倒翁胶囊机器人。This application belongs to the technical field of medical devices, and particularly relates to a tumbler capsule robot.
背景技术Background technique
随着微型机器人在生物医疗行业应用的越来越广泛,传统的医疗仪器也在慢慢的走向智能化,胶囊机器人的需求快速增长;相比传统胃镜,肠镜给人带来的不适,借助磁控胶囊胃镜机器人,受检人无需插管,就能完成无痛、无创、无麻醉的检查。胶囊微型机器人在人体肠胃中进行无创检查和小损伤手术,对于减轻病人痛苦、提高检查和手术的安全性和降低医疗费用都具有重要意义。As micro-robots are used more and more widely in the biomedical industry, traditional medical instruments are slowly becoming intelligent, and the demand for capsule robots is growing rapidly. Compared with traditional gastroscopes, colonoscopy causes discomfort, and with the help of With the magnetically controlled capsule gastroscopy robot, the subject can complete a painless, non-invasive, and anesthesia-free examination without the need for intubation. Capsule microrobots perform non-invasive examinations and small-injury surgeries in the human gastrointestinal tract, which are of great significance for reducing patient pain, improving the safety of examinations and surgeries, and reducing medical costs.
同时随着机器人技术的发展,研究人员已经研发出了各种各样用于胃肠道检查的胶囊机器人。例如,人们研制出的微型消化道胶囊内窥镜是利用消化道蠕动进行整个区域检查,由内嵌微型摄像机以无线方式传输检查图像。目前,基于内嵌图像处理的无线控制胶囊机器人已经可以实施胃的无创诊疗,实现了临床应用;这极大的提高了患者对于肠胃的检查的接受程度,提高了医疗检查的效率,更早的发现并解决问题,有效的减少了患病恶化的概率。At the same time, with the development of robotic technology, researchers have developed a variety of capsule robots for gastrointestinal examination. For example, the miniature digestive tract capsule endoscope developed by people uses the peristalsis of the digestive tract to inspect the entire area, and the inspection image is transmitted wirelessly by an embedded micro camera. At present, wirelessly controlled capsule robots based on embedded image processing can already perform non-invasive diagnosis and treatment of the stomach and achieve clinical applications; this has greatly improved patients' acceptance of gastrointestinal examinations, improved the efficiency of medical examinations, and enabled earlier Discover and solve problems, effectively reducing the probability of disease progression.
但是这种技术也存在明显的缺陷,目前的胶囊机器人不能称为完全意义的无人控制,不能称为完全的全自动系统,因为在食道管,肠道中这些狭窄环境,胶囊机器人依然存在视觉盲区,且在肠胃容易发生翻滚,定位定向存在不准的问题。存在的最主要的问题就是如何实现更精确的控制以及找到适合不同器官环境的结构设计新的胶囊机器人。However, this technology also has obvious flaws. The current capsule robot cannot be called completely unmanned control, nor can it be called a completely automatic system, because in the narrow environments of the esophagus and intestines, the capsule robot still has visual blind spots. , and it is prone to rolling in the intestines and stomach, and there are problems with inaccurate positioning and orientation. The main problems that exist are how to achieve more precise control and find structural designs suitable for different organ environments to design new capsule robots.
目前大部分的胶囊机器人为了实现定向定点的布药,活检,等诊疗作业, 选择磁控作为最方便的控制方法解决无线控制的问题。磁驱控制主要是通过磁力与磁矩两种操作方式;磁力控制主要是通过永磁体提供梯度磁场施加磁力使胶囊机器人在肠胃内进行翻转,磁矩是通过旋转磁场或者是运用电流线圈驱动。在结构方面,已有双半球胶囊机器人,花瓣机器人,尺蠖式机器人等。其中被动双半球胶囊机器人,主动模态实现滚动行走,被动模态实现定点“悬停”调姿。通过多维度旋转磁场进行主被动运动方式的转换。利用拉格朗日方程建立了定点“悬停”调姿动力学模型,可以有效实现定点靶向治疗等临床应用。At present, most capsule robots choose magnetic control as the most convenient control method to solve the problem of wireless control in order to achieve directional and fixed-point drug distribution, biopsy, and other diagnostic and treatment operations. Magnetic drive control mainly uses two operating modes: magnetic force and magnetic moment; magnetic force control mainly uses a permanent magnet to provide a gradient magnetic field to apply magnetic force to make the capsule robot flip in the intestines and stomach. The magnetic moment is driven by a rotating magnetic field or the use of a current coil. In terms of structure, there are dual-hemisphere capsule robots, petal robots, inchworm robots, etc. Among them, the passive double-hemisphere capsule robot can achieve rolling walking in the active mode, and "hover" posture adjustment at a fixed point in the passive mode. The conversion of active and passive motion modes is carried out through a multi-dimensional rotating magnetic field. A fixed-point "hover" posture adjustment dynamic model was established using the Lagrange equation, which can effectively realize clinical applications such as fixed-point targeted therapy.
不过这些现有的胶囊机器人结构多元,但没有针对性,广泛性的实现在不同种工作环境中上,大部分现有的胶囊机器人将微型摄像头放置于胶囊机器人内部,在检查病灶时需要对病灶点进行拍照,这个时候就要保持胶囊机器人方向位置恒定,但由于胃肠道的蠕动,常规的胶囊机器人很难通过胶囊机器人本身的结构实现精准定位。However, these existing capsule robots have multiple structures but are not targeted. They are widely used in different working environments. Most of the existing capsule robots place micro cameras inside the capsule robot. When inspecting lesions, it is necessary to detect the lesions. Click to take a picture. At this time, the direction and position of the capsule robot must be kept constant. However, due to the peristalsis of the gastrointestinal tract, it is difficult for conventional capsule robots to achieve precise positioning through the structure of the capsule robot itself.
因此,现有技术还存在不足,有待于进一步发展。Therefore, the existing technology still has shortcomings and needs further development.
发明内容Contents of the invention
为解决上述问题,本申请的目的在于提供一种不倒翁胶囊机器人,以解决现有机器人无法精准定位定向的技术问题。In order to solve the above problems, the purpose of this application is to provide a tumbler capsule robot to solve the technical problem that existing robots cannot accurately position and orient.
本申请的目的是通过以下技术方案实现的:The purpose of this application is achieved through the following technical solutions:
本申请提供一种不倒翁胶囊机器人,包括:This application provides a tumbler capsule robot, including:
壳体,所述壳体呈一端为开口的圆柱体设置,所述壳体的长度方向的侧边两端设置有凸起结构,所述凸起结构用于保持所述机器人的平衡;所述壳体的长度方向两端均设置为椭圆,所述壳体的开口一端连接有与所述壳体配合的圆柱体壳盖,所述壳体与壳盖构成封闭的不倒翁结构,所述不倒翁结构用于保持 所述机器人的同方向定位或定向;The housing is arranged in the form of a cylinder with one end open, and raised structures are provided at both ends of the sides in the length direction of the housing, and the raised structures are used to maintain the balance of the robot; Both ends of the housing in the length direction are configured as ellipses. One end of the opening of the housing is connected to a cylindrical shell cover that matches the housing. The housing and the shell cover form a closed tumbler structure. The tumbler structure For maintaining the positioning or orientation of the robot in the same direction;
Halbach磁场模块,贴合所述壳体内壁设置,所述Halbach磁场模块偏心设置在所述壳体内;The Halbach magnetic field module is arranged to fit the inner wall of the housing, and the Halbach magnetic field module is eccentrically arranged in the housing;
集成电路控制板,贴设在所述Halbach磁场模块上,所述集成电路控制板设置低于所述壳体的质心位置,以构成偏心结构;An integrated circuit control board is attached to the Halbach magnetic field module, and the integrated circuit control board is set lower than the center of mass of the housing to form an eccentric structure;
视觉检测模块,设置在所述集成电路控制板上,用于进行图像采集,所述视觉检测模块采用双目视觉进行图像采集;A visual detection module is provided on the integrated circuit control board and is used for image collection. The visual detection module uses binocular vision for image collection;
通过所述集成电路控制板低于所述壳体的质心位置、壳体两端的椭圆结构设置,整体构成的不倒翁结构设置及Halbach磁场模块的磁场控制调控所述机器人的平衡角度及实现定位定向。Through the position of the integrated circuit control board lower than the center of mass of the housing, the elliptical structure at both ends of the housing, the overall tumbler structure and the magnetic field control of the Halbach magnetic field module, the balance angle of the robot is controlled and the positioning and orientation are achieved.
本申请实施例采取的技术方案还包括:所述壳盖中心部分为凸起结构,壳体下半部分为圆弧结构,所述圆弧的圆心位置与胶囊的质心位置不重合,且在重力方向远低于质心位置,所述壳盖合盖在所述壳体上,使得所述壳体形成一封闭空腔的机外壳。The technical solution adopted in the embodiment of the present application also includes: the central part of the shell cover is a convex structure, and the lower part of the shell is an arc structure. The center position of the arc does not coincide with the center of mass position of the capsule, and under the gravity The direction is much lower than the center of mass position, and the shell cover is closed on the shell, so that the shell forms a machine shell that closes the cavity.
本申请实施例采取的技术方案还包括:壳盖呈槽体。The technical solution adopted in the embodiment of the present application also includes: the shell cover is in the form of a tank body.
本申请实施例采取的技术方案还包括:壳盖的槽体内设置有电池模块,电池模块与集成电路控制板电连接。The technical solution adopted in the embodiment of the present application also includes: a battery module is provided in the tank of the shell cover, and the battery module is electrically connected to the integrated circuit control board.
本申请实施例采取的技术方案还包括:壳盖远离壳体一端呈凸起状。The technical solution adopted in the embodiment of the present application also includes: the end of the shell cover away from the shell is in a convex shape.
本申请实施例采取的技术方案还包括:壳体远离开口一端呈凸起状。The technical solution adopted in the embodiment of the present application also includes: the end of the housing away from the opening is in a convex shape.
本申请实施例采取的技术方案还包括:Halbach磁场模块、视觉检测模块及集成电路控制板之间的连接通过胶粘连接。The technical solution adopted in the embodiment of the present application also includes: the Halbach magnetic field module, the visual detection module and the integrated circuit control board are connected through adhesive connection.
本申请实施例采取的技术方案还包括:机外壳的长度为28mm,高位15mm。The technical solution adopted in the embodiment of this application also includes: the length of the machine casing is 28 mm, and the height is 15 mm.
本申请实施例采取的技术方案还包括:壳体及壳盖的内直径为12mm,集成电路控制板为8mm*25mm*2mm的长方体,视觉检测模块为两个边长7-10mm的立方体。The technical solution adopted in the embodiment of this application also includes: the inner diameter of the housing and the cover is 12mm, the integrated circuit control board is a cuboid of 8mm*25mm*2mm, and the visual detection module is a cube with two side lengths of 7-10mm.
本申请实施例采取的技术方案还包括:Halbach磁场模块包括3-8个边长为2mm的依次排列连接的立方体。The technical solution adopted in the embodiment of the present application also includes: the Halbach magnetic field module includes 3-8 cubes with side lengths of 2 mm arranged and connected in sequence.
相对于现有技术,本申请实施例产生的有益效果在于:Compared with the existing technology, the beneficial effects produced by the embodiments of the present application are:
本申请的不倒翁胶囊机器人中,包括:壳体,壳体呈一端为开口的圆柱体设置,壳体的侧边的两端设置有凸起结构,凸起结构用于保持机器人的平衡;Halbach磁场模块,贴合壳体内壁设置;集成电路控制板,贴设在Halbach磁场模块上;视觉检测模块,设置在集成电路控制板上,用于进行图像采集;通过Halbach磁场模块的磁场控制,调控机器人的平衡角度及实现定位定向;本申请在壳体的长度方向的侧边两端设置有凸起结构用于保持机器人的平衡,将壳体的长度方向两端均设置为椭圆的不倒翁结构用于保持机器人的同方向定位或定向;将Halbach磁场模块偏心设置在壳体内及将集成电路控制板设置低于壳体的质心位置,以便胶囊机器人的重力偏向于一边,通过上述的结构性能结合Halbach磁场模块的磁控实现持续方向定位,提高机器人的效率,姿态调整灵活,可适用于不同的工作环境。The tumbler capsule robot of the present application includes: a shell, which is arranged as a cylinder with one end open, and protruding structures are provided at both ends of the sides of the shell, and the protruding structures are used to maintain the balance of the robot; Halbach magnetic field The module is installed to fit the inner wall of the housing; the integrated circuit control board is attached to the Halbach magnetic field module; the visual detection module is installed to the integrated circuit control board for image acquisition; the robot is controlled through the magnetic field control of the Halbach magnetic field module. The balance angle and the realization of positioning and orientation; in this application, protruding structures are provided at both ends of the sides of the housing in the length direction to maintain the balance of the robot, and both ends of the housing in the length direction are provided with elliptical tumbler structures for use Keep the robot positioned or oriented in the same direction; set the Halbach magnetic field module eccentrically in the shell and set the integrated circuit control board lower than the center of mass of the shell so that the gravity of the capsule robot is biased to one side. The above structural properties are combined with the Halbach magnetic field. The module's magnetic control realizes continuous directional positioning, improving the efficiency of the robot, and its posture adjustment is flexible, making it suitable for different working environments.
附图说明Description of drawings
此处所说明的附图用来提供对本申请的进一步理解,构成本申请的一部分,本申请的示意性实施例及其说明用于解释本申请,并不构成对本申请的不当限定。在附图中:The drawings described here are used to provide a further understanding of the present application and constitute a part of the present application. The illustrative embodiments of the present application and their descriptions are used to explain the present application and do not constitute an improper limitation of the present application. In the attached picture:
图1是本申请不倒翁胶囊机器人的结构图;Figure 1 is a structural diagram of the tumbler capsule robot of the present application;
图2是本申请不倒翁胶囊机器人的剖视图;Figure 2 is a cross-sectional view of the tumbler capsule robot of the present application;
图3是本申请不倒翁胶囊机器人的不设电池模块的透视结构图;Figure 3 is a perspective structural view of the tumbler capsule robot of the present application without a battery module;
图4是本申请不倒翁胶囊机器人的设置电池模块及壳盖的透视结构图;Figure 4 is a perspective structural view of the battery module and shell cover of the tumbler capsule robot of the present application;
图5是本申请不倒翁胶囊机器人的不设电池模块及壳盖的透视结构图;Figure 5 is a perspective structural view of the tumbler capsule robot of the present application without a battery module and a shell cover;
图6是本申请不倒翁胶囊机器人的受力前的示意图;Figure 6 is a schematic diagram of the tumbler capsule robot of the present application before it is stressed;
图7是本申请不倒翁胶囊机器人的受力后的示意图;Figure 7 is a schematic diagram of the tumbler capsule robot of the present application after being stressed;
图8是本申请不倒翁胶囊机器人的电池模块受力示意图。Figure 8 is a force diagram of the battery module of the tumbler capsule robot of the present application.
其中附图标记为:1-壳体、2-壳盖、3-Halbach磁场模块、4-集成电路控制板、5-视觉检测模块、6-电池模块、7-凸起结构、8-凸起。The reference numbers are: 1-shell, 2-shell cover, 3-Halbach magnetic field module, 4-integrated circuit control board, 5-visual detection module, 6-battery module, 7-convex structure, 8-convex .
具体实施方式Detailed ways
为了使本技术领域的人员更好地理解本申请方案,下面将结合本申请实施例中的附图,对本申请实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例仅仅是本申请一部分的实施例,而不是全部的实施例。基于本申请中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都应当属于本申请保护的范围。In order to enable those in the technical field to better understand the solutions of the present application, the technical solutions in the embodiments of the present application will be clearly and completely described below in conjunction with the accompanying drawings in the embodiments of the present application. Obviously, the described embodiments are only These are part of the embodiments of this application, not all of them. Based on the embodiments in this application, all other embodiments obtained by those of ordinary skill in the art without creative efforts should fall within the scope of protection of this application.
在胶囊机器人用于医疗的领域,胶囊机器人所能实现的功能是我们关注的重点;而目前大多数的胶囊机器人采用的结构依然是原始的圆柱结构,这种结构在一些微小狭窄的环境中,比如食管,肠道中不能保持胶囊一直稳定在所需的同一个方向,容易发生滚动,转向等问题,需要依靠人为操作,设置参数来调整固定胶囊机器人的方向,这种方式降低了胶囊机器人的工作效率,容易出现定向定位不准确等问题。In the field of medical use of capsule robots, the functions that capsule robots can achieve are the focus of our attention; currently, most capsule robots still use the original cylindrical structure. This structure can be used in some small and narrow environments. For example, in the esophagus and intestines, the capsule cannot be kept stable in the same direction as required, and problems such as rolling and turning are prone to occur. It is necessary to rely on human operation and set parameters to adjust the direction of the fixed capsule robot. This method reduces the work of the capsule robot. Efficiency, prone to problems such as inaccurate orientation and positioning.
因此基于以上问题,本申请提出的不倒翁结构的胶囊机器人,在检查时只 需要将用于驱动的大磁铁的位置确定,即可实现精准的控制本胶囊机器人的定位定向。Therefore, based on the above problems, the capsule robot with a tumbler structure proposed in this application only needs to determine the position of the large magnet used for driving during inspection, so that the positioning and orientation of the capsule robot can be accurately controlled.
参考图1至图5,本申请实施例的不倒翁胶囊机器人,包括:壳体1,壳体1呈一端为开口的圆柱体设置,壳体1的长度方向的侧边两端设置有凸起结构7,凸起结构7用于保持机器人的平衡,壳体1的长度方向两端均设置为椭圆的不倒翁结构,不倒翁结构用于保持机器人的同方向定位或定向,将壳体设置为椭圆的不倒翁结构,是胶囊机器人具有不倒翁动结构的力学特性;Halbach磁场模块3(Halbach-海尔巴赫),贴合壳体1内壁设置,Halbach磁场模块3偏心设置在壳体1内;集成电路控制板4,贴设在Halbach磁场模块3上,集成电路控制板4设置低于壳体的质心位置,以构成偏心结构;视觉检测模块5,设置在集成电路控制板4上,用于进行图像采集,视觉检测模块5采用双目视觉进行图像采集;通过Halbach磁场模块3的磁场控制,调控机器人的平衡角度及实现定位定向;本申请在壳体1的长度方向的侧边两端设置有凸起结构用于保持机器人的平衡,将壳体1的长度方向两端均设置为椭圆的不倒翁结构用于保持机器人的同方向定位或定向;将Halbach磁场模块3偏心设置在壳体内及将集成电路控制板4设置低于壳体1的质心位置,以便胶囊机器人的重力偏向于一边,通过结构性能结合Halbach磁场模块3的磁控实现持续方向定位,提高机器人的效率,姿态调整灵活,可适用于不同的工作环境。Referring to Figures 1 to 5, the tumbler capsule robot according to the embodiment of the present application includes: a shell 1. The shell 1 is arranged in the form of a cylinder with an opening at one end. The shell 1 is provided with protruding structures at both ends of the sides in the length direction. 7. The raised structure 7 is used to maintain the balance of the robot. Both ends of the housing 1 in the length direction are set as elliptical tumblers. The tumbler structure is used to maintain the positioning or orientation of the robot in the same direction. The shell is set as an elliptical tumbler. The structure is that the capsule robot has the mechanical characteristics of a tumbler structure; the Halbach magnetic field module 3 (Halbach-Hailbach) is set up to fit the inner wall of the shell 1, and the Halbach magnetic field module 3 is eccentrically set inside the shell 1; the integrated circuit control board 4, It is attached to the Halbach magnetic field module 3, and the integrated circuit control board 4 is set lower than the center of mass of the shell to form an eccentric structure; the visual detection module 5 is set on the integrated circuit control board 4 for image collection and visual inspection. Module 5 uses binocular vision to collect images; through the magnetic field control of Halbach magnetic field module 3, the robot's balance angle and positioning orientation are controlled; in this application, protruding structures are provided at both ends of the sides in the length direction of the housing 1 for To maintain the balance of the robot, both ends of the housing 1 in the length direction are set into elliptical tumbler structures to maintain the robot's positioning or orientation in the same direction; the Halbach magnetic field module 3 is eccentrically placed in the housing and the integrated circuit control board 4 is placed It is lower than the center of mass of the shell 1 so that the gravity of the capsule robot is biased to one side. Through the structural performance combined with the magnetic control of the Halbach magnetic field module 3, continuous directional positioning is achieved to improve the efficiency of the robot. The attitude adjustment is flexible and can be applied to different working environments. .
本申请提出一种新的不倒翁胶囊机器人,建立三维结构模型图,对胶囊机器人施加一个力,进行受力分析,保证设计符合单稳态结构,可以使其左右摇摆过后依然能保持稳定状态,同时结合磁控,实现精准控制。本申请主要解决胶囊机器人在肠道中,到达所要检查的地点后易发生转动翻滚的问题;解决胶囊机器人发挥其功能不充分的问题,以及控制磁控胶囊机器人的行进方向;可 以针对性的定向,对检查点可以始终保持同一个方向,且可适用于多种人体环境中。This application proposes a new tumbler capsule robot, establishes a three-dimensional structural model diagram, applies a force to the capsule robot, and conducts force analysis to ensure that the design conforms to a monostable structure, so that it can still maintain a stable state after swinging left and right, and at the same time Combined with magnetic control, precise control is achieved. This application mainly solves the problem that the capsule robot is easy to rotate and roll after arriving at the place to be inspected in the intestine; solves the problem of the capsule robot not fully exerting its functions, and controls the direction of travel of the magnetically controlled capsule robot; it can be oriented in a targeted manner, The checkpoints can always maintain the same direction and can be applied to a variety of human body environments.
机器人进入肠道后,通过外部设置的永磁体,形成一个新的环境磁场,进而控制胶囊内的Halbach磁场模块3的磁场发生改变,磁场的改变产生的力和扭矩使得机器人进行运动;另外,通过摄像头可以实时监测胶囊机器人在人体的具体位置,结合传回的图像,可以使其到达指定位置,或使机器人摇摆调整到指定状态;本申请的胶囊机器人的外壳结构是不倒翁结构,同时Halbach磁场模块位于胶囊底部,该结构可以使得胶囊机器人在外部磁场的控制下随时恢复到同一个竖直方向,因此可以针对性的定向,对检查点可以始终保持同一个方向。After the robot enters the intestine, a new environmental magnetic field is formed through the external permanent magnet, which controls the magnetic field of the Halbach magnetic field module 3 in the capsule to change. The force and torque generated by the change in the magnetic field make the robot move; in addition, through The camera can monitor the specific position of the capsule robot on the human body in real time, and combined with the returned image, can make it reach a designated position, or make the robot swing and adjust to a designated state; the shell structure of the capsule robot in this application is a tumbler structure, and the Halbach magnetic field module Located at the bottom of the capsule, this structure allows the capsule robot to return to the same vertical direction at any time under the control of an external magnetic field, so it can be oriented in a targeted manner and can always maintain the same direction for checkpoints.
与传统的水滴型不倒翁结构相比,本申请的不倒翁结构可以分为两个部分,壳体1部分与壳盖2部分,壳体1的开口一端连接有与壳体1配合的圆柱体壳盖2,该壳盖2的侧边设置为椭圆凸起8,壳盖2合盖在壳体1上,使得壳体1形成一封闭空腔的机外壳;壳体1部分类似于“平安锁”的结构;胶囊机器人的两端呈不倒翁结构,即壳盖2远离开口一端部分呈椭圆凸起8,所述壳体1远离开口一端呈椭圆凸起8,如图1所示;胶囊机器人的整体装配图,如图4所示,整体构成单稳态结构,在结构上优化了几何形状与静态平衡指之间的关系,保持单稳态状态;结构将一个完整的胶囊机器人设计成两个部分,便于将所需模块装入其中,在后续实验使用中,如果其中的模块发现问题,方便即时更换。Compared with the traditional water drop-shaped tumbler structure, the tumbler structure of the present application can be divided into two parts, the shell part 1 and the shell cover part 2. The open end of the shell 1 is connected to a cylindrical shell cover that matches the shell 1 2. The side of the cover 2 is set as an elliptical protrusion 8, and the cover 2 is closed on the housing 1, so that the housing 1 forms a machine casing with a closed cavity; the part of the housing 1 is similar to a "safety lock" The structure of the capsule robot is a tumbler structure, that is, the end of the shell cover 2 away from the opening is an elliptical protrusion 8, and the end of the shell 1 away from the opening is an elliptical protrusion 8, as shown in Figure 1; the overall capsule robot The assembly diagram, as shown in Figure 4, constitutes a monostable structure as a whole. The relationship between the geometric shape and the static balance finger is structurally optimized to maintain the monostable state. The structure designs a complete capsule robot into two parts. , it is convenient to install the required modules into it, and in subsequent experimental use, if any problem is found in the module, it can be replaced immediately.
实施例中,将控制所需Halbach磁场模块3与其他模块放入胶囊机器人结构中三维模型的建立;通过实验,找寻最佳的放置位置,将Halbach磁场模块3按照规律排列在不倒翁结构的底部,微型电池模块6的位置放入壳体1处, 集成电路控制板4与视觉检测模块5依次排列设置在Halbach磁场模块3上,完整的胶囊机器人的装配图,如图2和图4所示;后续添加新的控制模块或是其他功能模块,依然可以通过优化现有的不倒翁结构,实现持续的同方向定位。In the embodiment, the Halbach magnetic field module 3 and other modules required for control are put into the capsule robot structure to establish a three-dimensional model; through experiments, the best placement position is found, and the Halbach magnetic field module 3 is arranged at the bottom of the tumbler structure according to rules. The position of the micro battery module 6 is placed in the housing 1. The integrated circuit control board 4 and the visual detection module 5 are arranged in sequence on the Halbach magnetic field module 3. The assembly diagram of the complete capsule robot is shown in Figures 2 and 4; If new control modules or other functional modules are added later, the existing tumbler structure can still be optimized to achieve continuous positioning in the same direction.
机器人内结构的连接关系,不倒翁胶囊机器人总体长度为28mm,高度为15mm;壳盖2及壳体1的内径相等,内切圆直径设置为10-14,优选为12mm;视觉检测模块5设置为边长7-10mm的两个相等立方体,优选为长8mm的立方体,后续添加其他模块,均可以放置视觉检测模块5的区域进行优化;集成电路控制板4为8mm*25mm*2mm的长方体,位于Halbach磁场模块3上方;Halbach磁场模块3包括3-8个边长为2mm的依次排列连接的立方体,优选为,Halbach磁场模块3由5个边长为2mm的立方体构成。Regarding the connection relationship of the internal structure of the robot, the overall length of the tumbler capsule robot is 28mm and the height is 15mm; the inner diameters of the shell cover 2 and the shell 1 are equal, and the diameter of the inscribed circle is set to 10-14, preferably 12mm; the visual detection module 5 is set to Two equal cubes with a side length of 7-10mm, preferably a cube with a length of 8mm. If other modules are added later, the area of the visual detection module 5 can be placed for optimization; the integrated circuit control board 4 is a cuboid of 8mm*25mm*2mm, located at Above the Halbach magnetic field module 3; the Halbach magnetic field module 3 includes 3-8 cubes with a side length of 2 mm arranged and connected in sequence. Preferably, the Halbach magnetic field module 3 is composed of 5 cubes with a side length of 2 mm.
Halbach磁场模块3中的5个小立方体按照所设定的方向用胶进行粘黏,将集成电路控制板4与视觉检测模块5依次粘黏在Halbach磁场模块3上方;电池模块6位于壳盖2槽体内,使用双面胶进行粘贴;采用可充电的电容电池,电池模块6与集成电路控制板4之间通过导线连接;胶囊外壳使用3D打印技术打印而成,较为环保。The five small cubes in the Halbach magnetic field module 3 are glued in the set direction. The integrated circuit control board 4 and the visual detection module 5 are glued on top of the Halbach magnetic field module 3 in turn; the battery module 6 is located on the shell cover 2 Inside the tank, double-sided tape is used for pasting; a rechargeable capacitor battery is used, and the battery module 6 and the integrated circuit control board 4 are connected through wires; the capsule shell is printed using 3D printing technology, which is more environmentally friendly.
将Halbach磁场模块3与微型电池模块6放置在不同的位置,对不倒翁结构的胶囊机器人施加力,观察稳定情况;本申请的机器人可选择是否需要壳盖2,为了实现磁控持久有效,保证无论是否加壳盖2均不影响实现其不倒翁结构机器人的特点,优化有关不倒翁结构的设计,通过测试得出,以下三种情况均可以实现不倒翁结构的优势:(1)设置壳盖2与壳体1连接,(2)在壳盖2的槽体内设置电池模块6,(3)不设置壳盖2;如图3至图5所示。Place the Halbach magnetic field module 3 and the micro battery module 6 in different positions, apply force to the capsule robot with a tumbler structure, and observe the stability; the robot of this application can choose whether the shell cover 2 is needed. In order to achieve lasting and effective magnetic control, it ensures that no matter Whether or not the shell cover 2 is added does not affect the realization of the characteristics of the tumbler structure robot. Optimize the design of the tumbler structure. Through testing, it is concluded that the advantages of the tumbler structure can be achieved in the following three situations: (1) Setting the shell cover 2 and the shell 1 connection, (2) set the battery module 6 in the tank of the shell cover 2, (3) do not set the shell cover 2; as shown in Figures 3 to 5.
针对上述(1)中情况:将视觉检测模块5与集成电路控制板4以及Halbach磁场模块3依次布置于壳内,将壳盖2通过胶带与前面部分连接,如图3所示。For the situation in (1) above: arrange the visual detection module 5, the integrated circuit control board 4 and the Halbach magnetic field module 3 in sequence in the shell, and connect the shell cover 2 to the front part through tape, as shown in Figure 3.
针对上述(2)中情况:将微型电池置于后盖处,通过胶带与(1)中的前端部分相连,如图4所示。For the situation in (2) above: Place the micro battery on the back cover and connect it to the front part in (1) through tape, as shown in Figure 4.
针对上述(3)中情况:考虑到更换电池模块6以及位于熟悉环境中方便控制,仅将视觉检测模块5、集成电路控制板4及Halbach磁场模块3依次布置于壳内,也可以保证新型的不倒翁结构实现功能,如图5所示。For the situation in (3) above: considering the replacement of the battery module 6 and the convenience of control in a familiar environment, only the visual detection module 5, the integrated circuit control board 4 and the Halbach magnetic field module 3 are arranged in sequence in the shell, which can also ensure the new The tumbler structure implements the function, as shown in Figure 5.
除了必要的电源与磁控装置,后续我们还要添加其他装置,主要装在Halbach磁场模块3一侧。将配种简化为质点,当对胶囊机器人施加力的时候,重心会发生变化从而发生左右摇摆。将质点简化在配重的质心,但是处于摇摆情况的时候,质心在绕着底部中心旋转,主要将配重分配成两个部分,分别是电池模块6部分与磁场控制一侧的部分。In addition to the necessary power supply and magnetic control device, we will add other devices later, mainly installed on the Halbach magnetic field module 3 side. Simplifying the mating into a particle, when force is applied to the capsule robot, the center of gravity will change and sway left and right. The mass point is simplified to the center of mass of the counterweight, but when it is swinging, the center of mass rotates around the center of the bottom. The counterweight is mainly divided into two parts, namely the battery module 6 part and the part on the magnetic field control side.
下面对胶囊机器人的进行受力分析:The following is a force analysis of the capsule robot:
(1)对胶囊机器人的视觉检测模块5与磁场控制模块进行受力分析:(1) Perform force analysis on the visual detection module 5 and magnetic field control module of the capsule robot:
当胶囊机器人受力时,使胶囊机器人发生摇摆,取不倒翁结构的胶囊机器人的侧视图作为示意图进行表示;胶囊机器人的外壳相对于配重来说可以忽略不计;设Halbach磁场模块3一侧整体的配重质心为O,半径为R,质量为M,重力为G,设配重O到圆心距离为r,机器人的外壳与平台接触点为A,对机器人施加力后,转动θ角,接触点为A 1;施加力度前后,示意图如图6和图7所示。 When the capsule robot is stressed, it causes the capsule robot to swing. Take the side view of the capsule robot with a tumbler structure as a schematic diagram; the outer shell of the capsule robot can be ignored relative to the counterweight; assume that the overall Halbach magnetic field module 3 side The center of mass of the counterweight is O, the radius is R, the mass is M, and the gravity is G. Let the distance from the counterweight O to the center of the circle be r, and the contact point between the robot's shell and the platform be A. After applying force to the robot, it rotates at an angle θ, and the contact point is A 1 ; before and after applying force, the schematic diagram is shown in Figure 6 and Figure 7.
这一部分的分配几乎是不倒翁结构的胶囊机器人全部,类似于对整个整体的分析;当施加外力F后,整体配重的重力G的作用线偏离原来的支点A,从而对支点产生力矩M 2,设原来的力矩为M 1;由于不倒翁倾斜的角度不断增大,重力作用线的偏移量随之增大,力矩M 2也随之增大,最终实现和外力力矩的平衡。 The distribution of this part is almost the entire capsule robot with a tumbler structure, which is similar to the analysis of the entire whole; when an external force F is applied, the line of action of the gravity G of the overall counterweight deviates from the original fulcrum A, thus generating a moment M 2 on the fulcrum, Suppose the original moment is M 1 ; as the tilt angle of the tumbler continues to increase, the offset of the line of gravity increases, and the moment M 2 also increases, finally achieving a balance with the external force moment.
原接触点A与现接触点A 1的距离为Rθ,配重O相对于原来的接触点A的位置矢量可表示为: The distance between the original contact point A and the current contact point A 1 is Rθ, and the position vector of the counterweight O relative to the original contact point A can be expressed as:
d=(Rθ±rsinθ)i+(R±rcosθ)jd=(Rθ±rsinθ)i+(R±rcosθ)j
当受到外力F,胶囊机器人其自身的配重形成的力矩M 2抵抗外力,两个力矩的方向相反,当两者相等的时候,达到动态平衡;后续随着F的持续减少,逐渐趋于0,此时只存在力矩M 2;依靠力矩M 2使得胶囊机器人回到原始的平衡点,即重力与支持力平衡;外力F作用的力臂,设为l 1;配重的重力作用的力臂相当于点O到A 1的距离,设为l 2;机器人受力后,重心O变化,导致l 2也随之变化;M 1,M 2的方程式,表示如下: When the capsule robot is subjected to an external force F, the moment M 2 formed by its own counterweight resists the external force. The two moments are in opposite directions. When they are equal, a dynamic balance is achieved; subsequently, as F continues to decrease, it gradually approaches 0. , only the moment M 2 exists at this time; relying on the moment M 2 makes the capsule robot return to the original equilibrium point, that is, the balance between gravity and supporting force; the moment arm acted by the external force F is set to l 1 ; the moment arm acted by the gravity of the counterweight Equivalent to the distance from point O to A 1 , set to l 2 ; after the robot is stressed, the center of gravity O changes, causing l 2 to also change; the equations of M 1 and M 2 are expressed as follows:
M 1=F*l 1M 2=Gcosθ*l 2 M 1 =F*l 1 M 2 =Gcosθ*l 2
M 1,M 2的关系:当M 1=M 2=0时,处于初始位置,随后当M 1逐渐增大,且M 1>M 2时,发生摇摆,没有达到临界值;当M 1=M 2时,达到动态平衡;随着外力F减少,M 1<M 2时,往回摆动,最后达到原始的静态平衡。 The relationship between M 1 and M 2 : when M 1 =M 2 =0, it is in the initial position, and then when M 1 gradually increases, and M 1 > M 2 , a swing occurs and does not reach the critical value; when M 1 = When M 2 , dynamic equilibrium is reached; as the external force F decreases, when M 1 < M 2 , it swings back, and finally reaches the original static equilibrium.
在摇摆过程中,配重的质心O旋转,可能会在内切圆心的上方或是下方,正号表示位于圆心上方,负号表示在下方。During the swing process, the center of mass O of the counterweight rotates and may be above or below the center of the inscribed circle. The positive sign means it is above the center of the circle, and the negative sign means it is below.
因此,位于圆心的上方或是下方系统势能函数分别为:Therefore, the potential energy functions of the system above or below the center of the circle are:
Figure PCTCN2022139557-appb-000001
Figure PCTCN2022139557-appb-000001
Figure PCTCN2022139557-appb-000002
Figure PCTCN2022139557-appb-000002
根据机械能守恒定理有:According to the principle of conservation of mechanical energy:
Figure PCTCN2022139557-appb-000003
Figure PCTCN2022139557-appb-000003
根据上述方程式,可以得到相关参数。主要是反应了θ变化时,胶囊机器人的运动;当配重的质心分别位于圆心上方和下方的时候是两种不同的情况:(1)位于上方时,当θ=0的时候,势能取极大值,当θ增大时,势能减少; 为了符合机械能守恒定律,动能增加,θ从等于零开始发生偏转后将持续偏转;(2)位于下方时,当θ=0的时候,势能取极小值,当θ增大时,势能也随之增大。想要符合机械能守恒定律,所以动能要减少,所以θ从等于零开始发生偏转后到达静止,再向着θ等于零的方向返回。系统当θ=0的时候是最稳定的平衡点。According to the above equation, the relevant parameters can be obtained. It mainly reflects the movement of the capsule robot when θ changes; when the center of mass of the counterweight is located above and below the center of the circle, there are two different situations: (1) When it is located above, when θ = 0, the potential energy takes the pole. Large value, when θ increases, the potential energy decreases; in order to comply with the law of conservation of mechanical energy, the kinetic energy increases, and θ will continue to deflect after it starts to deflect from zero; (2) When it is located below, when θ = 0, the potential energy takes the minimum value, when θ increases, the potential energy also increases. In order to comply with the law of conservation of mechanical energy, the kinetic energy needs to be reduced, so θ starts to deflect from zero, reaches rest, and then returns to the direction where θ is equal to zero. The system is the most stable equilibrium point when θ=0.
(2)对胶囊机器人电池模块6部分进行分析以及总结:(2) Analyze and summarize the 6 parts of the capsule robot battery module:
针对只有电池模块6部分进行分析,当对机器人施加一个外力F后,机器人处于摇摆情况的时,质心在绕着底部中心旋转,电池模块6对于整体的配重来说是重力分量,在左右摇摆的过程中,将电池模块6的重力Ga沿着转动轴的变化方向,一个沿着切线方向设为Fc,一个沿着胶囊机器人的方向设为Fb;设OA为胶囊机器人的原始位置,转过θ角到达OA 1的位置,此时将电池模块6简化为质点,处于OA 1的端点处;示意图如下图8所示,受力如下公式表示: For the analysis of only the battery module 6, when an external force F is applied to the robot and the robot is in a rocking state, the center of mass rotates around the center of the bottom. The battery module 6 is the gravitational component of the overall counterweight, swinging left and right. In the process, set the changing directions of the gravity Ga of the battery module 6 along the rotation axis, one along the tangent direction as Fc, and the other along the direction of the capsule robot as Fb; let OA be the original position of the capsule robot, rotate The angle θ reaches the position of OA 1. At this time, the battery module 6 is simplified into a particle, which is at the end point of OA 1. The schematic diagram is shown in Figure 8 below, and the force is expressed by the following formula:
F b=G a cosθ
Figure PCTCN2022139557-appb-000004
F b =G a cosθ
Figure PCTCN2022139557-appb-000004
在摇摆过程中,摇摆的幅度取决于配重的大小,电池模块6的质量相比较其他部分的质量较轻,所以电池模块6对于摇摆的幅度影响不大;电池模块6不影响整个胶囊机器人的运动。During the swinging process, the amplitude of the swing depends on the size of the counterweight. The mass of the battery module 6 is lighter than the mass of other parts, so the battery module 6 has little effect on the amplitude of the swing; the battery module 6 does not affect the stability of the entire capsule robot. sports.
整个部分符合动能定理以及机械能守恒,需要考虑到势能;设外力摇摆过的高度为h,外力F与Ga的关系可以表示为:The entire part complies with the kinetic energy theorem and the conservation of mechanical energy, and potential energy needs to be taken into account; assuming that the height of the external force swing is h, the relationship between the external force F and Ga can be expressed as:
Figure PCTCN2022139557-appb-000005
Figure PCTCN2022139557-appb-000005
针对整体的新型的胶囊机器人,施加外力F后,两部分的配重的质心相对于底部中心做旋转运动,这两部分的综合运动运用转动惯量可以进行更直观的描述;设视觉检测和磁场控制模块的质心偏转角度为α,电池模块6部分的质心偏转角度为β;二者同时运动,设完整的胶囊机器人的加速度为ω,J为转 动惯量。其中ω与α,β的关系如下:For the overall new capsule robot, after an external force F is applied, the center of mass of the two parts of the counterweight rotates relative to the center of the bottom. The comprehensive motion of the two parts can be described more intuitively using the moment of inertia; assuming visual detection and magnetic field control The deflection angle of the center of mass of the module is α, and the deflection angle of the center of mass of the 6-part battery module is β; both move at the same time. Suppose the acceleration of the complete capsule robot is ω and J is the moment of inertia. The relationship between ω, α, and β is as follows:
Figure PCTCN2022139557-appb-000006
Figure PCTCN2022139557-appb-000006
摆动动能Et可表示为:
Figure PCTCN2022139557-appb-000007
将三个轴的投影分量带入,可以看出摆动的动能符合叠加原理,同时符合机械能守恒以及动能守恒。
The swing kinetic energy Et can be expressed as:
Figure PCTCN2022139557-appb-000007
Bringing in the projection components of the three axes, it can be seen that the kinetic energy of the swing conforms to the superposition principle, as well as the conservation of mechanical energy and the conservation of kinetic energy.
现有的胶囊机器人的控制方式基本依靠人为,定位定点定向的实施检测和对病灶点的拍照取样,基本是由人工控制机器人,大部分基于经验到达定位点,在这个过程中很难保持针对所需检测的方向不变,所以无法保证人工调试时的始终维持一种状态;针对病灶的检测,实现持续同方向定位较为困难,使得现有的胶囊机器人的工作效率较低。The existing control method of capsule robots basically relies on humans. The robot is basically controlled by humans to perform positioning and orientation detection and take pictures and samples of the lesion points. Most of the capsule robots reach the positioning points based on experience. In this process, it is difficult to maintain the targeted positioning. The direction to be detected does not change, so it is impossible to guarantee that the state will always be maintained during manual debugging; for the detection of lesions, it is difficult to achieve continuous positioning in the same direction, making the existing capsule robots less efficient.
针对上述问题,本申请从理论力学出发对不倒翁结构进行受力分析,得到胶囊机器人;结合磁控可以实时根据胶囊机器人的状态调整控制角度,通过控制Halbach磁场模块3可以实现适用于不同环境中,本申请在人体环境中可定点定位检查的新型的不倒翁胶囊机器人,相比于其他胶囊机器人,可以只通过结构性能实现持续的同方向定位,极大的提高了胶囊机器人的工作效率。In response to the above problems, this application conducts a stress analysis on the tumbler structure based on theoretical mechanics to obtain a capsule robot; combined with magnetic control, the control angle can be adjusted in real time according to the state of the capsule robot. By controlling the Halbach magnetic field module 3, it can be applied in different environments. This application applies to a new type of tumbler capsule robot that can perform fixed-point positioning and inspection in the human environment. Compared with other capsule robots, it can achieve continuous positioning in the same direction only through structural performance, which greatly improves the working efficiency of the capsule robot.
本申请的有益效果在于:The beneficial effects of this application are:
1.现有的胶囊机器人没有将机器人定点定向,持续保持一个方向行进作为研究的重点,因此胶囊机器人发挥其功能的有效性与精准度都较低;本申请是一种在人体环境中,可以只通过结构性能实现持续同方向定位,直达病灶,提高了胶囊机器人的工作效率,且操作相比较于其他胶囊机器人更加方便简单,使其应用更加具有广泛性;例如,在胃肠道中可定点定位检查的不倒翁结构的胶囊机器人。1. The existing capsule robot does not orient the robot at a fixed point, and continuously maintains one direction as the focus of research. Therefore, the effectiveness and accuracy of the capsule robot's function are low; this application is a method that can be used in the human environment. Only through structural performance, continuous positioning in the same direction can be achieved, directly reaching the lesion, which improves the working efficiency of the capsule robot. Compared with other capsule robots, the operation is more convenient and simple, making its application more widespread; for example, it can be positioned at fixed points in the gastrointestinal tract. Examination of the tumbler structure of the capsule robot.
2.现有的大部分的胶囊机器人建立的动力学模型在满足于能量守恒定理的条件下,不考虑配重建立动力学模型;本申请的不倒翁结构的胶囊机器人,考虑控制部分附加所需的Halbach磁场模块3后的重量,以及其他部分,包括集成电路控制板4,视觉检测模块5以及微型电源,进而对整个胶囊机器人进行受力分析,建立力学模型,使定位更精确。2. Most of the existing dynamic models established by capsule robots do not consider counterweights when establishing dynamic models that satisfy the principle of conservation of energy. The capsule robot with a tumbler structure in this application considers additional components required for the control part. The weight behind the Halbach magnetic field module 3, as well as other parts, including the integrated circuit control board 4, the visual detection module 5 and the micro power supply, are then used to analyze the force of the entire capsule robot and establish a mechanical model to make the positioning more accurate.
3.姿态调整灵活,针对现有的胶囊机器人行动位置变化多变,本申请控制操作灵活,可以实现胶囊机器人的姿态按照设定随意调整,且确定好位置后,能够快速且稳定的实现定位定向。3. Flexible posture adjustment. In view of the changing action positions of existing capsule robots, the control operation of this application is flexible, which can realize that the posture of the capsule robot can be adjusted at will according to the settings, and after the position is determined, the positioning and orientation can be quickly and stably realized. .
4.可适用于不同的工作环境,目前大部分的胶囊机器人的适用对象比较具有针对性,适合胃部检查的,与肠道检查适配度不高;本申请由于控制装置微型且采用不倒翁结构,不倒翁外壳结构运用环保材料结合3D打印技术进行制作,整体体积小,质量轻,且表面光滑,通过控制Halbach磁场模块3可以实现适用于不同环境中。4. It can be applied to different working environments. At present, most capsule robots are more targeted and suitable for gastric examination, but are not well suited for intestinal examination. In this application, the control device is micro and adopts a tumbler structure. , the tumbler shell structure is made of environmentally friendly materials combined with 3D printing technology. The overall size is small, light in weight, and the surface is smooth. By controlling the Halbach magnetic field module 3, it can be suitable for different environments.
本申请已经过实验验证,验证了提出结构的可行性与稳定性,可以提高胶囊机器人针对病灶点,定点定位定向的准确性。提升胶囊机器人的工作效率。This application has been experimentally verified, verifying the feasibility and stability of the proposed structure, which can improve the accuracy of capsule robot's positioning and orientation for focus points. Improve the working efficiency of capsule robots.
对所公开的实施例的上述说明,使本领域专业技术人员能够实现或使用本申请。对这些实施例的多种修改对本领域的专业技术人员来说将是显而易见的,本文中所定义的一般原理可以在不脱离本申请的精神或范围的情况下,在其它实施例中实现。因此,本申请将不会被限制于本文所示的这些实施例,而是要符合与本文所公开的原理和新颖特点相一致的最宽的范围。The above description of the disclosed embodiments enables those skilled in the art to implement or use the present application. Various modifications to these embodiments will be readily apparent to those skilled in the art, and the generic principles defined herein may be practiced in other embodiments without departing from the spirit or scope of the application. Therefore, the present application is not to be limited to the embodiments shown herein but is to be accorded the widest scope consistent with the principles and novel features disclosed herein.

Claims (10)

  1. 一种不倒翁胶囊机器人,其特征在于,包括:A tumbler capsule robot is characterized by including:
    壳体,所述壳体呈一端为开口的圆柱体设置,所述壳体的长度方向的侧边两端设置有凸起结构,所述凸起结构用于保持所述机器人的平衡;所述壳体的长度方向两端均设置为椭圆,所述壳体的开口一端连接有与所述壳体配合的圆柱体壳盖,所述壳体与壳盖构成封闭的不倒翁结构,所述不倒翁结构用于保持所述机器人的同方向定位或定向;The housing is arranged in the form of a cylinder with one end open, and raised structures are provided at both ends of the sides in the length direction of the housing, and the raised structures are used to maintain the balance of the robot; Both ends of the housing in the length direction are configured as ellipses. One end of the opening of the housing is connected to a cylindrical shell cover that matches the housing. The housing and the shell cover form a closed tumbler structure. The tumbler structure For maintaining the positioning or orientation of the robot in the same direction;
    Halbach磁场模块,贴合所述壳体内壁设置,所述Halbach磁场模块偏心设置在所述壳体内;The Halbach magnetic field module is arranged to fit the inner wall of the housing, and the Halbach magnetic field module is eccentrically arranged in the housing;
    集成电路控制板,贴设在所述Halbach磁场模块上,所述集成电路控制板设置低于所述壳体的质心位置,以构成偏心结构;An integrated circuit control board is attached to the Halbach magnetic field module, and the integrated circuit control board is set lower than the center of mass of the housing to form an eccentric structure;
    视觉检测模块,设置在所述集成电路控制板上,用于进行图像采集,所述视觉检测模块采用双目视觉进行图像采集;A visual detection module is provided on the integrated circuit control board and is used for image collection. The visual detection module uses binocular vision for image collection;
    通过所述集成电路控制板低于所述壳体的质心位置、壳体两端的椭圆结构设置,整体构成的不倒翁结构设置及Halbach磁场模块的磁场控制调控所述机器人的平衡角度及实现定位定向。Through the position of the integrated circuit control board lower than the center of mass of the housing, the elliptical structure at both ends of the housing, the overall tumbler structure and the magnetic field control of the Halbach magnetic field module, the balance angle of the robot is controlled and the positioning and orientation are achieved.
  2. 根据权利要求1所述的不倒翁胶囊机器人,其特征在于,所述壳盖中心部分为凸起结构,壳体下半部分为圆弧结构,所述圆弧的圆心位置与胶囊的质心位置不重合,且在重力方向远低于质心位置,所述壳盖合盖在所述壳体上,使得所述壳体形成一封闭空腔的机外壳。The tumbler capsule robot according to claim 1, characterized in that the center part of the shell cover has a convex structure, the lower part of the shell has an arc structure, and the center position of the arc does not coincide with the center of mass position of the capsule. , and in the direction of gravity far below the center of mass, the shell cover is closed on the shell, so that the shell forms a machine shell that closes the cavity.
  3. 根据权利要求2所述的不倒翁胶囊机器人,其特征在于,所述壳盖呈槽体。The tumbler capsule robot according to claim 2, wherein the shell cover is in the form of a tank.
  4. 根据权利要求3所述的不倒翁胶囊机器人,其特征在于,所述壳盖的槽体 内设置有电池模块,所述电池模块与所述集成电路控制板电连接。The tumbler capsule robot according to claim 3, characterized in that a battery module is provided in the tank of the shell cover, and the battery module is electrically connected to the integrated circuit control board.
  5. 根据权利要求3所述的不倒翁胶囊机器人,其特征在于,所述壳盖远离壳体一端呈凸起状。The tumbler capsule robot according to claim 3, wherein the end of the shell cover away from the shell is convex.
  6. 根据权利要求1所述的不倒翁胶囊机器人,其特征在于,所述壳体远离开口一端呈凸起状。The tumbler capsule robot according to claim 1, wherein the end of the housing away from the opening is convex.
  7. 根据权利要求1所述的不倒翁胶囊机器人,其特征在于,所述Halbach磁场模块、所述视觉检测模块及所述集成电路控制板之间的连接通过胶粘连接。The tumbler capsule robot according to claim 1, wherein the Halbach magnetic field module, the visual detection module and the integrated circuit control board are connected by adhesive connection.
  8. 根据权利要求2所述的不倒翁胶囊机器人,其特征在于,所述机外壳的长度为28mm,高位15mm。The tumbler capsule robot according to claim 2, characterized in that the length of the housing is 28 mm and the height is 15 mm.
  9. 根据权利要求2所述的不倒翁胶囊机器人,其特征在于,所述壳体及所述壳盖的内直径为12mm,所述集成电路控制板为8mm*25mm*2mm的长方体,所述视觉检测模块为两个边长7-10mm的立方体。The tumbler capsule robot according to claim 2, wherein the inner diameter of the housing and the shell cover is 12mm, the integrated circuit control board is a cuboid of 8mm*25mm*2mm, and the visual detection module It is two cubes with side lengths of 7-10mm.
  10. 根据权利要求2所述的不倒翁胶囊机器人,其特征在于,所述Halbach磁场模块包括3-8个边长为2mm的依次排列连接的立方体。The tumbler capsule robot according to claim 2, wherein the Halbach magnetic field module includes 3-8 cubes with side lengths of 2 mm arranged and connected in sequence.
PCT/CN2022/139557 2022-06-09 2022-12-16 Wobble doll-like capsule robot WO2023236492A1 (en)

Applications Claiming Priority (2)

Application Number Priority Date Filing Date Title
CN202210643316.7A CN115054181A (en) 2022-06-09 2022-06-09 Tumbler capsule robot
CN202210643316.7 2022-06-09

Publications (1)

Publication Number Publication Date
WO2023236492A1 true WO2023236492A1 (en) 2023-12-14

Family

ID=83199499

Family Applications (1)

Application Number Title Priority Date Filing Date
PCT/CN2022/139557 WO2023236492A1 (en) 2022-06-09 2022-12-16 Wobble doll-like capsule robot

Country Status (2)

Country Link
CN (1) CN115054181A (en)
WO (1) WO2023236492A1 (en)

Families Citing this family (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN115054181A (en) * 2022-06-09 2022-09-16 中国科学院深圳先进技术研究院 Tumbler capsule robot

Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
DE102006052801A1 (en) * 2006-11-09 2008-05-29 Siemens Ag Completely or partially reutilizable, magnetic navigatable endoscope-capsule for hollow organ of subject i.e. gastrointestinal tract of patient i.e. human, has separating device disconnecting capsule housing at reference-disconnecting point
CN101573070A (en) * 2006-12-28 2009-11-04 奥林巴斯医疗株式会社 Capsule medical apparatus and body-cavity observation method
CN201929933U (en) * 2010-12-22 2011-08-17 辽宁金泰克医疗有限公司 Wireless video image digestive tract calabash-shaped capsule type inspectoscope
CN104983385A (en) * 2015-05-21 2015-10-21 大连理工大学 Active and passive dual-hemispheroid capsule robot and posture adjustment and turning drive control method thereof
EP2995240A1 (en) * 2014-09-15 2016-03-16 Ankon Medical Technologie (Shanghai) Co., Ltd Apparatus and method for controlling the movement of a capsule endoscope in the digestive tract of a human body
CN115054181A (en) * 2022-06-09 2022-09-16 中国科学院深圳先进技术研究院 Tumbler capsule robot

Patent Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
DE102006052801A1 (en) * 2006-11-09 2008-05-29 Siemens Ag Completely or partially reutilizable, magnetic navigatable endoscope-capsule for hollow organ of subject i.e. gastrointestinal tract of patient i.e. human, has separating device disconnecting capsule housing at reference-disconnecting point
CN101573070A (en) * 2006-12-28 2009-11-04 奥林巴斯医疗株式会社 Capsule medical apparatus and body-cavity observation method
CN201929933U (en) * 2010-12-22 2011-08-17 辽宁金泰克医疗有限公司 Wireless video image digestive tract calabash-shaped capsule type inspectoscope
EP2995240A1 (en) * 2014-09-15 2016-03-16 Ankon Medical Technologie (Shanghai) Co., Ltd Apparatus and method for controlling the movement of a capsule endoscope in the digestive tract of a human body
CN104983385A (en) * 2015-05-21 2015-10-21 大连理工大学 Active and passive dual-hemispheroid capsule robot and posture adjustment and turning drive control method thereof
CN115054181A (en) * 2022-06-09 2022-09-16 中国科学院深圳先进技术研究院 Tumbler capsule robot

Also Published As

Publication number Publication date
CN115054181A (en) 2022-09-16

Similar Documents

Publication Publication Date Title
US10076234B2 (en) Apparatus and method for controlling movement of a capsule endoscope in digestive tract of a human body
EP3539456B1 (en) Apparatus for controlling the movement of a capsule endoscope in the digestive tract of a human body
Wang et al. An earthworm-like robotic endoscope system for human intestine: design, analysis, and experiment
WO2023236492A1 (en) Wobble doll-like capsule robot
US7697970B2 (en) Medical apparatus, medical apparatus guide system, capsule type medical apparatus, and capsule type medical apparatus guide apparatus
JP3662072B2 (en) Medical capsule device
CN105411505B (en) A kind of device and method that control capsule endoscope is moved in human body alimentary canal
CN201855252U (en) Capsule endoscope
CN109998457B (en) Active and passive double-hemisphere high-integration capsule robot capable of wirelessly transmitting images
BRPI1100715A2 (en) capsule endoscope, endoscope device and method of correcting the position of a capsule endoscope
CN110809426B (en) Capsule endoscope control system
Chen et al. Magnetically actuated capsule robots: A review
CN102048517A (en) Screw-type active-thrust capsule-like robot
CN103393389B (en) Endoscope microcapsule robot
CN201912084U (en) Screw active propulsion capsule-like robot
CN110269580A (en) Robot system is peeped in a kind of micro radio
WO2021129221A1 (en) Magnetic spiral capsule endoscope, magnetic spiral capsule endoscope control system and control method therefor
JP4331781B2 (en) Medical capsule device
CN215534201U (en) Capsule endoscope with vertical chain mark
WO2024050882A1 (en) Omnidirectional observation under-actuated capsule robot and axial flip magnetic control operation method therefor
CN111631669A (en) Capsule type endoscope driving device based on three-dimensional orthogonal magnetic field and control method
Zhang et al. Design and implementation of a highly integrated dual hemisphere capsule robot
CN203388828U (en) Control system for running state of capsule endoscope in body
CN209808307U (en) Gastrointestinal machine illumination structure
CN115316918B (en) Omnidirectional under-actuated capsule robot and axis overturning magnetic control operation method thereof

Legal Events

Date Code Title Description
121 Ep: the epo has been informed by wipo that ep was designated in this application

Ref document number: 22945620

Country of ref document: EP

Kind code of ref document: A1