力位混合的长桁零件机器人自动敷设方法、装置及设备制造方法及图纸

本申请涉及航空航天领域，特别涉及一种力位混合的长桁零件机器人自动敷设方法、装置及设备。包括：基于预设的第一力位混合信息，控制工业机械臂根据目标长桁零件的长桁截面和长桁姿态抓取目标长桁零件；在工业机械臂抓取完成后，结合数模中敷设轨迹重规划工业机械臂轨迹得到配准轨迹；在工业机械臂到待装配位置后，基于配准轨迹和壁板的待敷设表面截面，控制工业机械臂调整目标长桁零件的姿态，并基于预设的第二力位混合信息，控制工业机械臂敷设目标长桁零件至壁板。由此，通过利用多模态传感器和辅助定位硬件，解决以长桁为代表的长条状钣金零件自动装配过程中的检测、控制问题，在工件姿态未知、刚性较弱等复杂工况下实现特定零件自动化装配。定零件自动化装配。定零件自动化装配。

【技术实现步骤摘要】
力位混合的长桁零件机器人自动敷设方法、装置及设备


[0001]本申请涉及航空航天领域，特别涉及一种力位混合的长桁零件机器人自动敷设方法、装置及设备。

技术介绍

[0002]在航空航天领域当中，长桁一般指长条状的钣金零件，可以用于敷设在薄壁金属壁板背面，用于强化壁板结构的抗弯、抗扭性能。长桁零件数量较多，本身刚性较弱，且装配需要保证长桁零件的位置精度、彼此平行度等等，需要人工反复费时费力地调整，存在大量重复性工作。
[0003]相关技术中，机器人自动敷设长桁是有效提升航空航天装配效率、减少人工重复工作的可行解决方案。
[0004]然而，长桁结构本身尺寸较长、截面形状复杂、本身刚性尤其是抗扭能力较弱的特点，使得长桁的自动敷设依然比较困难，亟待解决。

技术实现思路

