摘要
为了能够在不修改工业机器人控制器的逆解算法的前提下对双机械臂系统进行位姿优化,同时要求以双臂各向同性指标为强化目标,设计出基于扩展任务的双臂姿态优化方法。首先对双臂机器人的协作任务进行了运动学分析与建模,然后基于最近被提出的一种新型的通用冗余机械臂位姿优化方法对双臂位姿优化进行数学描述,并表明了优化指标-双臂各向同性指标的几何和物理意义。再利用蒙特卡洛采样方法和非线性回归拟合出了主机械臂在操作空间的位姿与协作任务的位姿之间的数学关系,即扩展任务的数学模型。最后在ABB Robot Studio机器人仿真软件中对双臂系统进行主从协作运动任务的仿真,结果表明:利用扩展任务的优化方法可以实现以各向同性指标强化为目标的双臂系统的位姿优化,可以使两只机械臂都远离肘关节奇点和肩关节奇点,并且表明本质上还可以减小机械臂的条件数的值。
In order to optimize the pose of the dual manipulators system without modifying the inverse kinematics algorithms in the industrial robot controller. In the meantime the isotropic index of robot is enforced.A dual manipulators pose optimization Method based on augmented task is proposed. In this paper,firstly the kinematical analysis and modelling of the cooperative task of the dual manipulators are carried out,then the mathematic description of pose optimization is established based on a newpose optimization method for redundant manipulator. At last the relationship between the pose of the leader manipulator and the pose of the cooperative task is established based on Monte Carlo sampling and nonlinear regression method so the augmented task mathematical model is established. The leader-follower task simulation was performed in ABB Robot Studio,and the results shows that the pose optimization method can be realized and both manipulators are away from elbowsigularity and shoulder sigularity. In addition it shows that condition number of the manipulators is reduced.
引文
[1]Smith C.Dual arm manipulation-A survey[J].Robotics and Autonomous Systems,2012,60(10):1340-1353.
[2]Jamisola R S,R G Roberts.A more compact expression of relative Jacobian based on individual manipulator Jacobians[J].Robotics and Autonomous Systems,2015,63:158-164.
[3]Baillieul.J.Kinematic programming alternatives for redundant manipulators.in Proceedings[C].IEEE International Conference on Robotics and Automation,Boston:IEEE,1985:25-28.
[4]Zanchettin A M,P Rocco.A General User-Oriented Framework for Holonomic Redundancy Resolution in Robotic Manipulators Using Task Augmentation[J].IEEE Transactions on Robotics,2012,28(2):514-521.
[5]Zanchettin A M.Exploiting task redundancy in industrial manipulators during drilling operations[C].IEEE International Conference on Robotics and Automation(ICRA).Shanghai:IEEE,2011:128-133.
[6]Zanchettin A.On the Use of Functional Redundancy in Industrial Robotic Manipulators for Optimal Spray Painting[C].IFAC World Congress 2011.Milano,Italy,2011:11495-11500.
[7]Zanchettin A M,P Rocco.Dual-arm redundancy resolution based on null-space dynamically-scaled posture optimization[C].IEEE International Conference on Robotics and Automation(ICRA)Saint Paul:IEEE,2012:311-316.
[8]Jin-Oh Kim,P K Khosla.Dexterity measures for design and control of manipulators[J].IEEE International Workshop on Intelligent Robots and Systems,1991(2):759-763.
[9]O Egeland.Task-space tracking with redundant manipulator[J].IEEE journal on robotic and automation,2003,3:471-475.
[10]Seraji H.Kinematic functions for redundancy resolution using configuration control[P].US Patent:5294873,1994-03-15.
[11]梁新荣.机器人协调控制及其关节结构优化[J].五邑大学学报(自然科学版),1999,13(1):42-48.
[12]Siciliano.Robotics:Modelling,Planning and Control[M].London:Springer,2009.
[13]M Chen,B Schmeiser.General hit-and-run Monte Carlo sampling for evaluating multidimensional integrals[J].Operations Research Letters,1996,19(4):161-169.
[14]D Huybrechs,S Olver.Rapid function approximation by modified Fourier series[C].Proceedings of Highly Oscillatory Problems,Cambridge:Cambridge University Press2009:51-71.
[15]谢碧云,赵京.机器人运动灵活性问题研究概述[J].机械科学与技术,2011,30(8):1386-1393.