用于制造技术

本发明专利技术提供了用于

【技术实现步骤摘要】
用于FPC装配的目标引导式机器人系统及其控制方法、装置


[0001]本专利技术涉及机器人
，特别是涉及用于
FPC
装配的目标引导式机器人系统及其控制方法
、
装置
。

技术介绍

[0002]机器人已经广泛应用于各行各业的各种任务中
。
然而，在手机维修工艺中，
FPC
（
Flexible Printed Circuit
，柔性电路板）的装配仍然依赖人工的辅助，这是由于目前通过机器人实现
FPC
装配面临两个难点：第一，
FPC
及其上的连接器初始位置任意，使得机器人装配需要在线检测连接器的位姿以实现灵活操作；第二，
FPC
装配精度要求高达
0.4mm
，否则容易损坏
FPC
的连接器
。
因此，如何同时保证机器人操作的灵活性和高精度，以实现
FPC
的精准装配是目前主要的研究方向
。

技术实现思路

[0003]有鉴于此，本专利技术旨在提出用于
FPC
装配的目标引导式机器人系统及其控制方法
、
装置，以解决当前机器人操作无法同时满足灵活性和高精度要求，进而导致无法实现
FPC
的精准装配的问题
。
[0004]本专利技术的第一方面，提供了一种用于柔性电路板装配的目标引导式机器人系统的控制方法，应用于机器人系统，所述机器人系统包括第一机械臂
、
第二机械臂以及相机，所述方法包括：步骤
S1
，控制所述第一机械臂抓取待装配对象；其中，所述待装配对象包括柔性电路板的连接器公座，所述连接器公座待装配至母座上；步骤
S2
，在抓取成功后，采用所述相机以预设角度拍摄包括所述待装配对象的目标图像，并确定在所述目标图像中，所述待装配对象的多个关键点的像素坐标；步骤
S3
，基于多个所述关键点的像素坐标和每个所述关键点对应的参考像素坐标，确定所述待装配对象与期望对齐位置之间的位置误差；其中，所述参考像素坐标为当所述待装配对象处于所述期望对齐位置时，所述关键点在所述目标图像中的像素坐标；其中，所述期望对齐位置位于所述母座的正上方；步骤
S4
，在所述位置误差大于或等于预设阈值的情况下，基于所述位置误差以及预设映射关系，确定所述第一机械臂的机械臂控制量；其中，所述预设阈值根据所述装配对象的装配精度要求确定；所述预设映射关系表征所述关键点从所述像素坐标运动到所述参考像素坐标的特征速度与所述第一机械臂的末端速度之间的映射关系；步骤
S5
，根据所述机械臂控制量，控制所述第一机械臂运动，并重复上述步骤
S2
‑
S4
，直到所述位置误差小于所述预设阈值；步骤
S6
，在所述位置误差小于所述预设阈值时，控制所述第二机械臂将所述待装配对象扣合于所述母座
。
[0005]进一步地，在所述重复过程中，所述相机每间隔预设时长，以所述预设角度拍摄所
述目标图像；所述基于所述位置误差以及预设映射关系，确定所述第一机械臂的机械臂控制量，包括：基于所述位置误差，确定每个所述关键点的特征速度；按照所述预设映射关系，将多个所述关键点的特征速度映射为所述末端速度；基于所述预设时长，将所述末端速度转化为所述第一机械臂的位姿增量；将所述位姿增量确定为所述机械臂控制量；所述根据所述机械臂控制量，控制所述第一机械臂运动，包括：获取所述第一机械臂的当前位姿；基于所述位姿增量和所述当前位姿，确定所述第一机械臂的目标位姿；控制所述第一机械臂运动，以将所述第一机械臂从所述当前位姿调整至所述目标位姿
。
[0006]进一步地，所述末端速度包括末端线速度和末端角速度，所述基于所述预设时长，将所述末端速度转化为所述第一机械臂的位姿增量，包括：基于所述末端线速度和所述预设时长，确定所述第一机械臂的位移增量；基于所述末端角速度和所述预设时长，确定所述第一机械臂的旋转轴和旋转角度；将所述位移增量
、
所述旋转轴和所述旋转角度确定为所述位姿增量
。
[0007]进一步地，所述预设映射关系的获取步骤包括：确定所述特征运动速度与所述相机的相机运动速度之间的第一映射关系；其中，所述相机运动速度包括相机运动的线速度和角速度；基于所述相机的相机外参和所述第一机械臂的末端相对于所述第一机械臂的基座的位姿，确定所述相机运动速度与所述第一机械臂的末端运动速度之间的第二映射关系；基于所述第一映射关系和所述第二映射关系，确定所述预设映射关系
。
[0008]进一步地，所述确定在所述目标图像中，所述待装配对象的多个关键点的像素坐标，包括：基于所述相机的相机外参，从所述目标图像中识别出包括所述待装配对象的子区域；对所述子区域进行图像截取，得到包括所述待装配对象的子区域图像；对所述子区域图像进行图像处理，以确定所述子区域图像中多个所述关键点的位置；基于所述子区域图像中多个所述关键点的位置，确定多个所述关键点在所述目标图像中的像素坐标
。
[0009]进一步地，所述第一机械臂的末端设置有真空吸盘，所述真空吸盘连接真空泵；所述控制所述第一机械臂抓取待装配对象，包括：采用所述相机拍摄包括所述待装配对象的待处理图像；从所述待处理图像中，确定所述待装配对象的多个关键点的位置；基于多个所述关键点的位置和所述待装配对象的尺寸参数，确定所述待装配对象相对于所述相机的相对位姿；
基于所述相对位姿
、
所述相机的相机外参以及所述真空吸盘相对于所述第一机械臂的末端的吸盘位姿，确定所述第一机械臂的运动量；控制所述第一机械臂运动所述运动量后，控制所述真空泵开启，以吸取所述待装配对象
。
[0010]进一步地，所述基于所述相对位姿
、
所述相机的相机外参以及所述真空吸盘相对于所述末端的吸盘位姿，确定所述第一机械臂的运动量，包括：根据所述相对位姿和预设偏移量，确定在所述待处理图像中，对所述待装配对象进行抓取的抓取点位置；基于所述抓取点位置
、
所述相机外参以及所述吸盘位姿，确定所述真空吸盘运动至所述抓取点时，所述第一机械臂所需的运动量
。
[0011]进一步地，所述第二机械臂的末端包括压紧杆和力传感器；所述控制所述第二机械臂将所述待装配对象扣合于所述母座，包括：控制所述第二机械臂移动，以将所述压紧杆的位置调整至预设位置；其中，所述预设位置位于所述期望对齐位置的正上方；控制所述第二机械臂沿垂直方向向下运动，以使所述压紧杆对所述待装配对象施加压紧力；在所述下压的过程中，通过所述力传感器实时检测所述压紧力；在检测到所述压紧力突变时，控制所述第二机械臂停止运动，并确定所述待装配对象已扣合于所述母座
。
[0012]本专利技术的第二方面，提供了一种用于
FPC<本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.
一种用于
FPC
装配的目标引导式机器人系统的控制方法，其特征在于，应用于机器人系统，所述机器人系统包括第一机械臂
、
第二机械臂以及相机，所述方法包括：步骤
S1
，控制所述第一机械臂抓取待装配对象；其中，所述待装配对象包括柔性电路板的连接器公座，所述连接器公座待装配至母座上；步骤
S2
，在抓取成功后，采用所述相机以预设角度拍摄包括所述待装配对象的目标图像，并确定在所述目标图像中，所述待装配对象的多个关键点的像素坐标；步骤
S3
，基于多个所述关键点的像素坐标和每个所述关键点对应的参考像素坐标，确定所述待装配对象与期望对齐位置之间的位置误差；其中，所述参考像素坐标为当所述待装配对象处于所述期望对齐位置时，所述关键点在所述目标图像中的像素坐标；其中，所述期望对齐位置位于所述母座的正上方；步骤
S4
，在所述位置误差大于或等于预设阈值的情况下，基于所述位置误差以及预设映射关系，确定所述第一机械臂的机械臂控制量；其中，所述预设阈值根据所述装配对象的装配精度要求确定；所述预设映射关系表征所述关键点从所述像素坐标运动到所述参考像素坐标的特征速度与所述第一机械臂的末端速度之间的映射关系；步骤
S5
，根据所述机械臂控制量，控制所述第一机械臂运动，并重复上述步骤
S2
‑
S4
，直到所述位置误差小于所述预设阈值；步骤
S6
，在所述位置误差小于所述预设阈值时，控制所述第二机械臂将所述待装配对象扣合于所述母座
。2.
根据权利要求1所述的用于
FPC
装配的目标引导式机器人系统的控制方法，其特征在于，在所述重复过程中，所述相机每间隔预设时长，以所述预设角度拍摄所述目标图像；所述基于所述位置误差以及预设映射关系，确定所述第一机械臂的机械臂控制量，包括：基于所述位置误差，确定每个所述关键点的特征速度；按照所述预设映射关系，将多个所述关键点的特征速度映射为所述末端速度；基于所述预设时长，将所述末端速度转化为所述第一机械臂的位姿增量；将所述位姿增量确定为所述机械臂控制量；所述根据所述机械臂控制量，控制所述第一机械臂运动，包括：获取所述第一机械臂的当前位姿；基于所述位姿增量和所述当前位姿，确定所述第一机械臂的目标位姿；控制所述第一机械臂运动，以将所述第一机械臂从所述当前位姿调整至所述目标位姿
。3.
根据权利要求2所述的用于
FPC
装配的目标引导式机器人系统的控制方法，其特征在于，所述末端速度包括末端线速度和末端角速度，所述基于所述预设时长，将所述末端速度转化为所述第一机械臂的位姿增量，包括：基于所述末端线速度和所述预设时长，确定所述第一机械臂的位移增量；基于所述末端角速度和所述预设时长，确定所述第一机械臂的旋转轴和旋转角度；将所述位移增量
、
所述旋转轴和所述旋转角度确定为所述位姿增量
。4.
根据权利要求1所述的用于
FPC
装配的目标引导式机器人系统的控制方法，其特征在于，所述预设映射关系的获取步骤包括：确定所述特征速度与所述相机的相机速度之间的第一映射关系；其中，所述相机速度
包括相机运动的线速度和角速度；基于所述相机的相机外参和所述第一机械臂的末端相对于所述第一机械臂的基座的位姿，确定所述相机速度与所述第一机械臂的末端运动速度之间的第二映射关系；基于所述第一映射关系和所述第二映射关系，确定所述预设映射关系
。5.
根据权利要求1所述的用于
FPC
装配的目标引导式机器人系统的控制方法，其特征在于，所述确定在所述目标图像中，所述待装配对象的多个关键点的像素坐标，包括：基于所述相机的相机外参，从所述目标图像中识别出包括所述待装配对象的子区域；对所述子区域进行图像截取，得到包括所述待装配对象的子区域图像；对所述子区域图像进行图像处理，以确定所述子区域图像中多个所述关键点的位置；基于所述子区域图像中多个所述关键点的位置，确定多个所述关键点在所述目标图像中的像素坐标
。6.
根据权利要求1所述的用于
FPC
装配的目标引导式机器人系统的控制方法，其特征在于，所述第一机械臂的末端设置有真空吸盘，所述真空吸盘连接真空泵；所述控制所述...

【专利技术属性】
技术研发人员：姜峣，陈志远，李铁民，冯思源，
申请(专利权)人：清华大学，
类型：发明
国别省市：