[0005]本申请提供一种力位混合的长桁零件机器人自动敷设方法、装置及设备，解决以长桁为代表的长条状钣金零件自动装配过程中的检测、控制问题，在工件姿态部分未知、刚性较弱等复杂工况下实现特定零件的自动化装配。
[0006]为达到上述目的，本申请第一方面实施例提出一种力位混合的长桁零件机器人自动敷设方法，包括以下步骤：
[0007]获取目标长桁零件的长桁截面和长桁姿态，并基于预设的第一力位混合信息，控制工业机械臂根据所述长桁截面和所述长桁姿态抓取所述目标长桁零件；
[0008]在所述工业机械臂抓取完成后，结合数模中敷设轨迹重规划所述工业机械臂轨迹，得到配准轨迹；以及
[0009]在所述工业机械臂到待装配位置后，基于所述配准轨迹和壁板的待敷设表面截面，控制所述工业机械臂调整所述目标长桁零件的姿态，并基于预设的第二力位混合信息，控制所述工业机械臂敷设所述目标长桁零件至所述壁板。
[0010]根据本申请的一个实施例，所述控制工业机械臂根据所述长桁截面和所述长桁姿态抓取所述目标长桁零件，包括：
[0011]根据所述长桁截面和所述长桁姿态确定所述目标长桁零件的空间位置和空间姿态；
[0012]根据所述空间位置和所述空间姿态确定所述工业机械臂的抓取位置和抓取姿态；
[0013]根据所述抓取位置和所述抓取姿态抓取所述目标长桁零件。
[0014]根据本申请的一个实施例，所述空间位置和所述空间姿态分别为：
[0015][0016]其中，为所述目标长桁零件的所述空间位置，为所述目标长桁零件的所述空间姿态，为长桁料架的定位二维码标记在端面测量相机测量坐标系中的姿态，为长桁料架的定位二维码标记在端面测量相机测量坐标系中的位置，为长桁零件的位置，为长桁零件的姿态，为端面测量相机测量坐标系在末端执行器中的位置，为端面测量相机测量坐标系在末端执行器中的姿态，为工业机械臂末端的位置，为工业机械臂末端的姿态。
[0017]根据本申请的一个实施例，所述抓取位置和所述抓取姿态分别为：
[0018][0019]其中，为所述抓取位置，为所述抓取姿态，为截面测量线激光传感器在末端执行器中的位置，为截面测量线激光传感器在末端执行器中的姿态，Δy
pick
为预留距离。
[0020]根据本申请的一个实施例，所述配准轨迹包括工业机械臂的目标位置和目标姿态，其中，所述目标位置和所述目标姿态分别为：
[0021][0022]其中，为所述目标位置，为所述目标姿态，为待敷设壁板零件坐标系在工业机械臂坐标系中的位置，为待敷设壁板零件坐标系在工业机械臂坐标系中的姿态，为待敷设的长桁零件在数模中规定的理论位置，为待敷设的长桁零件在数模中规定的理论姿态，Δy
S
为预设敷设开始的安全距离。
[0023]根据本申请的一个实施例，所述控制所述工业机械臂调整所述目标长桁零件的姿态，包括：
[0024]基于预设的调姿目标点位置和预设的调姿目标点姿态，控制所述工业机械臂调整所述目标长桁零件的姿态，其中，所述预设的调姿目标点位置和所述预设的调姿目标点姿态分别为：
[0025][0026]其中，为所述预设的调姿目标点位置，为所述预设的调姿目标点姿态，为工业机械臂当前抓持长桁零件的位置，为工业机械臂当前抓持长桁零件的姿态，l0为长桁零件受到的潜在合力位置，Δθ
C
为预测z向角度偏差，Δy
V
为垂直方向的力控补偿距离，Δy
C
为截面测量线激光传感器实测沿y向截面误差，k
adj
为角度调整权重系数，L0为长桁长度方向尺寸，k
v
为导纳力控柔顺参数，F
T
为目标敷设力，F1、F2为长桁零件与壁板发生接触沿y向的接触力。
[0027]根据本申请实施例提出的力位混合的长桁零件机器人自动敷设方法，通过基于预设的第一力位混合信息，控制工业机械臂根据目标长桁零件的长桁截面和长桁姿态抓取目标长桁零件，在工业机械臂抓取完成后，结合数模中敷设轨迹重规划工业机械臂轨迹得到配准轨迹，在工业机械臂到待装配位置后，基于配准轨迹和壁板的待敷设表面截面，控制工业机械臂调整目标长桁零件的姿态，并基于预设的第二力位混合信息，控制工业机械臂敷设目标长桁零件至壁板。由此，通过利用多模态传感器和辅助定位硬件，解决以长桁为代表的长条状钣金零件自动装配过程中的检测、控制问题，在工件姿态部分未知、刚性较弱等复杂工况下实现特定零件的自动化装配。
[0028]为达到上述目的，本申请第二方面实施例提出一种力位混合的长桁零件机器人自动敷设装置，包括：
[0029]第一控制模块，用于获取目标长桁零件的长桁截面和长桁姿态，并基于预设的第一力位混合信息，控制工业机械臂根据所述长桁截面和所述长桁姿态抓取所述目标长桁零件；
[0030]重规划模块，用于在所述工业机械臂抓取完成后，结合数模中敷设轨迹重规划所述工业机械臂轨迹，得到配准轨迹；
[0031]第二控制模块，用于在所述工业机械臂到待装配位置后，基于所述配准轨迹和壁板的待敷设表面截面，控制所述工业机械臂调整所述目标长桁零件的姿态，并基于预设的第二力位混合信息，控制所述工业机械臂敷设所述目标长桁零件至所述壁板。
[0032]根据本申请的一个实施例，所述第一控制模块，具体用于：
[0033]根据所述长桁截面和所述长桁姿态确定所述目标长桁零件的空间位置和空间姿态；
[0034]根据所述空间位置和所述空间姿态确定所述工业机械臂的抓取位置和抓取姿态；
[0035]根据所述抓取位置和所述抓取姿态抓取所述目标长桁零件。
[0036]根据本申请的一个实施例，所述空间位置和所述空间姿态分别为：
[0037][0038]其中，为所述目标长桁零件的所述空间位置，为所述目标长桁零件的所述空间姿态，为长桁料架的定位二维码标记在端面测量相机测量坐标系中的姿态，为长桁料架的定位二维码标记在端面测量相机测量坐标系中的位置，为长桁零件的位置，为长桁零件的姿态，为端面测量相机测量坐标系在末端执行器中的位置，为端面测量相机测量坐标系在末端执本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.一种力位混合的长桁零件机器人自动敷设方法，其特征在于，包括以下步骤：获取目标长桁零件的长桁截面和长桁姿态，并基于预设的第一力位混合信息，控制工业机械臂根据所述长桁截面和所述长桁姿态抓取所述目标长桁零件；在所述工业机械臂抓取完成后，结合数模中敷设轨迹重规划所述工业机械臂轨迹，得到配准轨迹；在所述工业机械臂到待装配位置后，基于所述配准轨迹和壁板的待敷设表面截面，控制所述工业机械臂调整所述目标长桁零件的姿态，并基于预设的第二力位混合信息，控制所述工业机械臂敷设所述目标长桁零件至所述壁板。2.根据权利要求1所述的方法，其特征在于，所述控制工业机械臂根据所述长桁截面和所述长桁姿态抓取所述目标长桁零件，包括：根据所述长桁截面和所述长桁姿态确定所述目标长桁零件的空间位置和空间姿态；根据所述空间位置和所述空间姿态确定所述工业机械臂的抓取位置和抓取姿态；根据所述抓取位置和所述抓取姿态抓取所述目标长桁零件。3.根据权利要求2所述的方法，其特征在于，所述空间位置和所述空间姿态分别为：其中，为所述目标长桁零件的所述空间位置，为所述目标长桁零件的所述空间姿态，为长桁料架的定位二维码标记在端面测量相机测量坐标系中的姿态，为长桁料架的定位二维码标记在端面测量相机测量坐标系中的位置，为长桁零件的位置，为长桁零件的姿态，为端面测量相机测量坐标系在末端执行器中的位置，为端面测量相机测量坐标系在末端执行器中的姿态，为工业机械臂末端的位置，为工业机械臂末端的姿态。4.根据权利要求3所述的方法，其特征在于，所述抓取位置和所述抓取姿态分别为：其中，为所述抓取位置，为所述抓取姿态，为截面测量线激光传感器在末端执行器中的位置，为截面测量线激光传感器在末端执行器中的姿态，Δy
pick
为预留距离。5.根据权利要求1所述的方法，其特征在于，所述配准轨迹包括工业机械臂的目标位置和目标姿态，其中，所述目标位置和所述目标姿态分别为：其中，为所述目标位置，为所述目标姿态，为待敷设壁板零件坐标系在工业机械臂坐标系中的位置，为待敷设壁板零件坐标系在工业机械臂坐标系中的姿态，为待敷设的长桁零件在数模中规定的理论位置，为待敷设的长桁零件在数模中规定的理论姿态，Δy
S
为预设敷设开始的安全距离。6.根据权利要求1所述的方法，其特征在于，所述控制所述工业机械臂调整所述目标长
...

【专利技术属性】
技术研发人员：吴丹，任昊，张炜才，何玉厚，张继文，陈玉成，程承，
申请(专利权)人：昌河飞机工业集团有限责任公司，
类型：发明
国别省市：