医用微型胶囊机器人双变量磁力矩控制研究  

Research on Double Variant Magnetic Torque Control of Medical Microcapsule robot

作　　者：楚庄 王元利 迟明路 刘荣升 钱晓艳 邢倩 邱亚琴 任沁超 任瑞华 CHU Zhuang;WANG Yuanli;CHI Minglu;LIU Rongsheng;QIAN Xiaoyan;XING Qian;QIU Yaqin;REN Qinchao;REN Ruihua(College of Materials Science and Engineering,Henan Institute of Technology,Xinxiang 453003,China;School of Intelligent Engineering,Henan Institute of Technology,Xinxiang 453003,China;School of Economics,Henan Institute of Technology,Xinxiang 453003,China;Jiangsu Huibo Robot Technology Co.LTD,Suzhou 450002,China)

机构地区：[1]河南工学院材料科学与工程学院,河南新乡453003 [2]河南工学院智能工程学院,河南新乡453003 [3]河南工学院经济学院,河南新乡453003 [4]江苏汇博机器人技术股份有限公司,江苏苏州215121

出　　处：《河南工学院学报》2021年第5期1-5,共5页Journal of Henan Institute of Technology

基　　金：河南省重点研发与推广专项(科技攻关)项目(212102310119,212102210358);河南工学院高层次引进人才科研启动基金(KQ1869);河南工学院教育教学改革研究与实践项目(2019JG-ZD005);河南省高等教育教学改革研究与实践项目(2019SJGLX485);河南省高校大学生创新创业训练计划项目(202011329002,202011329003,202011329008,202011329009);教育部产学合作协同育人项目(201902155006);新乡市社科联重点调研课题(2020-145)。

摘　　要：为方便控制医用微型胶囊机器人的运动姿态,实现控制变量的降维与解耦,提出一种胶囊机器人的双变量磁力矩解耦控制方法。根据磁耦合力矩基本公式,推导了双变量转弯磁力矩,并通过解耦坐标变换减少了控制变量。对空间磁力矩的仿真分析结果表明:俯仰角和侧摆角都与微型胶囊机器人的运动方向有关,俯仰角和侧摆角越接近0°,微型胶囊机器人的运动状态越稳定。当俯仰角和侧摆角等于0°时,微型胶囊机器人将沿自身轴线旋转并进行直线运动,当俯仰角和侧摆角同时等于0°时,平均总磁力矩达到最小值。双变量磁力矩控制显著提升了磁场控制的便捷性和灵活性,为Helmholtz线圈旋转磁场的人机交互控制奠定了基础。In order to easily control the motion posture of medical microcapsule robot and realize the dimension reduction and decoupling of control variables,a dual-variable magnetic torque decoupling control method for the capsule robot is proposed.According to the basic formula of magnetic coupling torque,the double variable turning magnetic torque is derived,and the control variable is reduced by decoupling coordinate transformation.The simulation results of spatial magnetic moment show that the pitch angle and side swing angle are related to the motion direction of the capsule robot.The closer the pitch angle and side swing angle are to 0°,the more stable the motion state of the capsule robot is.When the pitch angle and the side swing angle are equal to 0°,the capsule robot will rotate along its axis and move in a straight line.When the pitch angle and the side swing angle are equal to 0°,the average total magnetic moment reaches the minimum.The double variant magnetic torque control significantly improves the convenience and flexibility of magnetic field control,which lays a foundation for human-computer interactive control of rotating magnetic field of Helmholtz coil.

关 键 词：医用微型胶囊机器人 肠道检查 双变量 磁力矩 解耦坐标变换 

分 类 号：TP27[自动化与计算机技术—检测技术与自动化装置]