CN110625611A - 基于激光跟踪测量与力传感联合控制的机械臂辅助部件装配方法及*** - Google Patents

基于激光跟踪测量与力传感联合控制的机械臂辅助部件装配方法及*** Download PDF

Info

Publication number
CN110625611A
CN110625611A CN201910797163.XA CN201910797163A CN110625611A CN 110625611 A CN110625611 A CN 110625611A CN 201910797163 A CN201910797163 A CN 201910797163A CN 110625611 A CN110625611 A CN 110625611A
Authority
CN
China
Prior art keywords
mechanical arm
assembly
pose
assembled
measurement
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Pending
Application number
CN201910797163.XA
Other languages
English (en)
Inventor
刘仁伟
谢永权
陈小弟
侯鹏
杨凯
袁佳晶
裴佩
张蓉
***
张敬伟
杨兴
成功
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Shanghai Institute of Satellite Equipment
Original Assignee
Shanghai Institute of Satellite Equipment
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Shanghai Institute of Satellite Equipment filed Critical Shanghai Institute of Satellite Equipment
Priority to CN201910797163.XA priority Critical patent/CN110625611A/zh
Publication of CN110625611A publication Critical patent/CN110625611A/zh
Pending legal-status Critical Current

Links

Classifications

    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J13/00—Controls for manipulators
    • B25J13/08—Controls for manipulators by means of sensing devices, e.g. viewing or touching devices
    • B25J13/085—Force or torque sensors
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J18/00—Arms
    • B25J18/007—Arms the end effector rotating around a fixed point
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00—Programme-controlled manipulators
    • B25J9/16—Programme controls
    • B25J9/1602—Programme controls characterised by the control system, structure, architecture
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00—Programme-controlled manipulators
    • B25J9/16—Programme controls
    • B25J9/1656—Programme controls characterised by programming, planning systems for manipulators
    • B25J9/1664—Programme controls characterised by programming, planning systems for manipulators characterised by motion, path, trajectory planning
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00—Programme-controlled manipulators
    • B25J9/16—Programme controls
    • B25J9/1679—Programme controls characterised by the tasks executed
    • B25J9/1684—Tracking a line or surface by means of sensors
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00—Programme-controlled manipulators
    • B25J9/16—Programme controls
    • B25J9/1679—Programme controls characterised by the tasks executed
    • B25J9/1687—Assembly, peg and hole, palletising, straight line, weaving pattern movement
    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S17/00—Systems using the reflection or reradiation of electromagnetic waves other than radio waves, e.g. lidar systems
    • G01S17/66—Tracking systems using electromagnetic waves other than radio waves

