CN112180736A - 基于双闭环三维路径跟踪的微机器人磁驱装置和控制方法 - Google Patents
基于双闭环三维路径跟踪的微机器人磁驱装置和控制方法 Download PDFInfo
- Publication number
- CN112180736A CN112180736A CN202011118436.2A CN202011118436A CN112180736A CN 112180736 A CN112180736 A CN 112180736A CN 202011118436 A CN202011118436 A CN 202011118436A CN 112180736 A CN112180736 A CN 112180736A
- Authority
- CN
- China
- Prior art keywords
- robot
- micro
- loop
- magnetic
- magnetic field
- 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.)
- Granted
Links
- 238000000034 method Methods 0.000 title claims abstract description 25
- XEEYBQQBJWHFJM-UHFFFAOYSA-N Iron Chemical group [Fe] XEEYBQQBJWHFJM-UHFFFAOYSA-N 0.000 claims description 37
- 239000000523 sample Substances 0.000 claims description 34
- 230000005389 magnetism Effects 0.000 claims description 12
- 239000011159 matrix material Substances 0.000 claims description 9
- 238000012545 processing Methods 0.000 claims description 4
- 230000009471 action Effects 0.000 claims description 3
- 238000006243 chemical reaction Methods 0.000 claims description 3
- 230000004907 flux Effects 0.000 claims description 3
- 230000005484 gravity Effects 0.000 claims description 3
- 238000013507 mapping Methods 0.000 claims description 3
- 239000000463 material Substances 0.000 claims description 3
- 230000009466 transformation Effects 0.000 claims description 3
- 238000013519 translation Methods 0.000 claims description 3
- 238000005452 bending Methods 0.000 claims description 2
- 230000009977 dual effect Effects 0.000 claims 4
- 238000010586 diagram Methods 0.000 description 6
- 230000004044 response Effects 0.000 description 4
- 230000001174 ascending effect Effects 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000013461 design Methods 0.000 description 1
- 239000003814 drug Substances 0.000 description 1
- 229940079593 drug Drugs 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 230000000007 visual effect Effects 0.000 description 1
Images
Classifications
-
- A—HUMAN NECESSITIES
- A61—MEDICAL OR VETERINARY SCIENCE; HYGIENE
- A61B—DIAGNOSIS; SURGERY; IDENTIFICATION
- A61B1/00—Instruments for performing medical examinations of the interior of cavities or tubes of the body by visual or photographical inspection, e.g. endoscopes; Illuminating arrangements therefor
- A61B1/04—Instruments for performing medical examinations of the interior of cavities or tubes of the body by visual or photographical inspection, e.g. endoscopes; Illuminating arrangements therefor combined with photographic or television appliances
- A61B1/041—Capsule endoscopes for imaging
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/10—Programme-controlled manipulators characterised by positioning means for manipulator elements
- B25J9/12—Programme-controlled manipulators characterised by positioning means for manipulator elements electric
- B25J9/126—Rotary actuators
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B13/00—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion
- G05B13/02—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric
- G05B13/04—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators
- G05B13/042—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators in which a parameter or coefficient is automatically adjusted to optimise the performance
-
- A—HUMAN NECESSITIES
- A61—MEDICAL OR VETERINARY SCIENCE; HYGIENE
- A61B—DIAGNOSIS; SURGERY; IDENTIFICATION
- A61B1/00—Instruments for performing medical examinations of the interior of cavities or tubes of the body by visual or photographical inspection, e.g. endoscopes; Illuminating arrangements therefor
- A61B1/00002—Operational features of endoscopes
- A61B1/00004—Operational features of endoscopes characterised by electronic signal processing
- A61B1/00006—Operational features of endoscopes characterised by electronic signal processing of control signals
-
- A—HUMAN NECESSITIES
- A61—MEDICAL OR VETERINARY SCIENCE; HYGIENE
- A61B—DIAGNOSIS; SURGERY; IDENTIFICATION
- A61B1/00—Instruments for performing medical examinations of the interior of cavities or tubes of the body by visual or photographical inspection, e.g. endoscopes; Illuminating arrangements therefor
- A61B1/00147—Holding or positioning arrangements
- A61B1/00158—Holding or positioning arrangements using magnetic field
-
- A—HUMAN NECESSITIES
- A61—MEDICAL OR VETERINARY SCIENCE; HYGIENE
- A61B—DIAGNOSIS; SURGERY; IDENTIFICATION
- A61B34/00—Computer-aided surgery; Manipulators or robots specially adapted for use in surgery
- A61B34/20—Surgical navigation systems; Devices for tracking or guiding surgical instruments, e.g. for frameless stereotaxis
-
- A—HUMAN NECESSITIES
- A61—MEDICAL OR VETERINARY SCIENCE; HYGIENE
- A61B—DIAGNOSIS; SURGERY; IDENTIFICATION
- A61B34/00—Computer-aided surgery; Manipulators or robots specially adapted for use in surgery
- A61B34/70—Manipulators specially adapted for use in surgery
- A61B34/72—Micromanipulators
-
- A—HUMAN NECESSITIES
- A61—MEDICAL OR VETERINARY SCIENCE; HYGIENE
- A61B—DIAGNOSIS; SURGERY; IDENTIFICATION
- A61B34/00—Computer-aided surgery; Manipulators or robots specially adapted for use in surgery
- A61B34/70—Manipulators specially adapted for use in surgery
- A61B34/73—Manipulators for magnetic surgery
-
- A—HUMAN NECESSITIES
- A61—MEDICAL OR VETERINARY SCIENCE; HYGIENE
- A61B—DIAGNOSIS; SURGERY; IDENTIFICATION
- A61B5/00—Measuring for diagnostic purposes; Identification of persons
- A61B5/06—Devices, other than using radiation, for detecting or locating foreign bodies ; determining position of probes within or on the body of the patient
- A61B5/061—Determining position of a probe within the body employing means separate from the probe, e.g. sensing internal probe position employing impedance electrodes on the surface of the body
- A61B5/062—Determining position of a probe within the body employing means separate from the probe, e.g. sensing internal probe position employing impedance electrodes on the surface of the body using magnetic field
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J7/00—Micromanipulators
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1602—Programme controls characterised by the control system, structure, architecture
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1656—Programme controls characterised by programming, planning systems for manipulators
- B25J9/1664—Programme controls characterised by programming, planning systems for manipulators characterised by motion, path, trajectory planning
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1694—Programme controls characterised by use of sensors other than normal servo-feedback from position, speed or acceleration sensors, perception control, multi-sensor controlled systems, sensor fusion
- B25J9/1697—Vision controlled systems
-
- H—ELECTRICITY
- H02—GENERATION; CONVERSION OR DISTRIBUTION OF ELECTRIC POWER
- H02P—CONTROL OR REGULATION OF ELECTRIC MOTORS, ELECTRIC GENERATORS OR DYNAMO-ELECTRIC CONVERTERS; CONTROLLING TRANSFORMERS, REACTORS OR CHOKE COILS
- H02P27/00—Arrangements or methods for the control of AC motors characterised by the kind of supply voltage
- H02P27/04—Arrangements or methods for the control of AC motors characterised by the kind of supply voltage using variable-frequency supply voltage, e.g. inverter or converter supply voltage
- H02P27/06—Arrangements or methods for the control of AC motors characterised by the kind of supply voltage using variable-frequency supply voltage, e.g. inverter or converter supply voltage using dc to ac converters or inverters
- H02P27/08—Arrangements or methods for the control of AC motors characterised by the kind of supply voltage using variable-frequency supply voltage, e.g. inverter or converter supply voltage using dc to ac converters or inverters with pulse width modulation
-
- A—HUMAN NECESSITIES
- A61—MEDICAL OR VETERINARY SCIENCE; HYGIENE
- A61B—DIAGNOSIS; SURGERY; IDENTIFICATION
- A61B17/00—Surgical instruments, devices or methods, e.g. tourniquets
- A61B17/00234—Surgical instruments, devices or methods, e.g. tourniquets for minimally invasive surgery
- A61B2017/00345—Micromachines, nanomachines, microsystems
-
- A—HUMAN NECESSITIES
- A61—MEDICAL OR VETERINARY SCIENCE; HYGIENE
- A61B—DIAGNOSIS; SURGERY; IDENTIFICATION
- A61B34/00—Computer-aided surgery; Manipulators or robots specially adapted for use in surgery
- A61B34/20—Surgical navigation systems; Devices for tracking or guiding surgical instruments, e.g. for frameless stereotaxis
- A61B2034/2046—Tracking techniques
- A61B2034/2065—Tracking using image or pattern recognition
Landscapes
- Engineering & Computer Science (AREA)
- Health & Medical Sciences (AREA)
- Life Sciences & Earth Sciences (AREA)
- Surgery (AREA)
- Robotics (AREA)
- Medical Informatics (AREA)
- Public Health (AREA)
- Biomedical Technology (AREA)
- Heart & Thoracic Surgery (AREA)
- Mechanical Engineering (AREA)
- Molecular Biology (AREA)
- Animal Behavior & Ethology (AREA)
- General Health & Medical Sciences (AREA)
- Veterinary Medicine (AREA)
- Nuclear Medicine, Radiotherapy & Molecular Imaging (AREA)
- Physics & Mathematics (AREA)
- Pathology (AREA)
- Biophysics (AREA)
- Radiology & Medical Imaging (AREA)
- Optics & Photonics (AREA)
- Automation & Control Theory (AREA)
- Human Computer Interaction (AREA)
- Power Engineering (AREA)
- Signal Processing (AREA)
- Artificial Intelligence (AREA)
- Computer Vision & Pattern Recognition (AREA)
- Evolutionary Computation (AREA)
- Software Systems (AREA)
- General Physics & Mathematics (AREA)
- Manipulator (AREA)
Abstract
本发明公开了基于双闭环三维路径跟踪的微机器人磁驱装置和控制方法,涉及微纳机器人控制技术领域,该方法包括:输入期望跟踪路径,通过摄像机获取磁性微机器人的当前位姿信息进而计算得到质心位置、实际轴线方向、期望跟踪路径上距离质心最近的期望位置点坐标以及此点的切线方向;根据实际轴线方向和切线方向以及扰动补偿计算出两点的水平距离、垂直距离、方向角误差、俯仰角误差;根据设计的位置闭环控制器求得所需的旋转磁场,电流闭环磁场控制器根据旋转磁场和反馈的线圈输出电流闭环控制亥姆霍兹线圈产生期望磁场,使磁性微机器人完成对期望跟踪路径的跟踪。该方法采用位置和电流反馈的双闭环控制能够精准的完成对三维路径的跟踪。
Description
技术领域
本发明涉及微纳机器人控制技术领域,尤其是基于双闭环三维路径跟踪的微机器人磁驱装置和控制方法。
背景技术
机器人的小型化为复杂和危险环境下的多种应用提供了解决方案,电磁驱动的磁性微机器人可以应用于医学环境,在不伤害人体的情况下磁性微机器人可以用于携带运输药物实现微创治疗。为了执行这样的任务磁性微机器人应该能实现对期望路径的跟踪。现有磁性微机器人的路径跟踪控制大多应用于平面范围,而且多采用单闭环路径跟踪即通过摄像机的视觉反馈获取磁性微机器在平面内的位姿信息建立位置闭环实现平面范围内的跟踪,然而这其中存在一定的响应延迟和适应性低的问题。一方面在高频环境下由于磁场发生装置的响应延迟问题,所使用的驱动装置往往不能及时准确的建立所需磁场造成响应速度慢。另一方面对复杂的人体环境我们更希望的是磁性微机器人能够完成对三维路径的跟踪,在平面路径跟踪控制领域上述方法可行,但应用于三维环境下的路径跟踪上述的控制方法便失去作用。
发明内容
本发明人针对上述问题及技术需求,提出了基于双闭环三维路径跟踪的微机器人磁驱装置和控制方法,实现对给定的三维期望跟踪路径准确及时的跟踪,克服在高频条件下磁驱装置响应速度慢的问题,采用位置反馈和电流反馈的双闭环控制提高了三维路径跟踪的准确性和快速性。
本发明的技术方案如下:
一种基于双闭环三维路径跟踪的微机器人磁驱装置,包括电磁线圈模组、直流电流源模组、PWM逆变电路、电流传感器、上位机、两个摄像头,电磁线圈模组包括六个带梯形探头的一级铁芯、设置在一级铁芯上的亥姆霍兹线圈以及线圈支架,每对带梯形探头的一级铁芯及其相应的亥姆霍兹线圈均平行设置,线圈支架用于固定三对带梯形探头的一级铁芯和三对亥姆霍兹线圈,三对带梯形探头的一级铁芯沿轴线方向两两正交,三对亥姆霍兹线圈沿轴线方向两两正交,三对梯形探头内侧形成的区域作为磁性微机器人的工作空间,每个直流电流源通过PWM逆变电路后为一对或一个亥姆霍兹线圈提供交流电,上位机分别连接PWM逆变电路、电流传感器和摄像头,电流传感器用于检测亥姆霍兹线圈的输出电流,两个摄像头设置在线圈支架外侧并且正交分布,上位机发送控制信号到PWM逆变电路输出频率和幅值可调的交流电,亥姆霍兹线圈产生旋转磁场进而控制磁性微机器人沿着旋转磁场的轴线方向进行三维运动,摄像头获取磁性微机器人的位置信息并传送至上位机实现闭环控制磁性微机器人的三维运动。
其进一步的技术方案为,线圈支架包括上下相对设置的底座、支架和中空挡板,每个底座沿轴线方向上均设有三个三角斜块,轴向上的一对三角斜块的斜面平行设置且用于放置带梯形探头的一级铁芯,支架设置在底座之间起到支撑作用,中空挡板设置在支架的中部并与底座平行,中空挡板将底座围成的空间分成上层区域和下层区域,每对带梯形探头的一级铁芯及其相应的亥姆霍兹线圈中的一个设置在中空挡板上且位于上层区域、另一个位于下层区域,中空挡板的中空面积至少与磁性微机器人的工作空间面积相同。
其进一步的技术方案为,一级铁芯为DT4-E材料制成的圆柱铁芯,直径50mm、厚30mm,亥姆霍兹线圈的匝数为190,梯形探头的末端为边长35mm的正方形,前端为长16mm、宽2mm的矩形,工作空间为半径16mm的球形空间,磁性微机器人为螺旋形状。
基于双闭环三维路径跟踪的微机器人控制方法,控制方法包括:
在上位机中输入期望跟踪路径得到期望运动方向,摄像机获取磁性微机器人的当前位姿信息并反馈给上位机得到磁性微机器人的质心三维坐标和实际轴线方向;
在期望跟踪路径上寻找与质心距离最小的期望位置点,建立期望跟踪路径曲线坐标系获取期望位置点三维坐标、期望跟踪路径曲线的曲率和挠率;
将实际轴线方向与期望运动方向、质心三维坐标与期望位置点三维坐标分别进行处理得到方向误差和位置误差,方向误差包括俯仰角误差和方向角误差,位置误差包括两者的水平距离和垂直距离;
根据曲率、挠率、方向误差和位置误差对期望跟踪路径的三维运动学建模得到状态空间方程;
通过状态空间方程设计位置闭环控制器得到所需旋转磁场,将旋转磁场输入至建立的电流闭环磁场控制器输出期望磁场,实现对磁性微机器人的双闭环三维运动控制;
重新执行摄像机获取磁性微机器人的当前位姿信息并反馈给上位机得到磁性微机器人的质心三维坐标和实际轴线方向的步骤,直至完成整个期望跟踪路径的跟踪。
其进一步的技术方案为,摄像机获取磁性微机器人的当前位姿信息并反馈给上位机得到磁性微机器人的质心三维坐标和实际轴线方向,包括:
利用侧面摄像机和顶部摄像机对磁性微机器人的当前位姿信息进行检测,把顶部摄像机坐标系固定为世界坐标系,通过下式计算磁性微机器人在世界坐标系中的实际轴线方向:
XB=ctht×cths=ctht×(ctRcs cshs)
其中,ctht表示顶部摄像机平面的法向量,cshs表示侧面摄像机平面的法向量,cths表示侧面摄像机平面的法向量到顶部摄像机平面的变换,ctRcs表示侧面摄像机坐标系到顶部摄像机坐标系的旋转矩阵,XB表示磁性微机器人在世界坐标系中的实际轴线方向;
通过下式计算磁性微机器人的质心在世界坐标系中的三维坐标:
G=ctRcs csG+cttcs
其中,csG表示质心在侧面摄像机平面的坐标,cttcs表示侧面摄像机坐标系到顶部摄像机坐标系的平移矩阵,G表示质心在世界坐标系中的三维坐标。
其进一步的技术方案为,状态空间方程为:
其中,s表示期望位置点三维坐标,v表示实际运动速度,θde表示方向角误差,θie表示俯仰角误差,c表示曲率,τ表示挠率,dy表示垂直距离,dz表示水平距离,Ωy表示磁性微机器人在Y轴上的角速度分量,Ωz表示磁性微机器人在Z轴上的角速度分量,δθi表示补偿俯仰角,δθd表示补偿方向角。
其进一步的技术方案为,通过状态空间方程设计位置闭环控制器得到所需旋转磁场,包括:
根据链式法则和路径跟踪任务对状态空间方程做线性化处理得到位置闭环控制器的输入量为:
其中,kd1、kt1、kd2、kt2为控制增益且为正;
路径跟踪任务为使方向角误差、俯仰角误差、垂直距离和水平距离收敛至零;
位置闭环控制器的输出量为:
其中,γ21、γ22、γ31、γ32、γ33的具体表达式为:
通过下式计算所需旋转磁场为:
B⊥=B0cos(2πft)yb+B0sin(2πft)zb
B||=-sgn((B⊥×Ω)XB)λ||(I1-XBXB T)Ω||XB
B=B||+B⊥
其中,B⊥为垂直于轴线方向的磁场并用于为磁性微机器人提供自转,B||为平行于轴线方向的磁场并用于为磁性微机器人提供转向,B0是工作空间中心的磁通密度,f是旋转频率,t是旋转时间,yb、zb是垂直于磁性微机器人的实际轴线方向XB平面的基向量,λ是控制增益,Ω是位置闭环控制器的输出量,且Ω=[Ωx Ωy Ωz],I1表示三阶单位矩阵。
其进一步的技术方案为,将旋转磁场输入至建立的电流闭环磁场控制器输出期望磁场,包括:
电流闭环磁场控制器对旋转磁场的方向和电流传感器反馈的线圈输出电流进行分析输出控制信号给PWM逆变电路,PWM逆变电路输出期望电流至亥姆霍兹线圈从而生成期望磁场;
其中,BX、BY、BZ为磁场B在三个轴向上的分量,nx、ny、nz为XOY、XOZ、YOZ三个平面的单位方向量;
其中,μ0为磁场介电常数,N表示亥姆霍兹线圈的匝数,a表示亥姆霍兹线圈的半径,I表示通入线圈的期望电流。
其进一步的技术方案为,在无扰动状况下磁性微机器人的期望运动方向为其轴线方向,期望运动方向由第一方向角和第一俯仰角表示,第一方向角为向量vp到XOY平面的投影与x轴的夹角,第一俯仰角为向量vp与XOY平面的夹角,由于受到重力及扰动的作用磁性微机器人的实际轴线方向由第二方向角和第二俯仰角表示,则对运行的磁性微机器人进行方向补偿,得到实际轴线方向与期望运动方向的对应关系为:
θd1=θd-δθd;θi1=θi-δθi
其中,θd1为第二方向角,θd为第一方向角,δθd为横向平面的补偿方向角,横向平面为XOY平面,θi1为第二俯仰角,θi为第一俯仰角,δθi为垂直平面的补偿俯仰角,垂直平面为与XOY平面垂直的面;
则方向角误差为:θde=θd1-θdc,其中,θdc为期望方向角;
俯仰角误差为:θie=θi-δθi-θic,其中,θic为期望俯仰角;
运行的磁性微机器人的实际运动速度为:
其中,vp为期望运动速度,v为实际运动速度。
其进一步的技术方案为,期望跟踪路径曲线坐标系是以期望位置点为原点、期望位置点的切线方向、主法线方向、次法线方向为坐标轴建立得到的,切线方向为期望运动方向,利用下述公式获取磁性微机器人的实际轴线方向与第一方向角、第一俯仰角之间的转换关系为:
本发明的有益技术效果是:
本申请提供的磁驱装置能够产生旋转磁场,实现了磁性微机器人在三维空间任意方向的控制,摄像机和集成在上位机中的位置闭环控制器、电流闭环磁场控制器配合实时监测和控制磁性微机器人的运动,PWM逆变电路能够缩短期望磁场的建立时间且使期望磁场更加稳定,上位机能快速给出期望位置点坐标以及磁性微机器人的运行轨迹信息;电流闭环磁场控制器、PWM逆变电路、亥姆霍兹线圈和电流传感器形成第一重闭环控制,在第一重闭环控制中,电流闭环磁场控制器对旋转磁场的方向和电流传感器反馈的输出电流进行分析输出控制信号给PWM逆变电路,PWM逆变电路输出期望电流至亥姆霍兹线圈从而生成期望磁场,位置闭环控制器、电流闭环磁场控制器、PWM逆变电路、亥姆霍兹线圈、磁性微机器人和摄像机形成第二重闭环控制,在第二重闭环控制中,根据摄像机反馈的位姿信息计算与期望运动路径的误差来设计位置闭环控制器得到所需旋转磁场,通过双闭环控制方法实现了磁性微机器人在三维环境下的准确、快速的路径跟踪。
附图说明
图1是本申请提供的磁驱装置原理图。
图2是本申请提供的电磁线圈模组整体装配正视图。
图3是本申请提供的去掉一个底座和支架的电磁线圈模组装配图。
图4是本申请提供的带三角斜块的底座示意图。
图5是本申请提供梯形探头、一级铁芯和二级铁芯的组合三视图。
图6是本申请提供的控制方法流程图。
图7是本申请提供的磁性微机器人在三维空间下运动的角度补偿示意图。
图8是本申请提供的获取磁性微机器人质心三维坐标和实际轴线方向的原理示意图。
图9是本申请提供的磁性微机器人在跟踪路径曲线坐标系下的期望跟踪路径模型图。
图10是本申请提供的第一重闭环控制的部分电路图。
具体实施方式
下面结合附图对本发明的具体实施方式做进一步说明。
本申请公开了一种基于双闭环三维路径跟踪的微机器人磁驱装置,图1示出了磁驱装置的原理图,磁驱装置包括电磁线圈模组、直流电流源模组、PWM逆变电路、电流传感器、上位机、两个摄像头。PWM逆变电路能够缩短期望磁场的建立时间且使期望磁场更加稳定,上位机能快速给出期望位置点坐标以及磁性微机器人的运行轨迹信息。结合图2-图4所示,电磁线圈模组包括六个带梯形探头1的一级铁芯2、设置在一级铁芯2上的亥姆霍兹线圈3以及线圈支架,每对带梯形探头1的一级铁芯2及其相应的亥姆霍兹线圈3均平行设置,线圈支架用于固定三对带梯形探头1的一级铁芯2和三对亥姆霍兹线圈3,具体的,线圈支架包括上下相对设置的底座401、支架402和中空挡板403,每个底座401沿轴线方向上均设有三个三角斜块404,轴向上的一对三角斜块404的斜面平行设置且用于放置带梯形探头1的一级铁芯2,支架402设置在底座401之间起到支撑作用,中空挡板403设置在支架402的中部并与底座401平行,中空挡板403将底座401围成的空间分成上层区域和下层区域,每对带梯形探头1的一级铁芯2及其相应的亥姆霍兹线圈3中的一个设置在中空挡板403上且位于上层区域、另一个位于下层区域。
三对带梯形探头1的一级铁芯2沿轴线方向两两正交,三对亥姆霍兹线圈3沿轴线方向两两正交,三对梯形探头1内侧形成的区域作为磁性微机器人的工作空间,中空挡板403的中空面积至少与磁性微机器人的工作空间面积相同。每个直流电流源通过PWM逆变电路后为一对或一个亥姆霍兹线圈3提供交流电,也即本申请的直流电流源至少为六个,至多为十二个。上位机分别连接PWM逆变电路、电流传感器和摄像头,电流传感器用于检测亥姆霍兹线圈3的输出电流,两个摄像头设置在线圈支架402外侧并且正交分布,上位机发送控制信号到PWM逆变电路输出频率和幅值可调的交流电,亥姆霍兹线圈3产生旋转磁场进而控制磁性微机器人沿着旋转磁场的轴线方向进行三维运动,摄像头获取磁性微机器人的位置信息并传送至上位机实现闭环控制磁性微机器人的三维运动。
可选的,电磁线圈模组还包括六个二级铁芯5以及围绕其设置的梯形线圈6,二级铁芯5设置在未设有梯形探头1的一级铁芯2的一侧上,同理,每对二级铁芯5平行设置且放置在三角斜块404上,三对二级铁芯5沿轴线方向两两正交,三对梯形线圈6沿轴线方向两两正交,梯形探头1、一级铁芯2和二级铁芯5呈阶梯状排列。
可选的,如图5所示,图5(a)为探头和铁芯组合的正视图,图5(b)为探头和铁芯组合的侧视图,图5(c)为探头和铁芯组合的俯视图。一级铁芯2和二级铁芯5均为DT4-E材料制成的圆柱铁芯,一级铁芯2的直径50mm、厚30mm,亥姆霍兹线圈3的匝数为190,二级铁芯5的直径70mm、厚35mm,梯形线圈6的匝数为610,对应的两个线圈串联通电,梯形探头1的末端为边长35mm的正方形,前端为长16mm、宽2mm的矩形。
可选的,根据上述带梯形探头1的一级铁芯2围成的工作空间为半径16mm的球形空间,磁性微机器人如图7所示为螺旋形状。
本申请还公开了一种基于双闭环三维路径跟踪的微机器人控制方法,能够应用在上述的磁驱装置中,该控制方法的流程图如图6所示,包括如下步骤:
步骤1:在上位机中输入期望跟踪路径得到期望运动方向,摄像机获取磁性微机器人的当前位姿信息并反馈给上位机得到磁性微机器人的质心三维坐标和实际轴线方向。
如图7所示,在无扰动状况下磁性微机器人的期望运动方向为其轴线方向,期望运动方向由第一方向角和第一俯仰角表示,第一方向角为向量vp到XOY平面的投影与x轴的夹角,第一俯仰角为向量vp与XOY平面的夹角。由于受到重力及扰动的作用磁性微机器人的实际轴线方向由第二方向角和第二俯仰角表示,则对运行的磁性微机器人进行方向补偿,得到实际轴线方向与期望运动方向的对应关系为:
θd1=θd-δθd;θi1=θi-δθi
其中,θd1为第二方向角,θd为第一方向角,δθd为横向平面的补偿方向角,横向平面为XOY平面,θi1为第二俯仰角,θi为第一俯仰角,δθi为垂直平面的补偿俯仰角,垂直平面为与XOY平面垂直的面。
运行的磁性微机器人的实际运动速度为:
其中,vp为期望运动速度,v为实际运动速度。
摄像机获取磁性微机器人的当前位姿信息并反馈给上位机得到磁性微机器人的质心三维坐标和实际轴线方向,如图8所示,包括:
利用侧面摄像机和顶部摄像机对磁性微机器人的当前位姿信息进行检测,把顶部摄像机坐标系固定为世界坐标系,通过下式计算磁性微机器人在世界坐标系中的实际轴线方向:
XB=ctht×cths=ctht×(ctRcs cshs)
其中,ctht表示顶部摄像机平面701的法向量,cshs表示侧面摄像机平面702的法向量,cths表示侧面摄像机平面702的法向量到顶部摄像机平面701的变换,ctRcs表示侧面摄像机坐标系到顶部摄像机坐标系的旋转矩阵,XB表示磁性微机器人在世界坐标系中的实际轴线方向。
通过下式计算磁性微机器人的质心在世界坐标系中的三维坐标:
G=ctRcs csG+cttcs
其中,csG表示质心在侧面摄像机平面702的坐标,cttcs表示侧面摄像机坐标系到顶部摄像机坐标系的平移矩阵,G表示质心在世界坐标系中的三维坐标。
步骤2:在期望跟踪路径上寻找与质心距离最小的期望位置点,建立期望跟踪路径曲线坐标系获取期望位置点三维坐标、期望跟踪路径曲线的曲率和挠率。
如图9所示,期望跟踪路径曲线坐标系是以期望位置点s为原点、期望位置点的切线方向XF、主法线方向YF、次法线方向ZF为坐标轴建立SF坐标系得到的,切线方向XF为期望运动方向,利用下述公式获取磁性微机器人的实际轴线方向与第一方向角、第一俯仰角之间的转换关系为:
步骤3:将实际轴线方向与期望运动方向、质心三维坐标与期望位置点三维坐标分别进行处理得到方向误差和位置误差,方向误差包括俯仰角误差和方向角误差,位置误差包括两者的水平距离和垂直距离。
则方向角误差为:θde=θd1-θdc,其中,θdc为期望方向角。
俯仰角误差为:θie=θi-δθi-θic,其中,θic为期望俯仰角。
水平距离dz和垂直距离dy为期望位置点三维坐标与质心三维坐标的欧式距离。
步骤4:根据曲率、挠率、方向误差和位置误差对期望跟踪路径的三维运动学建模得到状态空间方程。
则状态空间方程为:
其中,s表示期望位置点三维坐标,v表示实际运动速度,θde表示方向角误差,θie表示俯仰角误差,c表示曲率,τ表示挠率,dy表示垂直距离,dz表示水平距离,Ωy表示磁性微机器人在Y轴上的角速度分量,Ωz表示磁性微机器人在Z轴上的角速度分量,δθi表示补偿俯仰角,δθd表示补偿方向角。
步骤5:通过状态空间方程设计位置闭环控制器得到所需旋转磁场,将旋转磁场输入至建立的电流闭环磁场控制器输出期望磁场,实现对磁性微机器人的双闭环三维运动控制。
根据链式法则和路径跟踪任务对状态空间方程做线性化处理得到位置闭环控制器的输入量为:
其中,kd1、kt1、kd2、kt2为控制增益且为正。
路径跟踪任务为使所述方向角误差、俯仰角误差、垂直距离和水平距离收敛至零。
位置闭环控制器的输出量为:
其中,γ21、γ22、γ31、γ32、γ33的具体表达式为:
通过下式计算所需旋转磁场为:
B⊥=B0cos(2πft)yb+B0sin(2πft)zb
B||=-sgn((B⊥×Ω)XB)λ||(I1-XBXB T)Ω||XB
B=B||+B⊥
其中,B⊥为垂直于轴线方向的磁场并用于为磁性微机器人提供自转,B||为平行于轴线方向的磁场并用于为磁性微机器人提供转向,B0是工作空间中心的磁通密度,f是旋转频率,t是旋转时间,yb、zb是垂直于磁性微机器人的实际轴线方向XB平面的基向量,λ是控制增益,Ω是位置闭环控制器的输出量,且Ω=[Ωx Ωy Ωz],I1表示三阶单位矩阵。
图10示出了第一重闭环控制的部分电路图,电流闭环磁场控制器对旋转磁场的方向和电流传感器反馈的线圈输出电流进行分析输出PWM控制信号给PWM逆变电路,PWM逆变电路输出期望电流至亥姆霍兹线圈3从而生成期望磁场。
其中,BX、BY、BZ为磁场B在三个轴向上的分量,nx、ny、nz为XOY、XOZ、YOZ三个平面的单位方向量。
其中,μ0为磁场介电常数,N表示亥姆霍兹线圈3的匝数,a表示亥姆霍兹线圈3的半径,I表示通入线圈的期望电流。
步骤6:重新执行摄像机获取磁性微机器人的当前位姿信息并反馈给上位机得到磁性微机器人的质心三维坐标和实际轴线方向的步骤,直至完成整个期望跟踪路径的跟踪。
在本申请中,在上位机中设计电流闭环磁场控制器和位置闭环控制器,电流闭环磁场控制器、PWM逆变电路、亥姆霍兹线圈和电流传感器形成第一重闭环控制,在第一重闭环控制中,电流闭环磁场控制器输出控制信号给PWM逆变电路,PWM逆变电路输出期望电流至亥姆霍兹线圈从而生成期望磁场;位置闭环控制器、电流闭环磁场控制器、PWM逆变电路、亥姆霍兹线圈、磁性微机器人和摄像机形成第二重闭环控制,在第二重闭环控制中,根据摄像机反馈的位姿信息计算与期望运动路径的误差来设计位置闭环控制器得到所需旋转磁场,通过双闭环控制方法实现了磁性微机器人在三维环境下的准确、快速的路径跟踪。
以上所述的仅是本申请的优选实施方式,本发明不限于以上实施例。可以理解,本领域技术人员在不脱离本发明的精神和构思的前提下直接导出或联想到的其他改进和变化,均应认为包含在本发明的保护范围之内。
Claims (10)
1.基于双闭环三维路径跟踪的微机器人磁驱装置,其特征在于,所述磁驱装置包括电磁线圈模组、直流电流源模组、PWM逆变电路、电流传感器、上位机、两个摄像头,所述电磁线圈模组包括六个带梯形探头的一级铁芯、设置在所述一级铁芯上的亥姆霍兹线圈以及线圈支架,每对带梯形探头的一级铁芯及其相应的亥姆霍兹线圈均平行设置,所述线圈支架用于固定三对带梯形探头的一级铁芯和三对亥姆霍兹线圈,所述三对带梯形探头的一级铁芯沿轴线方向两两正交,所述三对亥姆霍兹线圈沿轴线方向两两正交,三对梯形探头内侧形成的区域作为磁性微机器人的工作空间,每个直流电流源通过所述PWM逆变电路后为一对或一个所述亥姆霍兹线圈提供交流电,所述上位机分别连接所述PWM逆变电路、电流传感器和摄像头,所述电流传感器用于检测所述亥姆霍兹线圈的输出电流,两个所述摄像头设置在所述线圈支架外侧并且正交分布,所述上位机发送控制信号到所述PWM逆变电路输出频率和幅值可调的交流电,所述亥姆霍兹线圈产生旋转磁场进而控制所述磁性微机器人沿着所述旋转磁场的轴线方向进行三维运动,所述摄像头获取所述磁性微机器人的位置信息并传送至所述上位机实现闭环控制所述磁性微机器人的三维运动。
2.根据权利要求1所述的基于双闭环三维路径跟踪的微机器人磁驱装置,其特征在于,所述线圈支架包括上下相对设置的底座、支架和中空挡板,每个所述底座沿轴线方向上均设有三个三角斜块,轴向上的一对所述三角斜块的斜面平行设置且用于放置所述带梯形探头的一级铁芯,所述支架设置在所述底座之间起到支撑作用,所述中空挡板设置在所述支架的中部并与所述底座平行,所述中空挡板将所述底座围成的空间分成上层区域和下层区域,每对所述带梯形探头的一级铁芯及其相应的亥姆霍兹线圈中的一个设置在所述中空挡板上且位于所述上层区域、另一个位于所述下层区域,所述中空挡板的中空面积至少与所述磁性微机器人的工作空间面积相同。
3.根据权利要求1或2所述的基于双闭环三维路径跟踪的微机器人磁驱装置,其特征在于,所述一级铁芯为DT4-E材料制成的圆柱铁芯,直径50mm、厚30mm,所述亥姆霍兹线圈的匝数为190,所述梯形探头的末端为边长35mm的正方形,前端为长16mm、宽2mm的矩形,所述工作空间为半径16mm的球形空间,所述磁性微机器人为螺旋形状。
4.基于双闭环三维路径跟踪的微机器人控制方法,其特征在于,应用于如权利要求1-3任一所述的磁驱装置,所述控制方法包括:
在所述上位机中输入期望跟踪路径得到期望运动方向,所述摄像机获取所述磁性微机器人的当前位姿信息并反馈给所述上位机得到所述磁性微机器人的质心三维坐标和实际轴线方向;
在所述期望跟踪路径上寻找与质心距离最小的期望位置点,建立期望跟踪路径曲线坐标系获取所述期望位置点三维坐标、期望跟踪路径曲线的曲率和挠率;
将所述实际轴线方向与所述期望运动方向、所述质心三维坐标与所述期望位置点三维坐标分别进行处理得到方向误差和位置误差,所述方向误差包括俯仰角误差和方向角误差,所述位置误差包括两者的水平距离和垂直距离;
根据所述曲率、挠率、方向误差和位置误差对所述期望跟踪路径的三维运动学建模得到状态空间方程;
通过所述状态空间方程设计位置闭环控制器得到所需旋转磁场,将所述旋转磁场输入至建立的电流闭环磁场控制器输出期望磁场,实现对所述磁性微机器人的双闭环三维运动控制;
重新执行所述摄像机获取所述磁性微机器人的当前位姿信息并反馈给所述上位机得到所述磁性微机器人的质心三维坐标和实际轴线方向的步骤,直至完成整个所述期望跟踪路径的跟踪。
5.根据权利要求4所述的基于双闭环三维路径跟踪的微机器人控制方法,其特征在于,所述摄像机获取所述磁性微机器人的当前位姿信息并反馈给所述上位机得到所述磁性微机器人的质心三维坐标和实际轴线方向,包括:
利用侧面摄像机和顶部摄像机对所述磁性微机器人的当前位姿信息进行检测,把顶部摄像机坐标系固定为世界坐标系,通过下式计算所述磁性微机器人在所述世界坐标系中的实际轴线方向:
XB=ctht×cths=ctht×(ctRcs cshs)
其中,ctht表示顶部摄像机平面的法向量,cshs表示侧面摄像机平面的法向量,cths表示所述侧面摄像机平面的法向量到所述顶部摄像机平面的变换,ctRcs表示侧面摄像机坐标系到顶部摄像机坐标系的旋转矩阵,XB表示所述磁性微机器人在所述世界坐标系中的实际轴线方向;
通过下式计算所述磁性微机器人的质心在所述世界坐标系中的三维坐标:
G=ctRcs csG+cttcs
其中,csG表示质心在所述侧面摄像机平面的坐标,cttcs表示侧面摄像机坐标系到顶部摄像机坐标系的平移矩阵,G表示质心在所述世界坐标系中的三维坐标。
7.根据权利要求6所述的基于双闭环三维路径跟踪的微机器人控制方法,其特征在于,所述通过所述状态空间方程设计位置闭环控制器得到所需旋转磁场,包括:
根据链式法则和路径跟踪任务对所述状态空间方程做线性化处理得到所述位置闭环控制器的输入量为:
其中,kd1、kt1、kd2、kt2为控制增益且为正;
所述路径跟踪任务为使所述方向角误差、俯仰角误差、垂直距离和水平距离收敛至零;
所述位置闭环控制器的输出量为:
其中,γ21、γ22、γ31、γ32、γ33的具体表达式为:
通过下式计算所述所需旋转磁场为:
B⊥=B0cos(2πft)yb+B0sin(2πft)zb
B||=-sgn((B⊥×Ω)XB)λ||(I1-XBXB T)Ω||XB
B=B||+B⊥
其中,B⊥为垂直于轴线方向的磁场并用于为所述磁性微机器人提供自转,B||为平行于轴线方向的磁场并用于为所述磁性微机器人提供转向,B0是工作空间中心的磁通密度,f是旋转频率,t是旋转时间,yb、zb是垂直于所述磁性微机器人的实际轴线方向XB平面的基向量,λ是控制增益,Ω是所述位置闭环控制器的输出量,且Ω=[Ωx Ωy Ωz],I1表示三阶单位矩阵。
8.根据权利要求7所述的基于双闭环三维路径跟踪的微机器人控制方法,其特征在于,所述将所述旋转磁场输入至建立的电流闭环磁场控制器输出期望磁场,包括:
所述电流闭环磁场控制器对所述旋转磁场的方向和所述电流传感器反馈的线圈输出电流进行分析输出所述控制信号给所述PWM逆变电路,所述PWM逆变电路输出期望电流至所述亥姆霍兹线圈从而生成所述期望磁场;
其中,BX、BY、BZ为磁场B在三个轴向上的分量,nx、ny、nz为XOY、XOZ、YOZ三个平面的单位方向量;
其中,μ0为磁场介电常数,N表示亥姆霍兹线圈的匝数,a表示亥姆霍兹线圈的半径,I表示通入线圈的期望电流。
9.根据权利要求6或7所述的基于双闭环三维路径跟踪的微机器人控制方法,其特征在于,在无扰动状况下所述磁性微机器人的期望运动方向为其轴线方向,所述期望运动方向由第一方向角和第一俯仰角表示,所述第一方向角为向量vp到XOY平面的投影与x轴的夹角,所述第一俯仰角为向量vp与XOY平面的夹角,由于受到重力及扰动的作用所述磁性微机器人的实际轴线方向由第二方向角和第二俯仰角表示,则对运行的所述磁性微机器人进行方向补偿,得到所述实际轴线方向与期望运动方向的对应关系为:
θd1=θd-δθd;θi1=θi-δθi
其中,θd1为所述第二方向角,θd为所述第一方向角,δθd为横向平面的所述补偿方向角,所述横向平面为XOY平面,θi1为所述第二俯仰角,θi为所述第一俯仰角,δθi为垂直平面的补偿俯仰角,所述垂直平面为与所述XOY平面垂直的面;
则所述方向角误差为:θde=θd1-θdc,其中,θdc为期望方向角;
所述俯仰角误差为:θie=θi-δθi-θic,其中,θic为期望俯仰角;
运行的所述磁性微机器人的实际运动速度为:
其中,vp为期望运动速度,v为实际运动速度。
Priority Applications (3)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202011118436.2A CN112180736B (zh) | 2020-10-19 | 2020-10-19 | 基于双闭环三维路径跟踪的微机器人控制方法 |
PCT/CN2021/104466 WO2022083173A1 (zh) | 2020-10-19 | 2021-07-05 | 基于双闭环三维路径跟踪的微机器人磁驱装置和控制方法 |
US17/522,676 US11938629B2 (en) | 2020-10-19 | 2021-11-09 | Micro-robot magnetic drive device and control method based on double closed loop three-dimensional path tracking |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202011118436.2A CN112180736B (zh) | 2020-10-19 | 2020-10-19 | 基于双闭环三维路径跟踪的微机器人控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN112180736A true CN112180736A (zh) | 2021-01-05 |
CN112180736B CN112180736B (zh) | 2021-08-03 |
Family
ID=73950977
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202011118436.2A Active CN112180736B (zh) | 2020-10-19 | 2020-10-19 | 基于双闭环三维路径跟踪的微机器人控制方法 |
Country Status (3)
Country | Link |
---|---|
US (1) | US11938629B2 (zh) |
CN (1) | CN112180736B (zh) |
WO (1) | WO2022083173A1 (zh) |
Cited By (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113064429A (zh) * | 2021-03-15 | 2021-07-02 | 江南大学 | 一种磁性微机器人群体独立驱动控制系统 |
CN113488309A (zh) * | 2021-07-09 | 2021-10-08 | 澳门大学 | 旋转磁场发生器及机器人 |
CN113671960A (zh) * | 2021-08-19 | 2021-11-19 | 江南大学 | 一种磁性微纳机器人的自主导航与控制方法 |
WO2022083173A1 (zh) * | 2020-10-19 | 2022-04-28 | 江南大学 | 基于双闭环三维路径跟踪的微机器人磁驱装置和控制方法 |
CN114967458A (zh) * | 2022-05-30 | 2022-08-30 | 江南大学 | 一种微纳机器人集群的驱动控制系统 |
Families Citing this family (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN116019565B (zh) * | 2022-10-28 | 2024-07-05 | 中国科学院深圳先进技术研究院 | 一种用于微型机器人的半开放式磁操控装置 |
CN116300982B (zh) * | 2023-03-03 | 2024-06-07 | 新兴际华(北京)智能装备技术研究院有限公司 | 水下航行器及其路径跟踪控制方法和装置 |
CN116035669B (zh) * | 2023-03-28 | 2023-10-27 | 真健康(北京)医疗科技有限公司 | 电磁驱动的两自由度穿刺针导向装置 |
CN117631544B (zh) * | 2024-01-25 | 2024-04-30 | 湖北工业大学 | 一种中空纤维膜拉丝机系统复合控制方法及系统 |
Citations (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US5720010A (en) * | 1995-08-22 | 1998-02-17 | Ebara Corporation | Control system for a linear actuator including magnetic bearings for levitating a robot arm |
CN101262198A (zh) * | 2008-04-14 | 2008-09-10 | 大连理工大学 | 体内医疗微型机器人万向旋转磁场驱动控制方法 |
US20140253114A1 (en) * | 2013-02-26 | 2014-09-11 | Mir Behrad KHAMESEE | System and method for providing force information in a magnetic field environment |
US20140333143A1 (en) * | 2013-05-08 | 2014-11-13 | Korea Institute Of Science And Technology | Electromagnetic coil system for driving control of micro-robot |
CN105334964A (zh) * | 2015-11-01 | 2016-02-17 | 华南理工大学 | 基于电磁理论的力反馈人机交互系统及方法 |
CN107179780A (zh) * | 2017-07-06 | 2017-09-19 | 哈尔滨工业大学深圳研究生院 | 一种视觉反馈三维电磁微机器人无缆驱动控制系统 |
CN108199527A (zh) * | 2018-01-31 | 2018-06-22 | 湖北环电磁装备工程技术有限公司 | 无框组合式永磁同步直线电机直驱的机器人关节旋转装置 |
CN108406725A (zh) * | 2018-02-09 | 2018-08-17 | 华南理工大学 | 基于电磁理论与移动跟踪的力反馈人机交互系统及方法 |
US20200030995A1 (en) * | 2017-03-27 | 2020-01-30 | Planar Motor Incorporated | Robotic devices and methods for fabrication, use and control of same |
Family Cites Families (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112180736B (zh) * | 2020-10-19 | 2021-08-03 | 江南大学 | 基于双闭环三维路径跟踪的微机器人控制方法 |
-
2020
- 2020-10-19 CN CN202011118436.2A patent/CN112180736B/zh active Active
-
2021
- 2021-07-05 WO PCT/CN2021/104466 patent/WO2022083173A1/zh active Application Filing
- 2021-11-09 US US17/522,676 patent/US11938629B2/en active Active
Patent Citations (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US5720010A (en) * | 1995-08-22 | 1998-02-17 | Ebara Corporation | Control system for a linear actuator including magnetic bearings for levitating a robot arm |
CN101262198A (zh) * | 2008-04-14 | 2008-09-10 | 大连理工大学 | 体内医疗微型机器人万向旋转磁场驱动控制方法 |
US20140253114A1 (en) * | 2013-02-26 | 2014-09-11 | Mir Behrad KHAMESEE | System and method for providing force information in a magnetic field environment |
US20140333143A1 (en) * | 2013-05-08 | 2014-11-13 | Korea Institute Of Science And Technology | Electromagnetic coil system for driving control of micro-robot |
CN105334964A (zh) * | 2015-11-01 | 2016-02-17 | 华南理工大学 | 基于电磁理论的力反馈人机交互系统及方法 |
US20200030995A1 (en) * | 2017-03-27 | 2020-01-30 | Planar Motor Incorporated | Robotic devices and methods for fabrication, use and control of same |
CN107179780A (zh) * | 2017-07-06 | 2017-09-19 | 哈尔滨工业大学深圳研究生院 | 一种视觉反馈三维电磁微机器人无缆驱动控制系统 |
CN108199527A (zh) * | 2018-01-31 | 2018-06-22 | 湖北环电磁装备工程技术有限公司 | 无框组合式永磁同步直线电机直驱的机器人关节旋转装置 |
CN108406725A (zh) * | 2018-02-09 | 2018-08-17 | 华南理工大学 | 基于电磁理论与移动跟踪的力反馈人机交互系统及方法 |
Non-Patent Citations (5)
Title |
---|
CHENGMING LUO等: "A collaborative positioning algorithm for mobile target using multisensor data integration in enclosed environments", 《COMPUTER COMMUNICATIONS》 * |
QIGAO FAN等: "Data Fusion for Indoor Mobile Robot Positioning Based on Tightly Coupled INS/UWB", 《THE JOURNAL OF NAVIGATION》 * |
宋时间: "基于三维可变磁场微机器人磁驱动控制技术的研究", 《中国优秀硕士学位论文全文数据库 信息科技辑》 * |
王群京等: "双极永磁球形电动机的电磁模型及磁场分析", 《中国科学技术大学学报》 * |
祝天利等: "基于场路耦合的机器人永磁电动机损耗及其温升分析", 《电气技术》 * |
Cited By (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2022083173A1 (zh) * | 2020-10-19 | 2022-04-28 | 江南大学 | 基于双闭环三维路径跟踪的微机器人磁驱装置和控制方法 |
US11938629B2 (en) | 2020-10-19 | 2024-03-26 | Jiangnan University | Micro-robot magnetic drive device and control method based on double closed loop three-dimensional path tracking |
CN113064429A (zh) * | 2021-03-15 | 2021-07-02 | 江南大学 | 一种磁性微机器人群体独立驱动控制系统 |
CN113488309A (zh) * | 2021-07-09 | 2021-10-08 | 澳门大学 | 旋转磁场发生器及机器人 |
CN113671960A (zh) * | 2021-08-19 | 2021-11-19 | 江南大学 | 一种磁性微纳机器人的自主导航与控制方法 |
CN114967458A (zh) * | 2022-05-30 | 2022-08-30 | 江南大学 | 一种微纳机器人集群的驱动控制系统 |
Also Published As
Publication number | Publication date |
---|---|
CN112180736B (zh) | 2021-08-03 |
US20220118609A1 (en) | 2022-04-21 |
US11938629B2 (en) | 2024-03-26 |
WO2022083173A1 (zh) | 2022-04-28 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN112180736B (zh) | 基于双闭环三维路径跟踪的微机器人控制方法 | |
Xu et al. | Planar path following of 3-D steering scaled-up helical microswimmers | |
Ryan et al. | Magnetic actuation for full dexterity microrobotic control using rotating permanent magnets | |
Folio et al. | Two-dimensional robust magnetic resonance navigation of a ferromagnetic microrobot using pareto optimality | |
Ryan et al. | Five-degree-of-freedom magnetic control of micro-robots using rotating permanent magnets | |
CN104097200B (zh) | 机械手、机械手控制装置以及机械手系统 | |
Yang et al. | Autonomous navigation of magnetic microrobots in a large workspace using mobile-coil system | |
JPS6321157B2 (zh) | ||
Yongguo et al. | Trajectory planning algorithm based on quaternion for 6-DOF aircraft wing automatic position and pose adjustment method | |
CN107179780A (zh) | 一种视觉反馈三维电磁微机器人无缆驱动控制系统 | |
CN105559739A (zh) | 一种基于磁场强度变化的胶囊内镜运动控制方法 | |
CN105662318A (zh) | 一种空间万向旋转磁场人机交互控制方法 | |
Song et al. | Motion control of capsule robot based on adaptive magnetic levitation using electromagnetic coil | |
Yang et al. | Multimode control of a parallel-mobile-coil system for adaptable large-workspace microrobotic actuation | |
Cheang et al. | Towards model-based control of achiral microswimmers | |
Yang et al. | Model-free and uncalibrated eye-in-hand visual servoing approach for concentric-tube robots | |
Yang et al. | Optimal Parameter Design and Microrobotic Navigation Control of Parallel-Mobile-Coil Systems | |
von Arx et al. | Simultaneous Localization and Actuation Using Electromagnetic Navigation Systems | |
Limpabandhu et al. | Actuation technologies for magnetically guided catheters | |
Huang et al. | Enhanced localization strategy for magnetic capsule robot using on-board nine-axis IMU through incorporation of alternating magnetic field | |
CN114888798B (zh) | 基于振荡磁场平台的微机器人运动控制系统 | |
Song et al. | The design of 3-D space electromagnetic control system for high-precision and fast-response control of capsule robot with 5-DOF | |
CN110497391A (zh) | 机械臂示教方法及机械臂示教装置 | |
US11451169B2 (en) | Multi-dimensional magnetic levitation and translation system and methods | |
CN112284372B (zh) | 一种基于线圈磁场调控的定位精度提升方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |