Zou Chengwen,Tao Ping.Cooperative Space Analysis and Simulation of Multi Manipulator[J].Journal of Mechanical Transmission,2022,46(02):78-84. DOI: 10.16578/j.issn.1004.2539.2022.02.013.
Cooperative Space Analysis and Simulation of Multi Manipulator
Monte Carlo method and envelope method are used to analyze the cooperative space and singular points of multi manipulator cooperative system model. The standard D-H parameter method is used to establish the coordinate system, the kinematics model of the robot is established in Matlab, and the forward kinematics equation of the robot is obtained. The workspace of each manipulator is obtained by Monte Carlo method, the common area points are extracted by envelope method, and the cooperation space of the multi manipulator cooperation system and the joint angle range of each manipulator in the cooperation space are obtained. An algorithm to calculate the operability is presented. According to the algorithm, the singularity distribution of multi manipulator in the cooperative space is calculated and analyzed. The Matlab/Robotics toolbox is used to build the simulation platform, and the algorithm is compiled for simulation analysis, which verifies the correctness and rationality of the kinematics model analysis of the multi robot cooperative system, the feasibility of the proposed algorithm is proved and the foundation for the subsequent coordinated operation and trajectory planning to avoid singular points is laid.
关键词
多机械臂协作系统蒙特卡罗法包络法协作空间可操作度奇异点
Keywords
Multi manipulator cooperative systemMonte Carlo methodEnvelope methodCooperative spaceManipulabilitySingular point
PAN Jianlong,GAN Yahui,CHEN Ming,et al.Initial welding position selection and optimal trajectory planning of multi-robots cooperative welding system[C]//Proceedings of the 36th China Control Conference(E).Dalian:[s.n.],2017:193-199.
KARIM A M,YEH H J.Analytical boundary of the workspace for general 3-DOF mechanisms[J].International Journal of Robotics Research,1997,16(2):198-213.
LU Jun,CHI Hongxun,XI Wenming,et al.Numerical calculation method for cooperative workspace of dual arm robot[J].China Mechanical Engineering,2001,12(S1):125-127.
LI Baofeng,SUN Hanxu,JIA Qingxuan.Workspaceanalysis of space robot based on Monte Carlo method and VM[C].Beijing:Beijing Institute of Spacecraft Design,2011:205-211.
CAO Yi,LI Xiujuan,NING Yi,et al.Workspace and geometric error analysis of 3D robot[J].Mechanical Science and Technology for Aerospace Engineering,2006,25(12):1458-1461.
ZHOU Lü,ZHOU Yuming,WANG Liang,et al.Workspace analysis of dual arm robot based on monte carlo method[J].Journal of Mechanical Transmission,2014,38(6):85-87.
MAO Longrui,XUE Tao,CAO Xiufang,et al.Workspace analysis of 7-DOF hydraulic heavy-duty manipulator based on MATLAB[J].Journal of Tianjin University of Technology,2020,36(3):40-44.
YUAN Dandan,DENG Sanpeng,WANG Zhongmin.Workspace analysis of modular robot based on Monte Carlo method[J].Machine Tools and Hydraulics,2017,45(11):9-12.
LI Xianhua,SUN Qing,FAN Kaijie,et al.Cooperative space analysis and simulation of dua arm 6R service robot[J].Journal of Mechanical Transmission,2018,42(9):130-134.
GE Lianzheng,CHEN Jian,LI Ruifeng.Research on humanoid dual arm kinematics of mobile robot[J].Journal of Huazhong University of Science and Technology(Natural Science Edition),2011,39(S2):1-4.
艾文君.基于特定任务的工业机器人基座位置优化研究[D].北京:北京林业大学,2018:7-9.
AI Wenjun.Research on position optimization of industrial robot base based on specific task[D].Beijing:Beijing Forestry University,2018:7-9.
YOSHIKAWA T.Manipulability of robotic mechanisms[J].International Journal Robotics Resenrch,1985,4(2):3-9.
LI Xianhua,SHU Yang,ZHANG Leigang,et al.The construction method of global relative operability map of the manipulator workspace[J].Journal of Anhui University of Science and Technology(Natural Science),2016,36(1):56-61.