Landscapes

  • Engineering & Computer Science (AREA)
  • Robotics (AREA)
  • Mechanical Engineering (AREA)
  • Physics & Mathematics (AREA)
  • Electromagnetism (AREA)
  • Computer Networks & Wireless Communication (AREA)
  • General Physics & Mathematics (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Human Computer Interaction (AREA)
  • Automation & Control Theory (AREA)
  • Manipulator (AREA)

Abstract

本发明提供了一种基于激光跟踪测量与力传感联合控制的机械臂辅助部件装配方法及***，包括：设置步骤；设置力传感器步骤；测量处理步骤；拟合路径步骤；安装夹持步骤；位姿微调步骤；调整到预定装配初始位姿步骤；逐步对齐步骤；卸载卸除步骤；测量数据存储步骤。本发明能够实现大型部件装配中位姿高精度、装配低应力的控制目标，提高装配效率。本发明的方法在航天、航空装备制造领域大型部件装配中具有广泛的应用前景。

Description

基于激光跟踪测量与力传感联合控制的机械臂辅助部件装配 方法及***
技术领域
本发明涉及智能装备及航天器装配技术领域，具体地，涉及基于激光跟踪测量与力传感联合控制的机械臂辅助部件装配方法及***，尤其是一种基于激光跟踪测量与力传感联合控制的机械臂辅助大部件装配方法。
背景技术
大型航天器装备具有高精度、大承载结构特征，在装配过程中对空间相对位置精度、安装面接触应力控制范围等有较高的要求，大型结构舱板、大型重载单机等部件装配目前多采用桁吊、专用安装支架车等多种工艺装备结合人工操作等工艺方式，实现对装配过程中待装配部件重力的卸载、空间姿态的调整、姿态的稳定以及装配紧固。桁吊、专用支架车结合人工经验指导的装配方法存在以下问题：
1、装配过程中待装配部件的移动、姿态调整依赖人眼判断和人工操作经验，桁吊、专用安装支架车等工艺装备无法实现空间姿态量化显示及调姿幅度量化控制。
2、装配调姿工序过程较长，一般需经过多次反复人工调整才能达到可装配的精度，且伴随的桁吊、专用支架车等工艺装备多次启停，产生卸载力、装配面接触应力的频繁波动，对装配部件存在冲击应力损伤风险，并易对装配面造成磕碰损伤。
3、装配过程涉及吊装作业、专用支架车操作、装配空间多个位置观测、位置调整与装配连接等操作，人员需求量大、劳动强度大、操作效率不高。
专利文献CN106625653A公开了一种基于力反馈的工业机器人辅助装配柔性对接方法。通过采用六维传感器反馈信息,由实际作用力与理想作用力之间的误差对工业机器人的运动轨迹进行实时修正,使接触力保持在期望范围内,实现柔性对接。该方法只使用力传感器单一方式反馈控制，未对装配过程中工件的位姿数据、装配精度进行量化采集与控制，装配移动路径及调姿过程均由人手操控机器人实现，机器人移动的平稳性和装配精度不够理想。因此，针对大型航天器部件装配的特点和要求，减少对人工操作依赖，进行各装配对象的空间姿态测量、机械臂运动路径规划与平稳运动、装配应力的量化控制与位姿精确微调，是机械臂辅助大部件装配需要解决的一个问题。
发明内容
针对现有技术中的缺陷，本发明的目的是提供一种基于激光跟踪测量与力传感联合控制的机械臂辅助部件装配方法及***。
根据本发明提供的一种基于激光跟踪测量与力传感联合控制的机械臂辅助部件装配方法，包括：设置步骤：在机械臂、待装配部件、目标装配体***可观测区域设置跟踪仪，与工控机上测量***进行连接；设置力传感器步骤：在机械臂末端法兰与末端执行器之间设置力传感器，力传感器与工控机上机械臂装配控制***进行连接；测量处理步骤：对机械臂末端执行器、待装配部件、目标装配体的位姿以及待装配部件、目标装配体上配合安装孔位置点进行测量，测量数据通过测量软件处理，将位姿测量数据统一转化成基于目标装配体坐标系的表达，获取供机械臂装配控制***读取信息，可以存储为可供机械臂装配控制***读取的中间格式文件；拟合路径步骤：根据供机械臂装配控制***读取信息，机械臂辅助装配控制***读取位姿测量数据，通过运行位姿拟合与路径规划算法，规划目标装配引导区域、预定装配初始位姿、待装配部件的空间运动路径；安装夹持步骤：通过示教器，人工控制机械臂末端移动至待装配部件放置区域预定位置，完成待装配部件的安装夹持，然后控制机械臂末端竖直向上平移预定距离，通过力传感器测量数据计算待装配部件的质心、重量，获取待装配部件质心信息、待装配部件重量信息；位姿微调步骤：根据待装配部件质心信息、待装配部件重量信息，机械臂辅助装配控制***设置待装配部件移动至目标装配引导区域，待装配部件位姿微调工序过程中机械臂末端运动控制参数、力传感控制参数，获取位置微调信息；调整到预定装配初始位姿步骤：根据位置微调信息，机械臂辅助装配控制***将控制参数及指令传输至机械臂控制器，机械臂末端执行器夹持待装配部件一次性平稳移动至目标装配引导区域内，调整到预定的、具有较理想的装配初始位姿；逐步对齐步骤：机械臂辅助装配控制***将控制参数及指令传输至机械臂控制器，启用人工牵引机械臂运动模式，启用力传感反馈控制，由人手动引导机械臂末端执行器对部件姿态微调，使待装配部件与目标装配体上相应配合安装孔逐步对齐，安装面逐步贴近、接触，达到紧固件安装精度范围后，将待装配部件与目标装配体紧固连接；卸载卸除步骤：机械臂辅助装配控制***将控制参数及指令传输至机械臂控制器，对机械臂末端执行器进行已装配部件的重力卸载，人工卸除末端执行器与所夹持工件间的连接件，机械臂运动返回至初始位姿；测量数据存储步骤：对装配部件实际装配位姿进行测量，得出相对于目标装配体坐标系的实际安装位姿精度，获取装配部件实际装配位姿测量结果信息；根据装配部件实际装配位姿测量结果信息，将测量结果传递给机械臂辅助装配控制***，获取装配质量数据包信息，***将装配初始位姿测量数据、机械臂运动路径及工艺参数、力控数据、最终位姿测量数据作为装配质量数据包以文件形式输出存储。
优选地，包括：生成最优轨迹步骤：根据工艺参数、现场空间限制参数，设置运动路径上的位置点，机械臂辅助装配控制***将运动路径点矩阵通过指令传输至机械臂运动控制器，生成可操作机械臂运动的轨迹；所述路径规划是控制机械臂末端夹持待装配部件依次移动的一个或者多个空间位置点及在各位置点相应的速度方向向量，可由N×6维矩阵表示。
优选地，包括：确定目标装配引导区域步骤：根据工艺参数、现场空间限制参数，设置目标装配引导区域；所述的目标装配引导区域是预设置的在目标装配体安装面外法向具有预定安全距离和可进行待装配部件位姿调整的立体空间范围。
优选地，所述跟踪仪采用便携式激光跟踪仪；所述跟踪仪的精度高于某一设定阈值；所述跟踪仪的测量尺寸范围大于某一设定阈值；所述跟踪仪通过跟踪靶标依次采集各测量对象特征位置的空间坐标。
优选地，所述机械臂采用串联式机械臂，所述机械臂具有6个自由度，所述机械臂的承载能力大于额定负载，所述额定负载大于300kg。
优选地，所述的基于激光跟踪测量与力传感联合控制的机械臂辅助部件装配方法，其特征在于，所述力传感器是六维力传感器，所述力传感器能够测量三个正交力分量，以及三个正交力矩分量。
优选地，所述位姿是与测量对象固连的空间直角坐标系，所述位姿具有6个特征值，所述位姿用坐标系原点空间3个坐标值及3个正交坐标轴方位向量表达，所述位姿通过测量被测对象上至少3个不在同一直线方向上的空间坐标点来拟合。
优选地，所述的预定装配初始位姿是将目标装配体安装面上M个安装孔的空间位姿坐标P1沿安装面外法向平移距离D得到P1′，将待装配体安装面上M个安装孔的空间位姿P0，令T为待求的空间转换6维齐次矩阵，通过算法对P0×T与P1′进行最佳拟合，得出T为引导区理想装配初始位姿转换矩阵。
优选地，所述的人工牵引机械臂运动模式为结合力传感反馈控制，通过力传感器测量由人或目标装配体作用于末端执行器或待装配部件上外力或外力矩的变化，控制机械臂末端执行器姿态的微调，以减少或消除外力和外力矩变化，使得人工牵引机械臂运动模式下姿态的微调。
根据一种基于激光跟踪测量与力传感联合控制的机械臂辅助部件装配***，包括：控制器；
所述控制器执行基于激光跟踪测量与力传感联合控制的机械臂辅助部件装配方法。
与现有技术相比，本发明具有如下的有益效果：
1、本发明通过采用基于激光跟踪测量与力传感联合控制方法，能够同时较好的满足大型部件装配中位姿高精度、装配低应力的技术要求，适用于大型航天器部件装配的特点，大幅提高装配效率；
2、本发明采用激光跟踪测量的数据，通过位姿拟合与路径规划，合理设置目标装配引导区域，在装配前期阶段，能够使机械臂通过算法控制将待装配部件一次性移动至目标装配引导区域内具有较理想的装配初始位姿，减少人工控制机械臂运动调整的工序，并增加机械臂移动的平稳性，能减少待装配部件大范围移动中频繁受到冲击应力；
3、本发明在装配位姿微调阶段，通过采用人工牵引机械臂运动模式，结合力传感反馈控制，将机械臂运动稳定可靠、定位精度高的特点,与人观察、操作的灵活性有效结合，实现精确调姿，并始终将装配作用力和力矩控制在规定范围内，有效提升装配质量。
附图说明
通过阅读参照以下附图对非限制性实施例所作的详细描述，本发明的其它特征、目的和优点将会变得更明显：
图1为本发明涉及的一种基于激光跟踪测量与力传感联合控制的机械臂辅助大部件装配***组成示意图。
图2为本发明所提供的基于激光跟踪测量与力传感联合控制的机械臂辅助部件装配方法的方法流程图。
具体实施方式
下面结合具体实施例对本发明进行详细说明。以下实施例将有助于本领域的技术人员进一步理解本发明，但不以任何形式限制本发明。应当指出的是，对本领域的普通技术人员来说，在不脱离本发明构思的前提下，还可以做出若干变化和改进。这些都属于本发明的保护范围。
根据本发明提供的一种基于激光跟踪测量与力传感联合控制的机械臂辅助部件装配方法，包括：设置步骤：在机械臂、待装配部件、目标装配体***可观测区域设置跟踪仪，与工控机上测量***进行连接；设置力传感器步骤：在机械臂末端法兰与末端执行器之间设置力传感器，力传感器与工控机上机械臂装配控制***进行连接；测量处理步骤：对机械臂末端执行器、待装配部件、目标装配体的位姿以及待装配部件、目标装配体上配合安装孔位置点进行测量，测量数据通过测量软件处理，将位姿测量数据统一转化成基于目标装配体坐标系的表达，获取供机械臂装配控制***读取信息，可以存储为可供机械臂装配控制***读取的中间格式文件；拟合路径步骤：根据供机械臂装配控制***读取信息，机械臂辅助装配控制***读取位姿测量数据，通过运行位姿拟合与路径规划算法，规划目标装配引导区域、预定装配初始位姿、待装配部件的空间运动路径；安装夹持步骤：通过示教器，人工控制机械臂末端移动至待装配部件放置区域预定位置，完成待装配部件的安装夹持，然后控制机械臂末端竖直向上平移预定距离，通过力传感器测量数据计算待装配部件的质心、重量，获取待装配部件质心信息、待装配部件重量信息；位姿微调步骤：根据待装配部件质心信息、待装配部件重量信息，机械臂辅助装配控制***设置待装配部件移动至目标装配引导区域，待装配部件位姿微调工序过程中机械臂末端运动控制参数、力传感控制参数，获取位置微调信息；调整到预定装配初始位姿步骤：根据位置微调信息，机械臂辅助装配控制***将控制参数及指令传输至机械臂控制器，机械臂末端执行器夹持待装配部件一次性平稳移动至目标装配引导区域内，调整到预定的、具有较理想的装配初始位姿；逐步对齐步骤：机械臂辅助装配控制***将控制参数及指令传输至机械臂控制器，启用人工牵引机械臂运动模式，启用力传感反馈控制，由人手动引导机械臂末端执行器对部件姿态微调，使待装配部件与目标装配体上相应配合安装孔逐步对齐，安装面逐步贴近、接触，达到紧固件安装精度范围后，将待装配部件与目标装配体紧固连接；卸载卸除步骤：机械臂辅助装配控制***将控制参数及指令传输至机械臂控制器，对机械臂末端执行器进行已装配部件的重力卸载，人工卸除末端执行器与所夹持工件间的连接件，机械臂运动返回至初始位姿；测量数据存储步骤：对装配部件实际装配位姿进行测量，得出相对于目标装配体坐标系的实际安装位姿精度，获取装配部件实际装配位姿测量结果信息；根据装配部件实际装配位姿测量结果信息，将测量结果传递给机械臂辅助装配控制***，获取装配质量数据包信息，***将装配初始位姿测量数据、机械臂运动路径及工艺参数、力控数据、最终位姿测量数据作为装配质量数据包以文件形式输出存储。
本发明从航天器大部件装配的需求出发，结合机械臂具有承载重量大、定位精度高、稳定可靠、响应速度快等特点，提出一种基于激光跟踪测量与力传感联合控制的机械臂辅助大部件装配方法。采用这种方法，可以对待装配部件、目标装配体的位姿进行跟踪测量，通过路径优化算法控制机械臂夹持待装配部件平稳移动至目标装配引导区域，并使待装配部件一次性移动至引导区域内具有较理想的装配初始位姿，在部件姿态微调及装配紧固阶段，通过人工牵引机械臂运动模式结合力传感反馈控制，始终将装配作用力和力矩控制在规定范围内，从而实现大型部件装配中位姿高精度、装配低应力的控制。
优选地，包括：生成最优轨迹步骤：根据工艺参数、现场空间限制参数，设置运动路径上的位置点，机械臂辅助装配控制***将运动路径点矩阵通过指令传输至机械臂运动控制器，生成可操作机械臂运动的轨迹；所述路径规划是控制机械臂末端夹持待装配部件依次移动的一个或者多个空间位置点及在各位置点相应的速度方向向量，可由N×6维矩阵表示。
优选地，包括：确定目标装配引导区域步骤：根据工艺参数、现场空间限制参数，设置目标装配引导区域；所述的目标装配引导区域是预设置的在目标装配体安装面外法向具有预定安全距离和可进行待装配部件位姿调整的立体空间范围。
优选地，所述跟踪仪采用便携式激光跟踪仪；所述跟踪仪的精度高于某一设定阈值；所述跟踪仪的测量尺寸范围大于某一设定阈值；所述跟踪仪通过跟踪靶标依次采集各测量对象特征位置的空间坐标。
优选地，所述机械臂采用串联式机械臂，所述机械臂具有6个自由度，所述机械臂的承载能力大于额定负载，所述额定负载大于300kg。
优选地，所述的基于激光跟踪测量与力传感联合控制的机械臂辅助部件装配方法，其特征在于，所述力传感器是六维力传感器，所述力传感器能够测量三个正交力分量，以及三个正交力矩分量。
优选地，所述位姿是与测量对象固连的空间直角坐标系，所述位姿具有6个特征值，所述位姿用坐标系原点空间3个坐标值及3个正交坐标轴方位向量表达，所述位姿通过测量被测对象上至少3个不在同一直线方向上的空间坐标点来拟合。
优选地，所述的预定装配初始位姿是将目标装配体安装面上M个安装孔的空间位姿坐标P1沿安装面外法向平移距离D得到P1′，将待装配体安装面上M个安装孔的空间位姿P0，令T为待求的空间转换6维齐次矩阵，通过算法对P0×T与P1′进行最佳拟合，得出T为引导区理想装配初始位姿转换矩阵。
优选地，所述的人工牵引机械臂运动模式为结合力传感反馈控制，通过力传感器测量由人或目标装配体作用于末端执行器或待装配部件上外力或外力矩的变化，控制机械臂末端执行器姿态的微调，以减少或消除外力和外力矩变化，使得人工牵引机械臂运动模式下姿态的微调。
具体地，在一个实施例中，如图1所示，根据本发明提供的基于激光跟踪测量与力传感联合控制的机械臂辅助大部件装配***能够执行本发明提供的一种基于激光跟踪测量与力传感联合控制的机械臂辅助部件装配方法，包括：激光跟踪仪、工控机、机械臂控制器、工业机械臂、力传感器、末端执行器、待装配部件等组成。其中，激光跟踪仪设置在机械臂、待装配部件、目标装配体***可观测区域，与工控机上测量***软件进行连接通信，可测量机械臂末端执行器、待装配部件、目标装配体的空间位姿。力传感器安装在机械臂末端法兰与末端执行器之间，与工控机上机械臂辅助装配控制软件进行连接通信，可检测末端执行器及待装配部件的重力及人工牵引力、装配应力等外部作用力。
本发明可以依据航天器大部件装配的要求，对待装配部件、目标装配体的位姿进行跟踪测量，通过路径优化算法控制机械臂夹持待装配部件平稳移动至装配引导区域，并使待装配部件一次性移动至引导区域内具有较理想的初始装配位姿，在部件姿态微调及装配紧固阶段，通过人工牵引机械臂运动模式结合力传感反馈控制，始终将装配作用力和力矩控制在规定范围内，从而实现大型部件装配中位姿高精度、装配低应力的控制。
一种基于激光跟踪测量与力传感联合控制的机械臂辅助大部件装配方法流程图如图2所示，实施步骤如下：
步骤1：空间位姿激光跟踪测量步骤：激光跟踪仪分别对机械臂末端执行器、待装配部件、目标装配体上能够表征相应位姿的3个特征点以及待装配部件、目标装配体上M对配合安装孔位点进行测量，重复测量3组，并对异常、突变的数据进行剔除后取各组平均值作为相应点的测量数据，测量数据通过专业测量软件处理，将测量数据统一转化成基于目标装配体坐标系的表达，存储为可供机械臂装配控制***读取的中间格式文件；
步骤2：装配位姿拟合步骤：工业测量软件读取中间格式测量数据文件，通过工业测量软件常用的3点拟合空间坐标系的方法，拟合机械臂末端执行器、待装配部件相对于目标装配坐标系的空间初始位姿；
步骤3：目标装配引导区设置步骤：机械臂辅助装配控制***中预设置与目标装配体安装面外法向具有一定安全距离和可进行待装配部件位姿调整的立体空间范围，安全距离的大小可依据工艺要求和现场空间限制条件等因素来确定，并设置目标装配引导区内机械臂末端的运动参数范围；
步骤4：目标装配引导区较理想装配初始位姿计算步骤：将目标装配体安装面上M个安装孔的空间位姿坐标P1沿安装面外法向平移距离D得到P1′，将待装配体安装面上M个安装孔的空间位姿P0，令T为待求的空间转换6维齐次矩阵，通过算法对P0×T与P1′进行最佳拟合，得出T为引导区理想装配初始位姿转换矩阵；
步骤5：运动路径规划步骤：依据工艺要求和现场空间限制条件等因素来指定待装配部件运动至引导区理想装配初始位姿路径中经过的N个位置点坐标及在各位置点相应速度的方向向量，可由N×6维矩阵表示；本步骤路径规划优化也可由专门的算法实现，本方法中不做详细阐述；
步骤6：机械臂夹持待安装部件步骤：通过示教器人工控制机械臂末端移动至待装配部件放置区域相应位置，完成待装配部件的安装夹持，然后控制机械臂末端竖直向上平移一定距离，并绕机械臂末端执行器3个坐标轴方向做微小角度的转动，通过力传感器测量数据计算待装配部件的质心、重量；
步骤7：机械臂夹持待安装部件移动至目标装配引导区域、调整至较理想初始装配位姿步骤：机械臂辅助装配控制***将控制参数、运动路径、理想初始装配位姿等指令传输至机械臂控制器，机械臂末端执行器夹持待装配部件平稳移动至装配引导区域内并一次性调整至较理想初始装配位姿P0×T；
步骤8：人工牵引机械臂运动模式结合力传感反馈控制姿态微调、连接装配步骤：机械臂转换至人工牵引运动模式，启用力传感反馈控制，控制***通过力传感器感受由人手或目标装配体作用于末端执行器或待装配部件上附加外力或外力矩变化，通过运行相应的闭环控制算法，控制机械臂末端执行器姿态随人手牵引对部件姿态微调，以减少或消除外力和外力矩变化，使部件与目标装配体上相应配对安装孔逐步对齐，安装面逐步贴近、接触，达到紧固件安装精度范围后，将待装配部件与目标装配体紧固连接；
步骤9：装配后机械臂卸载步骤：机械臂辅助装配控制***将控制参数及指令传输至机械臂控制器，对机械臂末端执行器进行已装配部件的重力卸载，人工卸除末端执行器与已装配部件间的连接件，机械臂运动返回至初始位姿；
步骤10：实际装配位姿测量步骤：激光跟踪仪对装配部件实际装配位姿进行测量，得出相对于目标装配体坐标系的实际安装位姿精度，并将测量结果传递给机械臂辅助装配控制***，***将装配初始位姿测量数据、机械臂运动路径及工艺参数、力控数据、最终位姿测量数据作为装配质量数据包以文件形式输出存储。
本领域技术人员可以将本发明提供的基于激光跟踪测量与力传感联合控制的机械臂辅助部件装配方法，理解为本发明提供的基于激光跟踪测量与力传感联合控制的机械臂辅助部件装配***的一个实施例。即，所述基于激光跟踪测量与力传感联合控制的机械臂辅助部件装配***可以通过执行所述基于激光跟踪测量与力传感联合控制的机械臂辅助部件装配方法的步骤流程实现。
根据一种的基于激光跟踪测量与力传感联合控制的机械臂辅助部件装配***，包括：控制器；所述控制器执行基于激光跟踪测量与力传感联合控制的机械臂辅助部件装配方法。
本发明通过采用基于激光跟踪测量与力传感联合控制方法，能够同时较好的满足大型部件装配中位姿高精度、装配低应力的技术要求，适用于大型航天器部件装配的特点，大幅提高装配效率；本发明采用激光跟踪测量的数据，通过位姿拟合与路径规划，合理设置目标装配引导区域，在装配前期阶段，能够使机械臂通过算法控制将待装配部件一次性移动至目标装配引导区域内具有较理想的装配初始位姿，减少人工控制机械臂运动调整的工序，并增加机械臂移动的平稳性，能减少待装配部件大范围移动中频繁受到冲击应力；本发明在装配位姿微调阶段，通过采用人工牵引机械臂运动模式，结合力传感反馈控制，将机械臂运动稳定可靠、定位精度高的特点,与人观察、操作的灵活性有效结合，实现精确调姿，并始终将装配作用力和力矩控制在规定范围内，有效提升装配质量。
本领域技术人员知道，除了以纯计算机可读程序代码方式实现本发明提供的***及其各个装置、模块、单元以外，完全可以通过将方法步骤进行逻辑编程来使得本发明提供的***及其各个装置、模块、单元以逻辑门、开关、专用集成电路、可编程逻辑控制器以及嵌入式微控制器等的形式来实现相同功能。所以，本发明提供的***及其各项装置、模块、单元可以被认为是一种硬件部件，而对其内包括的用于实现各种功能的装置、模块、单元也可以视为硬件部件内的结构；也可以将用于实现各种功能的装置、模块、单元视为既可以是实现方法的软件模块又可以是硬件部件内的结构。
以上对本发明的具体实施例进行了描述。需要理解的是，本发明并不局限于上述特定实施方式，本领域技术人员可以在权利要求的范围内做出各种变化或修改，这并不影响本发明的实质内容。在不冲突的情况下，本申请的实施例和实施例中的特征可以任意相互组合。

Claims (10)

1.一种基于激光跟踪测量与力传感联合控制的机械臂辅助部件装配方法，其特征在于，包括：
设置步骤：在机械臂、待装配部件、目标装配体***可观测区域设置跟踪仪，与工控机上测量***进行连接；
设置力传感器步骤：在机械臂末端法兰与末端执行器之间设置力传感器，力传感器与工控机上机械臂装配控制***进行连接；
测量处理步骤：对机械臂末端执行器、待装配部件、目标装配体的位姿以及待装配部件、目标装配体上配合安装孔位置点进行测量，测量数据通过处理，将位姿测量数据统一转化成基于目标装配体坐标系的表达，获取供机械臂装配控制***读取信息；
拟合路径步骤：根据供机械臂装配控制***读取信息，机械臂辅助装配控制***读取位姿测量数据，规划目标装配引导区域、预定装配初始位姿、待装配部件的空间运动路径；
安装夹持步骤：通过示教器，人工控制机械臂末端移动至待装配部件放置区域预定位置，完成待装配部件的安装夹持，然后控制机械臂末端竖直向上平移预定距离，通过力传感器测量数据计算待装配部件的质心、重量，获取待装配部件质心信息、待装配部件重量信息；
位姿微调步骤：根据待装配部件质心信息、待装配部件重量信息，设置待装配部件移动至目标装配引导区域，待装配部件位姿微调工序过程中机械臂末端运动控制参数、力传感控制参数，获取位置微调信息；
调整到预定装配初始位姿步骤：根据位置微调信息，将控制参数及指令传输至机械臂控制器，机械臂末端执行器夹持待装配部件一次性平稳移动至目标装配引导区域内，调整到预定装配初始位姿；
逐步对齐步骤：将控制参数及指令传输至机械臂控制器，启用人工牵引机械臂运动模式，启用力传感反馈控制，由人手动引导机械臂末端执行器对部件姿态微调，使待装配部件与目标装配体上相应配合安装孔逐步对齐，安装面逐步贴近、接触，达到紧固件安装精度范围后，将待装配部件与目标装配体紧固连接；
卸载卸除步骤：机械臂辅助装配控制***将控制参数及指令传输至机械臂控制器，对机械臂末端执行器进行已装配部件的重力卸载，人工卸除末端执行器与所夹持工件间的连接件，机械臂运动返回至初始位姿；
测量数据存储步骤：对装配部件实际装配位姿进行测量，得出相对于目标装配体坐标系的实际安装位姿精度，获取装配部件实际装配位姿测量结果信息；
根据装配部件实际装配位姿测量结果信息，将测量结果传递给机械臂辅助装配控制***，获取装配质量数据包信息。
2.根据权利要求1所述的基于激光跟踪测量与力传感联合控制的机械臂辅助部件装配方法，其特征在于，包括：
生成最优轨迹步骤：根据工艺参数、现场空间限制参数，设置运动路径上的位置点，机械臂辅助装配控制***将运动路径点矩阵通过指令传输至机械臂运动控制器，生成可操作机械臂运动的轨迹；
所述路径规划是控制机械臂末端夹持待装配部件依次移动的一个或者多个空间位置点及在各位置点相应的速度方向向量，可由N×6维矩阵表示。
3.根据权利要求1所述的基于激光跟踪测量与力传感联合控制的机械臂辅助部件装配方法，其特征在于，包括：
确定目标装配引导区域步骤：根据工艺参数、现场空间限制参数，设置目标装配引导区域；
所述的目标装配引导区域是预设置的在目标装配体安装面外法向具有预定安全距离和可进行待装配部件位姿调整的立体空间范围。
4.根据权利要求1所述的基于激光跟踪测量与力传感联合控制的机械臂辅助部件装配方法，其特征在于，所述跟踪仪采用便携式激光跟踪仪；
所述跟踪仪的精度高于某一设定阈值；
所述跟踪仪的测量尺寸范围大于某一设定阈值；
所述跟踪仪通过跟踪靶标依次采集各测量对象特征位置的空间坐标。
5.根据权利要求1所述的基于激光跟踪测量与力传感联合控制的机械臂辅助部件装配方法，其特征在于，所述机械臂采用串联式机械臂，所述机械臂具有6个自由度，所述机械臂的承载能力大于额定负载，所述额定负载大于300kg。
6.根据权利要求1所述的基于激光跟踪测量与力传感联合控制的机械臂辅助部件装配方法，其特征在于，所述力传感器是六维力传感器，所述力传感器能够测量三个正交力分量，以及三个正交力矩分量。
7.根据权利要求1所述的基于激光跟踪测量与力传感联合控制的机械臂辅助部件装配方法，其特征在于，所述位姿是与测量对象固连的空间直角坐标系，所述位姿具有6个特征值；
所述位姿用坐标系原点空间3个坐标值及3个正交坐标轴方位向量表达，所述位姿通过测量被测对象上至少3个不在同一直线方向上的空间坐标点来拟合。
8.根据权利要求1所述的基于激光跟踪测量与力传感联合控制的机械臂辅助部件装配方法，其特征在于，所述的预定装配初始位姿是将目标装配体安装面上M个安装孔的空间位姿坐标P1沿安装面外法向平移距离D得到P1′，将待装配体安装面上M个安装孔的空间位姿P0，令T为待求的空间转换6维齐次矩阵，通过算法对P0×T与P1′进行最佳拟合，得出T为引导区理想装配初始位姿转换矩阵。
9.根据权利要求1所述的基于激光跟踪测量与力传感联合控制的机械臂辅助部件装配方法，其特征在于，所述的人工牵引机械臂运动模式为结合力传感反馈控制，通过力传感器测量由人或目标装配体作用于末端执行器或待装配部件上外力或外力矩的变化，控制机械臂末端执行器姿态的微调，以减少或消除外力和外力矩变化，使得人工牵引机械臂运动模式下姿态的微调。
10.一种基于激光跟踪测量与力传感联合控制的机械臂辅助部件装配***，其特征在于，包括：控制器；
所述控制器执行权利要求1-9任一项所述的基于激光跟踪测量与力传感联合控制的机械臂辅助部件装配方法。
CN201910797163.XA 2019-08-27 2019-08-27 基于激光跟踪测量与力传感联合控制的机械臂辅助部件装配方法及*** Pending CN110625611A (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201910797163.XA CN110625611A (zh) 2019-08-27 2019-08-27 基于激光跟踪测量与力传感联合控制的机械臂辅助部件装配方法及***

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201910797163.XA CN110625611A (zh) 2019-08-27 2019-08-27 基于激光跟踪测量与力传感联合控制的机械臂辅助部件装配方法及***

Publications (1)

Publication Number Publication Date
CN110625611A true CN110625611A (zh) 2019-12-31

Family

ID=68969473

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201910797163.XA Pending CN110625611A (zh) 2019-08-27 2019-08-27 基于激光跟踪测量与力传感联合控制的机械臂辅助部件装配方法及***

Country Status (1)

Country Link
CN (1) CN110625611A (zh)

Cited By (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN111152264A (zh) * 2020-01-03 2020-05-15 北京理工大学 一种用于检测协作机器人碰撞力和功率的精密测量模块
CN111390883A (zh) * 2020-06-02 2020-07-10 季华实验室 一种复合示教方法、装置和电子设备
CN111504284A (zh) * 2020-05-08 2020-08-07 珠海格力智能装备有限公司 精度测量辅助装置
CN111531530A (zh) * 2020-03-13 2020-08-14 北京卫星制造厂有限公司 一种基于六维力感知的低应力装调***及方法
CN111660235A (zh) * 2020-05-20 2020-09-15 上海航天精密机械研究所 铆接舱体激光引导装配***及方法
CN111843415A (zh) * 2020-07-20 2020-10-30 广东电网有限责任公司 一种气体绝缘组合电器对接***及方法
CN111915718A (zh) * 2020-06-22 2020-11-10 中国船舶重工集团公司第七一六研究所 适用于船岸lng装卸臂的自动对接***
CN113096519A (zh) * 2021-03-25 2021-07-09 广东南大机器人有限公司 工业机器人技能实训考核平台的电机装配训练***及方法
CN113119123A (zh) * 2021-04-12 2021-07-16 厦门大学 一种办公转椅生产的运动控制方法

Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN103640022A (zh) * 2013-11-13 2014-03-19 北京卫星环境工程研究所 航天器机械臂柔性随动控制方法
CN105834735A (zh) * 2016-04-19 2016-08-10 北京航空航天大学 一种基于激光跟踪仪的零部件自动装配方法
CN106625653A (zh) * 2016-05-23 2017-05-10 北京卫星环境工程研究所 基于力反馈的工业机器人辅助装配柔性对接方法
DE202016002733U1 (de) * 2016-04-22 2017-07-26 Kuka Roboter Gmbh Endeffektor-Vorrichtung
US20180222049A1 (en) * 2017-02-09 2018-08-09 Canon Kabushiki Kaisha Method of controlling robot, method of teaching robot, and robot system
CN109382828A (zh) * 2018-10-30 2019-02-26 武汉大学 一种基于示教学习的机器人轴孔装配***及方法

Patent Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN103640022A (zh) * 2013-11-13 2014-03-19 北京卫星环境工程研究所 航天器机械臂柔性随动控制方法
CN105834735A (zh) * 2016-04-19 2016-08-10 北京航空航天大学 一种基于激光跟踪仪的零部件自动装配方法
DE202016002733U1 (de) * 2016-04-22 2017-07-26 Kuka Roboter Gmbh Endeffektor-Vorrichtung
CN106625653A (zh) * 2016-05-23 2017-05-10 北京卫星环境工程研究所 基于力反馈的工业机器人辅助装配柔性对接方法
US20180222049A1 (en) * 2017-02-09 2018-08-09 Canon Kabushiki Kaisha Method of controlling robot, method of teaching robot, and robot system
CN109382828A (zh) * 2018-10-30 2019-02-26 武汉大学 一种基于示教学习的机器人轴孔装配***及方法

Cited By (12)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN111152264A (zh) * 2020-01-03 2020-05-15 北京理工大学 一种用于检测协作机器人碰撞力和功率的精密测量模块
CN111531530A (zh) * 2020-03-13 2020-08-14 北京卫星制造厂有限公司 一种基于六维力感知的低应力装调***及方法
CN111504284A (zh) * 2020-05-08 2020-08-07 珠海格力智能装备有限公司 精度测量辅助装置
CN111504284B (zh) * 2020-05-08 2022-01-18 珠海格力智能装备有限公司 精度测量辅助装置
CN111660235A (zh) * 2020-05-20 2020-09-15 上海航天精密机械研究所 铆接舱体激光引导装配***及方法
CN111390883A (zh) * 2020-06-02 2020-07-10 季华实验室 一种复合示教方法、装置和电子设备
CN111915718A (zh) * 2020-06-22 2020-11-10 中国船舶重工集团公司第七一六研究所 适用于船岸lng装卸臂的自动对接***
CN111915718B (zh) * 2020-06-22 2024-01-09 中国船舶集团有限公司第七一六研究所 适用于船岸lng装卸臂的自动对接***
CN111843415A (zh) * 2020-07-20 2020-10-30 广东电网有限责任公司 一种气体绝缘组合电器对接***及方法
CN113096519A (zh) * 2021-03-25 2021-07-09 广东南大机器人有限公司 工业机器人技能实训考核平台的电机装配训练***及方法
CN113119123A (zh) * 2021-04-12 2021-07-16 厦门大学 一种办公转椅生产的运动控制方法
CN113119123B (zh) * 2021-04-12 2022-05-17 厦门大学 一种办公转椅生产的运动控制方法

Similar Documents

Publication Publication Date Title
CN110625611A (zh) 基于激光跟踪测量与力传感联合控制的机械臂辅助部件装配方法及***
CN107717994B (zh) 基于主从空间映射的主从异构机器人通用控制方法及***
CN104626152B (zh) 工业机器人主动柔顺控制方法及装置
CN109848983A (zh) 一种高顺应性人引导机器人协同作业的方法
US9555548B2 (en) Robot control device for controlling robot moved according to applied force
CN107351084B (zh) 一种面向维修任务的空间机械臂手***误差修正方法
JPH03178788A (ja) マニピュレータの制御方法
US9573272B2 (en) Operating method for a positioning system
JP2001157975A (ja) ロボットの制御装置
CN111037542B (zh) 一种逆动力学控制机器人直线加工的轨迹误差补偿方法
CN112171673A (zh) 机械臂作业控制方法、控制设备及计算机可读存储介质
CN113189950B (zh) 用于大型弱刚性结构件装配的双机器人协同柔顺装调方法
CN103144109B (zh) 一种用于附加外部轴的机器人***分站式精度补偿方法
CN111515928B (zh) 机械臂运动控制***
CN108453740A (zh) 一种工业机器人协作交互方法及***
CN112296995B (zh) 机器人协作搬运***
Hamaza et al. 2d contour following with an unmanned aerial manipulator: Towards tactile-based aerial navigation
JP5505155B2 (ja) ロボットシステムおよびロボット制御方法
Deng et al. A review of robot grinding and polishing force control mode
CN111230267B (zh) 一种双工位协作混焊焊接生产线
CN117245663A (zh) 绳驱空间柔性机械臂力位型融合柔顺控制方法及***
Lim et al. Configuration control of a mobile dexterous robot: Real-time implementation and experimentation
Zhang et al. A task-priority coordinated motion planner combined with visual servo for mobile manipulator
CN118061202B (zh) 基于激光跟踪仪引导的机器人高精度手眼标定方法及***
Yang et al. An obstacle avoidance and trajectory tracking algorithm for redundant manipulator end

Legal Events

Date Code Title Description
PB01 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination
SE01 Entry into force of request for substantive examination
RJ01 Rejection of invention patent application after publication
RJ01 Rejection of invention patent application after publication

Application publication date: 20191231