上海交通大学学报(自然版) ›› 2012, Vol. 46 ›› Issue (11): 1718-1722.

• 自动化技术、计算机技术 • 上一篇    下一篇

基于泰勒级数的3D匀速运动控制算法及误差分析

顾浩, 马艺馨   

  1. (上海交通大学 电子信息与电气工程学院,上海 200240)
  • 收稿日期:2012-01-04 出版日期:2012-11-30 发布日期:2012-11-30
  • 基金资助:

    教育部博士点新教师基金(200802481011),上海市浦江人才计划(08PJ1406900)资助项目

3D Uniform Motion Control Method Based on Taylor Series and Accuracy Analysis

 GU  Hao, MA  Yi-Xin   

  1. (School of Electronic, Information and Electrical Engineering, Shanghai Jiaotong University, Shanghai 200240, China)
  • Received:2012-01-04 Online:2012-11-30 Published:2012-11-30
  • Supported by:

    教育部博士点新教师基金(200802481011),上海市浦江人才计划(08PJ1406900)资助项目

摘要: 在高强度聚焦超声(HIFU)治疗肿瘤过程中,需要针对肿瘤形状制定最有效的照射轨迹,在最短时间内最精确地按照预定轨迹对肿瘤组织进行理疗.文中以一阶泰勒级数为插补算法基础,提出了具有实际意义的“曲线线速度”概念,并对任意参数曲线线速度误差进行改进,同时保证插补的步长误差与弦高误差在允许范围内.特别以空间椭圆螺旋线为例,详细推导了插补算法并分析插补误差.在S3C44B0X单片机控制的三维移动机构上,利用μC/OSⅡ RTOS内核控制运动,实现了包括直线、椭圆、空间螺旋线等匀速运动.实验结果表明,本算法能有效控制线速度的稳定性并同时保证步长误差和弦高误差在允许范围内.  
 

关键词: 移动机构, 参数方程, 线速度, 误差分析, 螺旋线

Abstract: In the process of using high intensity focused ultrasound (HIFU) system to ablate tumor tissue, the irradiation trajectory needs to be optimized based on tumor’s shape. So the tumor can be effectively treated in the shortest time. Based on the first-order-Taylor series interpolation algorithm, the actual "linear velocity" concept was proposed, and the linear velocity error was improved for any kind of movement along parametric curves. The new control method can also effectively maintain the step-size shift and chord deviation within the permitted range. Particularly, the derivative of interpolation algorithm for spatial spiral trajectory was explained in details and its accuracy was analyzed. The μC/OS II RTOS kernel was used to control the movement, and some movement, such as straight line, ellipse, spirals, etc., were realized to validate the proposed interpolation method and accuracy evaluation method. The experiments show that the stability of the linear velocity is also verified and it can also effectively maintain the step-size shift and chord deviation within the permitted range.  

Key words: mobile mechanism, parametric equation, linear velocity, error analysis, spiral

中图分类号: