弓丝弯制机器人轨迹规划与控制
详细信息    本馆镜像全文|  推荐本文 |  |   获取CNKI官网全文
摘要
机器人是一种机电一体化的复杂动态系统,随着现代化工业的发展,机器人在工业中的使用也日渐成熟,而机器人在医疗领域的应用是目前机器人研究的热点课题之一。这也将改变传统医疗的许多概念,并对相关学科的发展产生积极的推动作用。本课题所研究的弓丝弯制机器人是用于医学中口腔医学领域口腔正畸学分支的是专用机器人。其目的是研制一套完整的机器人系统进行矫正弓丝的弯制来代传统的手工弯制方法。使用机器人进行矫正弓丝的弯制,可以提高弓丝弯制的精度同时缩短弯制时间。如果研制出成型的弯制系统并使机器人得到广泛的使用,可以在很大程度上降低口腔医生的劳动量并提高口腔医学临床自动化的程度。
     本课题首先设计了弓丝弯制机器人整个系统的总体方案,对系统功能结构进行了阐述,并对系统试验平台MOTOMAN UP6机器人进行了运动学分析,为机器人进行弓丝弯制运动控制软件的开发提供了理论依据;其次进行了弓丝弯制末端夹持器的机构设计以及末端夹持器驱动方式选择;再次根据矫正弓丝的实际形状,结合MOTOMAN UP6机器人的运动方式进行了弓丝弯制机器人在进行弓丝弯制作业时的运动轨迹规划。根据实际需要阐述了整个系统在软件上要实现的功能,详细介绍了上位机软件的设计过程和各功能模块,完成了对弓丝弯制机器人控制软件的阶段性开发和对全系统操作与控制的原理验证。最后进行了标准牙弓曲线形矫正弓丝的弯制实验,并对误差产生的原因进行了分析。
     实验对y = 0.005x2.8型的牙弓曲线形弓丝进行弯制,在设定允许偏差的情况下合理的分布弯制结点,弯制成型后与标准的指数函数型曲线进行了对比,得到了较为理想的弓丝形态。结果表明整个系统总体方案以及运动控制方案是合理、可行的。
Robot is a mechanical and electrical integration system. With development of the robot in industry the application of robotics in the medical field has become a hot topic. This trend will change many concepts of traditional medicine and related disciplines will have a positive development. The archwire bending robot researched is a kind of special robot which provides services for orthodontics. The robot takes place the traditional manual method to finish the archwire bending. It will significantly improve the accuracy of archwire and efficiency of bending. The amount of oral doctor’s labor will be reduced if the archwire bending robots can be widely used and the degree of clinical oral medicine automation will be improved.
     Firstly the whole general scheme of the arch wire bending robot system is designed in this paper. Then the function of the system is elaborated and the analysis of MOTOMAN UP6 robot kinematics is studied as the theoretical of the motion control software. Then the archwire bending gripper mechanism is designed and the drive mode is selected. After these two steps, the trajectory planning is studied with combination of MOTOMAN UP6 robot’s movement pattern. The entire system software function is described according to actual needs that the robot must achieve. Following that the function modules host computer software are introduced in details. This subject has completed the phased development of archwire bending robot control software and verified system-wide operation and control principle. Finally, the archwire bending experiment is done to make the standard corrective archwire and analyzes the cause of the errors.
     The archwire was bended on some certain control points with the function of y = 0.005x2.8under a specified maximum deviation. It showed that the archwire had a good accuracy after compared with the standard exponential function curve. As a result, the whole system as well as motion control program is reasonable and feasible.
