系统仿真学报 ›› 2021, Vol. 33 ›› Issue (12): 2864-2879.doi: 10.16182/j.issn1004731x.joss.20-0457

• 仿真建模理论与方法 • 上一篇    下一篇

自动跟踪口腔手术灯的运动学分析与仿真

蒋泽睿, 杨立军, 李俊, 焦晓龙, 郑航   

  1. 陕西科技大学 机电工程学院,陕西 西安 710043
  • 收稿日期:2020-07-08 修回日期:2020-08-24 出版日期:2021-12-18 发布日期:2022-01-13
  • 作者简介:蒋泽睿(1995-),男,硕士生,研究方向为机器人运动学。E-mail:kerfg@qq.com
  • 基金资助:
    陕西省教育厅专项科研计划(2020KJRC0008)

Kinematics Analysis and Simulation of Automatically Tracking Dental Surgery Lamp

Jiang Zerui, Yang Lijun, Li Jun, Jiao Xiaolong, Zheng Hang   

  1. Shaanxi University of Science & Technology, Xi'an 710043, China
  • Received:2020-07-08 Revised:2020-08-24 Online:2021-12-18 Published:2022-01-13

摘要: 为解决口腔手术灯无法根据人脸方向和口腔位置自动调整手术灯照射姿态的问题,提出一种六自由度自动跟踪视觉机械臂的方案通过双目视觉实现坐标转换,获得口腔位置和人脸面部法向量的三维信息。在运动学计算中引入几何法,得到了逆运动学的封闭解,通过Maltab编程并带入数值验证了其正确性。对机械臂进行了五次多项式运动规划,分析了轨迹控制效果,距离误差在28.73 mm内,方向偏移在1.369 7°内。该方案通过仿真实验后可以完成自动定位、跟踪、对正,为自动跟踪口腔手术灯提供了理论基础。

关键词: 机械臂, 口腔手术灯, 双目视觉, 机器人运动学, 轨迹规划, 仿真

Abstract: In order to solve the problem that the oral surgical lamp cannot automatically adjust the irradiation posture of the surgical lamp according to the face direction and oral cavity position, a six-degree-of-freedom automatic tracking visual manipulator solution is proposed. Coordinate conversion is achieved through binocular vision to obtain three-dimensional information of oral cavity position and face normal vector. The geometric method is introduced into the kinematics calculation, and the closed solution of the inverse kinematics is obtained. The correctness is verified by the Maltab programming and the introduction of numerical values. Five-degree polynomial motion planning is performed on the manipulator, and the effect of trajectory control is analyzed. The distance error is within 28.73 mm, and the direction deviation is within 1.369 7°. After simulation, the solution can complete automatic positioning, tracking, and alignment as expected, providing a theoretical basis for automatically tracking oral surgical lights.

Key words: robotic arm, dental surgery lamp, binocular vision, robot kinematics, trajectory planning, simulation

中图分类号: