136 机械设计与制造
Machinery Design&Manufacture 第3期 2013年3月
基于LabVIEW和SolidWorks的 lj手术机器人运动仿真
朱峰,刁 燕,吴应东
(I ̄IJII大学制造科学与工程学院,四川成都610065)
摘要:为了直观的对微创手术机器人进行运动分析,首先建立机器人逆向运动学数学模型,并在Matlab中完成逆解程
序编写。同时在Solidworks中建立相应的三维模型,利用SolidWorks Morion对机器人进行了运动轨迹规划和仿真,验证
了位置反解的正确性。为了使运动规划和仿真更加直观、简单,需要设计运动仿真前界面。因此,基于LabVIEW强大的前
面板功能设计出运动仿真人机交互界面,基于LabVIEW SoftMotion模块丰富的运动函数完成机器人末端轨迹规划,最后
将LabVIEW、SolidWorks和Motion设计工具集成到一起,对机器人进行了运动仿真,实现了对运动过程的参数化控制。
关键词:手术机器人;运动仿真;6olidWorks;Motion;LabVIEW;SoftMotion
中图分类号:TH16;TP242 文献标识码:A 文章编号:1001—3997(2013)03—0136—03
Minimally Invasive Surgical Robot Motion Simulation Based
on LabVI E:W and SoildWorks
ZHU Feng.DIAO Yan.WU Ying-dong
(School ofManufacturing Science and Engineering,Sichuan University,Siehuan Chengdu 610065,China)
Abstract:In order to complete the motion simulation ofan existing minimally invasive surgical robot,the mathematical model
o厂the inverse solutions established,then programmed by Matlab.Trajectoryplanning and simulation ofmechanism were
pe r/备r,r d by SolidWorksMotion which verified e validity of inverse position.Man—machine interface of£ e motion
simulation was needed to" e the motion simulation more intuitive and simpler.LabVIEW W(/S used tO design man—machine inte ̄ace of the motion simulation.Trajectory planning of the robot WtTIS completed by LabVIEW SofiMotion because of it’s
wealth ofmotionfunctions.Finally.motion simulation preformed by LabVIEW.SolidWorks and motion integrated together
which achieved the parameters control of movement.
Key Words:Surgical Robot;Motion Simulation;SolidWorks;Motion;LabVIEW;SoftMotion
1引言
随着相关技术的发展,手术机器人成为国际医学界研究的
热点I I。手术机器人具有状态稳定、定位准确等优点。单一的串联 或者并联机器人结构并不能满足这些要求,因此采用串联和并联
结合的混联机器人构型 。 机器人的运动学分析是进行机器人机构设计的首要任务。
Matlab软件能够完成运动学理论分析和数据计算,但不够直观,
机器人末端轨迹规划验证过程也比较繁琐。因此,对机器人采用
SolidWorks进行建模,为后续SolidWorks Motion仿真提供对象。
采用SolidWorks Motion进行运动仿真比较繁琐,因此,开发 直观简洁的运动仿真前界面就非常有必要。某公司开发的
SoflMotion模块能和SolidWorks Motion无缝连接。该模块提供丰
富的运动规划函数,结合LabVIEW本身强大的前面板功能,将为
机器人轨迹规划和运动控制设计出更加合理的人机交互界面。同
时也为后续机器人的机电一体化仿真奠定了基础。
2机器人结构及运动学逆解分析
机器人结构如图1所示。该系统具有7+1个冗余运动自由 度,其中第5关节为并联转动机构,实现两个自由度的转动,调整
手术工具杆的姿态,模型中简化为一个球关节。
第五关节
第二
关节
dj 图1机器人关节配置
FigA Configuralion Map of Robot Joints 采用几何法得到机器人的逆解,该方法还可用于实时控制13/。
为了简化公式,作以下规定:
s =sin(O/+ ̄) (1)
cij=cOS( + ) (2)
S:sin0. (3)
来稿13期:2012—05—27 基金项目:成都市科技计划项目(11DXYB190JH一027);四川省科技支撑计划项目(2011GZ0096),(2012FZ0042) 作者简介:朱峰,(1982一),男,
江苏省徐州市人,在读硕士研究生,主要研究方向:机械自动化方面的专业研究 第3期 朱峰等:基于LabVIEW和SolidWorks的微创手术机器人运动仿真 137
Ci=eosOi
Sy=sinO
Cy=COS ̄y =sin( )
c =cos(3+0) (4)
(5)
(6)
(7)
(8)
图2机器人空f司坐标系
Fig.2 Reference Coordinate Systems of Robot 根据球关节处Q在基础坐标系中的坐标(q q ,q )与第二、
第三关节之间的几何关系,如图3所示,可求得腕点坐标表达式
为:
q =-a2sinO2-fsin(02+03) (9)
q =a=cos¥2+fcos(O ̄+as) (10)
P:=dI+d2+a4sB4+ 2sird一 3c0 (11)
+a4c + 2co ̄+u3 si (12)
_厂表示从关节3到腕点Q间距离在XOY平面上的投影长
度
图3定位关节逆解构型图
Fig.3 Inverse Kinematics Configuration of Position Joints 根据上述表达式,依次求解出0 ,0,,04:
: ) +2 3
03 ̄+arccos --g2;
a一 ̄ -1 ( 4)
04=arcsi f进1]8 (15)/ l 口
根据手术杆末端点坐标H(h ,h , ),求得移动关节6的移
距离d6为: r——————— ~—————— ~—————— d6= ̄/(hx-q ) +(^ 1 )‘+(hz-q ) ~u4-L (16)
并联转动腕点与手术工具杆的关系,如图4所示。
图4腕点与手术杆关系图 ng.4 Relationship Map Between Wrist and Surgical Tool 根据图4中腕点与手术杆的关系,可求出并联转动机构的
转角0y, 的表达式:
—arctan瓦 (q ̄:- hx) %=3+ ( qr- hy)s z3 (17)
: 。。 (18)
c V(h-q ) +(h-q ) +(h-q )‘
3基于SolidWorks的机器人运动仿真
手术机器人运动仿真用于验证位置正反解,可以通过模拟
来检查数据的正确性 。
Motion模块是内嵌于SolidWorks的运动仿真软件包,可对
模型的真实运动情况进行精确仿真。通过Motion仿真可以大幅
降低制造物理原型的成本,并缩短产品开发时间。它还有其它一
些定性优点,例如,它能够考虑更多的设计方案、降低风险,并在
设计过程的初期提供有价值的信息阎。
在SolidWorks中验证机器人运动学逆解主要包含以下几个
步骤[6I:SolidWorks完成模型建立并添加机器人各个关节驱动电
机,调整到需要的初始位姿;完成手术机器人末端点路径规划,借
助数据处理软件Matlab,绘制三维轨迹线,如图5所示。根据已得
的逆解公式,利用Matlab进行数值运算,求得各个关节驱动输入
值,保存为txt或CSV格式,并在首列插入时间序列,与Matlab中
总时长一致,以此作为虚拟样机的驱动样条曲线函数,导入到
Motion各个驱动电机中;最后对仿真参数进行设置,如时间和帧
数等,机构仿真轨迹,如图5所示。比较仿真得到轨迹和规划轨
迹。
基于SolidWorks Motion的机器人运动仿真过程比较繁琐,
因此,考虑开发集成了机器人轨迹规划、数值计算以及运动仿真
的应用程序,简化整个运动计算过程,并联合SolidWorks Motion
中模型完成运动控制和显示。
图5机器人末端规划轨迹及SolidWorks运动仿真轨迹对比 Fig.5 Comparison Study of Planned and Simulation Trajector
y l38 机械设计与制造 NO.3 Mar.201 3
4 LabVIEW联合SolidWorks完成机器人
轨迹规划及运动仿真
LabVIEW(Laboratory Virtual instrument Engineering Workbe—
nch)是一种图形化的编程语言和开发环境,由美国国家仪器(NI)
公司研制开发,是通用的编程系统,有一个可以完成任何编程任
务的庞大函数库I7f。
LabvIEw和SolidWorks联合运动仿真利用NI运动雨数,
进行轨迹设计和运动编程,联合SolidWorks Motion实现对机械部
件的仿真设计,最终确定机械功能部件的运动轨迹和运动参数。
4.1运动轨迹设计
NI SoflMotion提供了丰富的功能函数模块,主要包含:直线
运动(Straight—Line Move),使用轴或者坐标执行一个直线运动;
弧线运动(Arc Move),执行一个圆形弧、球面弧、椭圆弧运动;轮
廓线运动(ContourMove),结合轴或者坐标完成由指定位置组成
的轮廓线,需要使用指定位置的表格(Table)来实现。通过上述三
种基本的运动函数可以实现任何轨迹的运动Ial。
4.2仿真过程
联合仿真重要的一步就是建立LabVIEW程序和SolidWorks
联系,基本方法是:创建LabVIEW丁程,添加SolidWorks装配体,
映射并添加运动资源,控制编程与仿真设计,部署并运行仿真。
仿真主要分为两个阶段,首先是轨迹数据的生成。NI SofiM—
otion现有的运动函数组合可以实现一定末端轨迹。但是复杂运
动轨迹是以机器人数学模型为基础,已知末端刀具轨迹,求解各
个关节驱动输入轨迹。在程序框图中利用Mathscript节点完成机
构位置反解的运算。最后将各驱动轨迹数据通过数组操作,以表
单文件形式保存至指定文件。
然后,就可以对虚拟模型进行仿真。LabVIEW SoflMotion模
块中的Contour函数可实现曲线轨迹运动。允许将轨迹数据文件
加载到LabVIEW,并对轨迹文件进行参数设置,如速度、加速度
等,根据参数设置,生成经插值的曲线轨迹文件。
仿真的两个阶段通过事件结构完成各项任务。仿真前面板
和仿真结果,如图6所示。前面板包含基本参数设置和一般轨迹
线路的规划,LabVIEW后台程序已经完成和SolidWorks模型的
连接并能实现对模型的控制,运行该程序,可以直接观察机器人
刀具末端轨迹是否和预期的一致。
图6 LabVIEW和SolidWorks联合运动仿真界面 Fig.6 Man—Machine Interface of-the Motion Simulation
5结论
在SolidWorks中完成机器人三维建模,并利用Motion模块 对机器人进行了运动仿真,验证了逆解程序的正确性,为后续的
仿真和控制打下了良好的基础。
利用NI SoftMotion建立起了SolidWorks和LabVIEW之间
的联系,实现了基于接口方式的多领域交互式仿真设计环境的构
建。利用LabVIEW软件强大的前面板功能设计机器人运动仿真
人机交互界面,同时,NI SoftMotion丰富的运动控制甬数为机器
人末端复杂轨迹规划提供基础。整个过程可视化了机器人运动轮
廓,能得到机器人的机械动态特性,完成精确的压力栅矩性能需
求分析。
LabVIEW和SolidWorks的联合能够实现从机械到电气、控
制等领域的综合仿真设计。其机电一体化仿真的程序代码具有可
移植性,能直接配置到后续物理样机的控制系统开发中,缩短后
期的开发周期,这也是未来主要工作之。
参考文献
[1 1景扶苇,王伯华.医用手术机器人[J1.机器人技术与应用,2001(4):
17—19. (JingFu-wei,WangBo--hua.Medical。perati【II1H’h()t[-f{lRobotTechnique
and Application,2001(4):17-19 ) 2j胡德成, 燕,陈章平.混联机器人结构设计及优化f J1_机械设计与制
造,201 1(8):165—167. (Hu De-cheng,Diao Yah,Chen Zhang—ping.Design and optimization of
hybrid structure robot[Jj.Machinery Design&Manufacture,2011(8):
165—167.)
31刁燕,陈章平,姚林,等.一种新型混联手术机器人的运动学分析 J1l四 川大学学报,2010,42(4):214—218.
(Diao Yah,Chen Zhang—ping,Yao Lin,eta1.Kinematic analysis ofa new hybrid surgical robot lJ].Journal of Sichuan University,2010,42(4):
214—218.)
f4]张铁牛,陆中平,陈巧红.基于COSMOSMotion的3-PRRU并联机器人
运动仿真[n浙江理1二大学学报,2010,27(6):885—888.
(Zhang Tie-niu.Lu Zhong—ping.Chen Qiao—hong.Kinematics simulati— on of3-PRRU parallel mechanisms based on cOsM0SM0tion[J J.Journal
of Zhejiang Sci—Tech University,2010,27l 6):885—888.) [5]SolidWorks公司.COSMOS高级教程:cOsM0sMotion[M].北京:机械
工业出版社,2008.
(Dassault Systemes SolidWorks Corp.COSMOS 2007 Training Manuals: c0sM0sMotion[M].Beijing:China Machine Press,2008.) I6]张铁牛.3~PRRU并联机器人运动仿真与控制系统设计[D]lI浙江:浙
江理工大学,2010.
(Zhang Tie—niu.Motion simulation and control system design of 3一PRRU parallel manipulator[D].Zhejiang:ZhejiangSci—TechUniversity,2010 )
7]张凯,周陬,郭栋 LabVIEW虚拟仪器丁稗设计与开发[M].北京:国防
工业出版社,2004.
(Zhang Kai,Zhou Zou,Guo Dong.Design of virtual instrument based on
LabVIEW[M1lBeijing:NationalDefenceIndustryPress,2004.)
[8]壬慧能.基于虚拟原型的机电一体化设计技术研究fD].两安:西安电
子科技大学,201 1.
(Wang Hui-neng.A study ofmechatronics design based on virtual prototype 【D].Xian:Xidian University,201 1.)