引文
[1]傅民魁.口腔正畸学[M].北京:人民卫生出版社,2007:15-20.
    [2] Dirk Wiechmann . Lingual Orthodontics (Part 2): Archwire Fabrication [J].Journal of Orofacial Orthopedics, 1999 60(6):416-426.
    [3] Toshiya Endo, Koji Kojima.Cephalometric evaluation of anterior open-bite nonextraction treatment,using multiloop edgewise archwire therapy: Archwire Fabrication[J].Odontology, 2006 94(4):51-58.
    [4] Christian Sander, Franz Martin Sander.The Derotation of Premolars and Canines with NiTi Elements [J].Journal of Orofacial Orthopedics, 2006 67(2):117-126.
    [5] Helge Fischer-Brandies, Mohammed Es-Souni . Transformation Behavior, Chemical Composition,Surface Topography and Bending Properties of FiveSelected 0.016″-0.022″NiTi Archwires[J] . Journal of Orofacial Orthopedics, 2003 64(2):88-99.
    [6] Christian Sander, Franz Martin Sander.Leveling of the Second Molar with a Superelastic Spring[J].Journal of Orofacial Orthopedics, 2006 67(3):186-195.
    [7] Ralf J. Radlanski, Natalie D. Zain.Stability of the Bonded Lingual Wire Retainer-A Study of the Initial Bond Strength[J] . Journal of Orofacial Orthopedics, 2004 65(4):321-335.
    [8] Franz Martin Sander, Christian Sander.Alignment of Displaced or Impacted Teeth with the Traction Chain[J].Journal of Orofacial Orthopedics, 2006 67(4):289-296.
    [9] Verena Nedwed, Rainer-Reginald Miethke . Motivation, Acceptance and Problems of Invisalign Patients[J].Journal of Orofacial Orthopedics, 2005 66(2):162-173.
    [10] Edward Jahn, Douglas Edward Toll.Effect of the MARA Appliance on the Position of the Lower Anteriors in Children, Adolescents and Adults with Class II Malocclusion[J].Journal of Orofacial Orthopedics, 2007 68(5):397-412.
    [11] Pamela Husmann, Christoph Bourauel.The Frictional Behavior of Coated Guiding Archwires[J].Odontology, 2002 63(2):199-211.
    [12]傅民魁,林久祥.口腔正畸学[M].北京:北京医科大学出版社,2005.
    [13]任超超,白玉兴.不同正畸镍钛矫正弓丝机械性能差异的对比研究[J].现代口腔医学杂志,2008,33(2):244-247.
    [14]赵晓宾,王高潮.TC11钛合金的最大m值超塑性变形研究[J].航空材料学报,2008,28(2):5-8.
    [15] Motoman安装手册.北京:首钢莫托曼机器人有限公司,1999.
    [16] Motoman机器人使用说明书.北京:首钢莫托曼机器人有限公司,1999.
    [17] YASNAC XRC使用说明书.北京:首钢莫托曼机器人有限公司,1999.
    [18] MOTOCOM32 SPECIFICATION.日本:莫托曼机器人有限公司,1999.
    [19] YASNAC XRC操作要领书-入门篇.首钢莫托曼机器人有限公司,1999.
    [20] YASNAC XRC操作要领书-应用篇.首钢莫托曼机器人有限公司,1999.
    [21] MOTOCOM32 OPERATION MANUAl.莫托曼机器人有限公司,1999.
    [22]夏泽洋,陈恳.面向仿人机器人自然步态规划的人体步行实验分析[J].机器人,2008,30(1):41-46.
    [23] Kwon J, Park FC.Using hidden Markov models to generate natural hum anoid movement [C].International Conference on Intelligent Robots and System, 2006 1990-1995.
    [24]莫贤,陈文家.一种四自由度并联机器人的工作空间分析[J].扬州大学学报,2008,11(3):40-44.
    [25]王乐锋,荣伟彬.三杆六自由度并联微动机器人的工作空间分析[J].机械设计与制造,2008,22 (3):5-8.
    [26]赵燕江,张永德.基于Matlab的机器人工作空间求解方法[J].机械科学与技术,2009 ,12(3):1657-1666.
    [27]胡磊,刘文勇.骨科机器人空间设计方法研究[J].机器人,2006 ,28(4):389-393.
    [28]王卫忠,赵杰,蔡鹤皋.机器人的片面曲线轨迹规划方法[J].哈尔滨工业大学学报,2008, 40(3):389-392.
    [29] Nejat G,Benhabib B. Line-of-sight task-space sensing methodology for the localization of robotic end effectors [J]. IEEE/ASME Transactions on Mechatronics,2006,11(2):225-232.
    [30] Yoshida K, Nakanishi H.Impedance matching in capturing a satellite by a space robot[A]. Proceedings of the IEEE/RSJ International Conference on Intelligent Robots and Systems [C]. Piscataway,NJ,USA: IEEE, 2003. 3059-3064.
    [31] Philipp Meyer-Marcotty, Jutta Hartmann, Angelika Stellzig-Eisenhauer. Dentoalveolar Open Bite Treatment with Spur Appliances[J]. Journal of Orofacial Orthopedics, 2007, 68(6):510-520.
    [32] ROHSG,CHOIHR. Differential driven pipe robot for moving inside urban gas pipe lines [J]. IEEE Transactions on Robotics,2005,21(l):l-17.
    [33]徐文福,詹文法,梁斌.自由飘浮空间机器人系统基座姿态调整路径规划方法的研究[J].机器人,2006,28(3): 291-296.
    [34]张福海,付宜利,王树国.一种笛卡儿空间的自由漂浮空间机器人路径规划方法[J].机器人,2009,31(2):187-192.
    [35]曲道奎,杜振军.移动机器人路径规划方法研究[J].机器人,2008,30(2):97-102.
    [36]曹会彬,李斌.基于多传感器的可变形机器人自主控制方法研究[J].机器人,2007,29(5): 479-484.
    [37]丁杰男,王树新.主从式外科手术机器人实时控制算法[J].机械工程学报,2006,42(12):163-168.
    [38]陈志翔,殷树言.基于遗传模拟退火算法的弧焊机器人系统协调路径规划[J].机械工程学报,2005,41(2):194-199.
    [39]李东洁,邱江艳,尤波.一种机器人轨迹规划的优化算法[J].电机与控制学报,2009,13(1):124-127.
    [40]王昕,王均伟.基于NURBS曲线轨迹规划与速度规划的研究[J].系统仿真学报,2008,20(15):3973-3980.
    [41]李燕青,计时鸣. MOTOMAN机器人实时控制的方法研究[J].机电工程, 2007,24(7): 69-82.
    [42]王宇智,严新忠.用VC++6.0实现PLC与PC机之间的通信[J].计算机应用,2002,17(6):41-43.
    [43]雷鹏,陈星.用Windows API设计多线程的串行通信ActiveX控件[J].电子技术应用, 2002,1: 26-28.
    [44]杨东海,翁新华.基于VC ++和MFC的上位机与PLC的通讯系统[J].微计算机信息,2003,19:10-12.
    [45]张晓鑫,雍俊海.面向对象系统的应用编程接口设计模式[J].计算机工程与应用,2006,30(1):108-110.
    [46]周晶晶,张学志.基于Visual C++的数据处理软件的设计[J].微计算机信息,2009,25(2):228-230.
    [47]王超龙,陈志华.Visual C++ 6.0入门与提高[M].北京:人民邮政出版社,2003:39-95.
    [48]殷华文,崔世林,田斐.PLC与上位计算机的串行通讯程序设计技术[J].现代电子技术,2001 (12):78-81.
    [49]钞海洋,吴建华.基于Linix的移动机器人串行通信的研究[J].机电工程,2005,22 (4):43-46.
    [50]刘元朋,赵辉,陈良骥.基于ActiveX的VC++和Matlab混合编程技术[J].兵工自动化,2008 (3):23-26.