基于MEMS的微创手术机器人位姿检测及精细控制

来源期刊：机械设计与制造2011年第12期

论文作者：王运飞 陈章平 罗华

文章页码：172 - 174

关键词：手术机器人;陀螺仪;数字积分;编码器;

摘    要：针对微创手术提出的高精度和高实时性要求,采用基于光电传感器和微机械陀螺的双重闭环控制模式,实现微创手术机器人的位姿检测与精细控制。编码器、光栅尺所检测的各关节实时位移,输入到运动控制卡中,构成第一层反馈环节;基于微机械陀螺检测的角速度信息,利用基于二次插值构造的数字积分方法,在DSP中进行积分得到角位移,供上位机调用,构成第二层反馈环节。试验验证该双闭环检测控制模式能有效弥补电机运转偏差和各杆件加工误差;构造的数字积分方法在满足实时性要求的前提下,具有很高的精度,最大偏差不超过0.0172°;可以很好的保证微创手术机器人的微小动作要求。