• CN:11-2187/TH
  • ISSN:0577-6686

机械工程学报 ›› 2015, Vol. 51 ›› Issue (5): 14-21.doi: 10.3901/JME.2015.05.014

• 机构学及机器人 • 上一篇    下一篇

操作机器人轴孔装配的行为动力学控制策略

魏明明1,2 傅卫平1 蒋家婷1 杨世强1 王 雯1   

  1. 1.西安理工大学机械与精密仪器工程学院;
    2.西安工业大学机电工程学院
  • 出版日期:2015-03-05 发布日期:2015-03-05
  • 基金资助:
    国家自然科学基金(10872160)和陕西省自然科学基础研究计划重点(2011JZ012)资助项目

Dynamics of Behavior Control Strategy in Peg-in-hole Assembly Task of Manipulator

WEI Mingming1,2 FU Weiping1 JIANG Jiating1 YANG Shiqiang1 WANG Wen1   

  1. 1.School of Mechanical and Precision Instrument Engineering, Xi’an University of Technology;
    2.School of Mechatronic Engineering, Xi’an Technological University
  • Online:2015-03-05 Published:2015-03-05

摘要: 将移动机器人行为动力学理论扩展到操作机器人三维空间,并应用到机器人轴孔装配中。把轴孔装配过程分为趋向装配目标阶段和装配阶段。在趋向装配目标阶段,分别建立趋向装配目标点和避障的行为动力学模型,并将两种行为耦合构成机器人整体的竞争动力学模型;在装配阶段,建立末端执行器姿态调整动力学模型,并推导了侧向误差计算公式;在整个装配过程,利用宏/微平台和视觉/力觉伺服,对轴进行位姿调整,使其满足装配条件。仿真和试验结果表明:在行为动力学方程的控制下,末端执行器在避开障碍物的同时,安全有效地到达装配目标点,顺利完成轴孔装配,证明方法的有效性。

关键词: 操作机器人, 排斥子, 位姿调整, 吸引子, 行为动力学, 轴孔装配

Abstract: The theory of mobile robot behavioral dynamics is extended to three-dimensional space of manipulator, and applied to peg-in-hole assembly task. The assembly process is divided into the trend toward assembly target and assembly phase. In the phase of trend toward assembly target, the dynamic model of target acquisition and obstacle avoidance are established respectively, and these two kinds of behavior constitute a overall coupling and competitive robot dynamics model. In assembly phase, the posture adjustment dynamic model is established and the lateral error formula is deduced. Throughout the assembly process, the use of macro/micro platform and visual/force servo, posture control is carried out on the shaft, make it meet the assembly condition. Simulation and experimental results show that, under the control of the dynamics equation, the end-effector while avoiding obstacles, safe and effective to reach the target assembly, successfully completed the peg-in-hole assembly, demonstrating the effectiveness of the proposed method.

Key words: attractor, behavioral dynamics, manipulating robot, peg-in-hole assembly, posture adjustment, repellor

中图分类号: