Kinematics Analysis and Simulation of Automatically Tracking Dental Surgery Lamp

doi:10.16182/j.issn1004731x.joss.20-0457

Abstract

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

CLC Number:

TH39
TP391

Jiang Zerui, Yang Lijun, Li Jun, Jiao Xiaolong, Zheng Hang. Kinematics Analysis and Simulation of Automatically Tracking Dental Surgery Lamp[J]. Journal of System Simulation, 2021, 33(12): 2864-2879.

References

[1] 卢文娟, 刘思胜, 周恒艳, 等. 牙科口腔灯标准研析[J]. 中国医疗器械信息, 2017, 23(5): 77-79.
Lu Wenjuan, Liu Sisheng, Zhou Hengyan, et al.Research on Standard of Dentistry-operating Light[J]. China Medical Device Information, 2017, 23(5): 77-79.
[2] 武雪梅, 刘奇. 基于立体视觉的手术导航光学定位系统[J]. 中国组织工程研究与临床康复, 2011, 15(35): 6584-6587.
Wu Xuemei, Liu Qi.Optical Localizer of Surgical Navigation System Based on Binocular Stereo Vision[J]. Journal of Clinical Rehabilitative Tissue Engineering Research, 2011, 15(35): 6584-6587.
[3] 章炜. 机器视觉技术发展及其工业应用[J]. 红外, 2006, 27(2): 11-17.
Zhang Wei.Development of Machine Vision and Its Industrial Applications[J]. Infrar, 2006, 27(2): 11-17.
[4] 卢望, 叶宏武. 人体跟踪的智能照明系统设计[J]. 宁波工程学院学报, 2007, 6(2): 13-17.
Lu Wang, Ye Hongwu.Design of Intelligent Lighting System for Human Body Tracking[J]. Journal of Ningbo University of Technology, 2007, 6(2): 13-17.
[5] 时凯飞, 李瑞峰. 7自由度仿人手臂运动学研究[J]. 哈尔滨工业大学学报, 2003, 35(7): 806-808.
Shi Kaifei, Li Ruifeng.Kinematies of Service Robot Bionics Arm[J]. Journal of Harbin Institute of Technology, 2003, 35(7): 806-808.
[6] 潘峰, 武威, 杨轶璐, 等. 视觉定位脑外科手术机器人系统的坐标映射[J]. 东北大学学报(自然科学版), 2005, 26(5): 413-416.
Pan Feng, Wu Wei, Yang Yielu, et al.Coordinate Mapping for Visual Positioning Brain Surgery Robot System[J]. Journal of Northeastern University (Natural Science), 2005, 26(5): 413-416.
[7] Dalal N, Triggs B.Histograms of Oriented Gradients for Human Detection[C]// IEEE Computer Society Conference on Computer Vision & Pattern Recognition. San Diego, CA, USA: IEEE, 2005.
[8] 李胜旺, 陈凯悦. 一种基于双目视觉原理的距离测量系统的设计[J]. 信息通信, 2017, 30(8): 61-63.
Li Shengwang, Chen Kairui.Design of a Distance Measuring System Based on the Principle of Binocular Vision[J]. Information & Communications, 2017, 30(8): 61-63.
[9] 潘磊, 钱炜, 张志艳, 等. 四自由度机械臂运动学分析及Matlab仿真[J]. 机械科学与技术, 2013, 32(3): 421-425.
Pan Lei, Qian Wei, Zhang Zhiyan, et al.Simulating Kinematics of 4-DOF Manipulator[J]. Mechanical Science and Technology for Aerospace Engineering, 2013, 32(3): 421-425.
[10] 陈鹏, 刘璐, 余飞, 等. 一种仿人机械臂的运动学逆解的几何求解方法[J]. 机器人, 2012, 34(2): 211-216.
Chen Peng, Li Lu, Yu Fei.A Geometrical Method for Inverse Kinematics of a Kind of Humanoid Manipulator[J]. Robot, 2012, 34(2): 211-216.
[11] 崔泽, 韩增军. 基于自运动的仿人七自由度机械臂逆解算法[J]. 上海大学学报(自然科学版), 2012, 18(6): 589-595.
Cui Ze, Han Zengjun.Inverse Kinematics Algorithm of 7-DOF Manipulator Based on Self-Motion[J]. Journal of Shanghai University (Natural Science Edition), 2012, 18(6): 589-595.
[12] Fu Z T, Yang W Y, Yang Z.Solution of Inverse Kinematics for 6R Robot Manipulators with Offset Wrist Based on Geometric Algebra[J]. Journal of Mechanisms and Robotics (S1942-4302), 2013, 5(3): 310081-310087.
[13] De L A.Nonholonomic Behavior in Redundant Robots Under Kinematic Control[M]. Britain: AD Luca, 2013.
[14] Xiao Y Q, Du Z J, Dong W.Smooth and Near Time-optimal Trajectory Planning of Industrial Robots for Online Applications[J]. Emerald (S0143-991X), 2013, 39(2): 169-177.
[15] 刘子贵. 基于关节空间工业机器人轨迹规划的研究与仿真[J]. 机械工程与自动化, 2017, 3(3): 59-61.
Liu Zigui.Research and Simulation of Trajectory Planning of Industrial Robot Based on Joint Space[J]. Mechanical Engineering & Automation, 2017, 3(3): 59-61.