CN113664838B - 机器人定位放置控制方法、装置、电子设备及存储介质 - Google Patents

机器人定位放置控制方法、装置、电子设备及存储介质 Download PDF

Info

Publication number
CN113664838B
CN113664838B CN202111228181.XA CN202111228181A CN113664838B CN 113664838 B CN113664838 B CN 113664838B CN 202111228181 A CN202111228181 A CN 202111228181A CN 113664838 B CN113664838 B CN 113664838B
Authority
CN
China
Prior art keywords
dimensional code
information
robot
coordinate system
test
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.)
Active
Application number
CN202111228181.XA
Other languages
English (en)
Other versions
CN113664838A (zh
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.)
Individual
Original Assignee
Individual
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 Individual filed Critical Individual
Priority to CN202111228181.XA priority Critical patent/CN113664838B/zh
Publication of CN113664838A publication Critical patent/CN113664838A/zh
Application granted granted Critical
Publication of CN113664838B publication Critical patent/CN113664838B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00Programme-controlled manipulators
    • B25J9/16Programme controls
    • B25J9/1602Programme controls characterised by the control system, structure, architecture
    • B25J9/161Hardware, e.g. neural networks, fuzzy logic, interfaces, processor
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J13/00Controls for manipulators
    • B25J13/08Controls for manipulators by means of sensing devices, e.g. viewing or touching devices
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J19/00Accessories fitted to manipulators, e.g. for monitoring, for viewing; Safety devices combined with or specially adapted for use in connection with manipulators
    • B25J19/02Sensing devices
    • B25J19/04Viewing devices
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00Programme-controlled manipulators
    • B25J9/16Programme controls
    • B25J9/1656Programme controls characterised by programming, planning systems for manipulators
    • B25J9/1661Programme controls characterised by programming, planning systems for manipulators characterised by task planning, object-oriented languages
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00Programme-controlled manipulators
    • B25J9/16Programme controls
    • B25J9/1694Programme controls characterised by use of sensors other than normal servo-feedback from position, speed or acceleration sensors, perception control, multi-sensor controlled systems, sensor fusion
    • B25J9/1697Vision controlled systems

Abstract

本申请属于机器人控制技术领域,公开了一种机器人定位放置控制方法、装置、电子设备及存储介质,通过获取由三维相机采集的二维码的二维码图像信息;二维码设置在测试台上;根据二维码图像信息获取二维码在机器人基坐标系下的位姿信息;根据二维码图像信息获取预先标定的测试置具相对二维码的偏置矩阵信息;根据二维码在机器人基坐标系下的位姿信息和偏置矩阵信息计算测试置具在机器人基坐标系下的位姿信息;根据测试置具在机器人基坐标系下的位姿信息向机器人发送控制指令,使机器人把PCBA板放置在测试置具上;从而可根据测试台位置变化情况自动调整放置位置,避免在测试台位置变化时需要重新示教而影响工作效率。

Description

机器人定位放置控制方法、装置、电子设备及存储介质
技术领域
本申请涉及机器人控制技术领域,具体而言,涉及一种机器人定位放置控制方法、装置、电子设备及存储介质。
背景技术
目前在PCBA(Printed Circuit Board Assembly)板生产线中,对PCBA板进行测试时,一般是由人工把PCBA板取出放入测试台进行测试的,测试完后再由人工取出放回生产线中,耗费人力。因此,可使用配备视觉系统的机器人代替人工进行PCBA板在测试台的取放工作,目前,一般的测试台的位置是固定的,因此机器人只需要示教一次后按照固定的路径运行即可,但为了满足不同PCBA板的生产需求,有时候会把测试台设为可移动的,以便根据不同PCBA板替换不同的测试台,因此测试台的位置不是固定的,可能由于被无意挪动或更换测试台而导致位置变化,若每次出现位置变化都重新进行示教,则影响生产效率。
发明内容
本申请的目的在于提供一种机器人定位放置控制方法、装置、电子设备及存储介质,可根据测试台位置变化情况自动调整放置位置,避免在测试台位置变化时需要重新示教而影响工作效率。
第一方面,本申请提供了一种机器人定位放置控制方法,用于机器人控制装置,以控制机器人把PCBA板放置在测试台的测试置具上,包括以下步骤:
A1.获取由三维相机采集的二维码的二维码图像信息;所述二维码设置在所述测试台上;
A2.根据所述二维码图像信息获取所述二维码在机器人基坐标系下的位姿信息;
A3.根据所述二维码图像信息获取预先标定的所述测试置具相对所述二维码的偏置矩阵信息;
A4.根据所述二维码在机器人基坐标系下的位姿信息和所述偏置矩阵信息计算所述测试置具在机器人基坐标系下的位姿信息;
A5.根据所述测试置具在机器人基坐标系下的位姿信息向所述机器人发送控制指令,使所述机器人把PCBA板放置在所述测试置具上。
该机器人定位放置控制方法,通过设置在测试台上的二维码的图像获取该二维码在机器人基坐标系下的位姿信息,并根据测试台上的测试置具与该二维码之间的偏置矩阵信息计算得到测试置具在机器人基坐标系下的位姿信息,进而控制机器人把PCBA板放置在所述测试置具上;由于每个测试台的二维码和测试置具之间的相对位置是固定的,其偏置矩阵信息是固定的,当更换测试台或测试台的位置被挪动,只需要知道二维码在机器人基坐标系下的实际的位姿信息,就可快速地计算得到对应的测试置具在机器人基坐标系下的实际的位姿信息,进而可自动调整放置位置,避免在测试台位置变化时需要重新示教而影响工作效率。
优选地,步骤A2包括:
根据所述二维码图像信息获取所述二维码在所述三维相机的相机坐标系下的第一位姿信息;
根据所述第一位姿信息和预先标定得到的第一位姿转换矩阵,计算所述二维码在机器人基坐标系下的位姿信息。
优选地,所述根据所述二维码图像信息获取所述二维码在所述三维相机的相机坐标系下的第一位姿信息的步骤包括:
通过图像识别方法获取所述二维码图像信息中的二维码中心点在所述相机坐标系下的位置坐标数据,作为所述第一位姿信息的位置坐标数据;
通过图像识别方法获取所述二维码图像信息中的二维码的三个定位图标中心点在所述相机坐标系下的位置坐标数据;
根据所述三个定位图标中心点在所述相机坐标系下的位置坐标数据,计算所述二维码在所述相机坐标系下的姿态角度数据,作为所述第一位姿信息的姿态角度数据。
在一些实施方式中,步骤A3包括:
对所述二维码图像信息中的二维码进行解析,得到解析信息;
从所述解析信息中提取所述偏置矩阵信息。
该实施方式中,把偏置矩阵信息作为二维码的解析信息之一记载在二维码上,直接识别该二维码即可得到偏置矩阵信息,方便快捷。
在另一些实施方式中,步骤A3包括:
对所述二维码图像信息中的二维码进行解析,得到解析信息;
从所述解析信息中提取所述测试台的编号信息;
根据所述编号信息在本地数据库中查询得到所述偏置矩阵信息。
优选地,步骤A5包括:
根据所述测试置具在机器人基坐标系下的位姿信息规划放置路径,得到放置路径信息;
根据所述放置路径信息生成控制指令;所述控制指令包含所述放置路径信息;
把所述控制指令发送至所述机器人,使所述机器人沿所述放置路径把所述PCBA板放置在所述测试置具上。
优选地,所述放置路径包括一个过渡路径点,所述过渡路径点位于所述测试置具正上方的预设高度处。
在该实施方式中,机器人进行PCBA板放置时会先移动到过渡路径点,然后会带动PCBA板竖直往下移动至测试置具处,可保证测试置具上的一些定位柱和探针准确插入PCBA板上对应的插孔中,避免损坏测试置具。
第二方面,本申请提供了一种机器人定位放置控制装置,用于机器人控制装置,以控制机器人把PCBA板放置在测试台的测试置具上,包括:
第一获取模块,用于获取由三维相机采集的二维码的二维码图像信息;所述二维码设置在所述测试台上;
第二获取模块,用于根据所述二维码图像信息获取所述二维码在机器人基坐标系下的位姿信息;
第三获取模块,用于根据所述二维码图像信息获取预先标定的所述测试置具相对所述二维码的偏置矩阵信息;
第一计算模块,用于根据所述二维码在机器人基坐标系下的位姿信息和所述偏置矩阵信息计算所述测试置具在机器人基坐标系下的位姿信息;
第一执行模块,用于根据所述测试置具在机器人基坐标系下的位姿信息向所述机器人发送控制指令,使所述机器人把PCBA板放置在所述测试置具上。
该机器人定位放置控制装置,通过设置在测试台上的二维码的图像获取该二维码在机器人基坐标系下的位姿信息,并根据测试台上的测试置具与该二维码之间的偏置矩阵信息计算得到测试置具在机器人基坐标系下的位姿信息,进而控制机器人把PCBA板放置在所述测试置具上;由于每个测试台的二维码和测试置具之间的相对位置是固定的,其偏置矩阵信息是固定的,当更换测试台或测试台的位置被挪动,只需要知道二维码在机器人基坐标系下的实际的位姿信息,就可快速地计算得到对应的测试置具在机器人基坐标系下的实际的位姿信息,进而可自动调整放置位置,避免在测试台位置变化时需要重新示教而影响工作效率。
第三方面,本申请提供了一种电子设备,包括处理器以及存储器,所述存储器存储有计算机可读取指令,当所述计算机可读取指令由所述处理器执行时,运行如前文所述机器人定位放置控制方法中的步骤。
第四方面,本申请提供了一种存储介质,其上存储有计算机程序,所述计算机程序被处理器执行时运行如前文所述机器人定位放置控制方法中的步骤。
有益效果:
本申请提供的机器人定位放置控制方法、装置、电子设备及存储介质,通过获取由三维相机采集的二维码的二维码图像信息;所述二维码设置在所述测试台上;根据所述二维码图像信息获取所述二维码在机器人基坐标系下的位姿信息;根据所述二维码图像信息获取预先标定的所述测试置具相对所述二维码的偏置矩阵信息;根据所述二维码在机器人基坐标系下的位姿信息和所述偏置矩阵信息计算所述测试置具在机器人基坐标系下的位姿信息;根据所述测试置具在机器人基坐标系下的位姿信息向所述机器人发送控制指令,使所述机器人把PCBA板放置在所述测试置具上;由于每个测试台的二维码和测试置具之间的相对位置是固定的,其偏置矩阵信息是固定的,当更换测试台或测试台的位置被挪动,只需要知道二维码在机器人基坐标系下的实际的位姿信息,就可快速地计算得到对应的测试置具在机器人基坐标系下的实际的位姿信息,进而可自动调整放置位置,避免在测试台位置变化时需要重新示教而影响工作效率。
本申请的其他特征和优点将在随后的说明书阐述,并且,部分地从说明书中变得显而易见,或者通过实施本申请了解。
附图说明
图1为本申请实施例提供的机器人定位放置控制方法的一种流程图。
图2为本申请实施例提供的机器人定位放置控制装置的一种结构示意图。
图3为本申请实施例提供的电子设备的结构示意图。
图4为一种示例性的二维码的示意图。
具体实施方式
下面将结合本申请实施例中附图,对本申请实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例仅仅是本申请一部分实施例,而不是全部的实施例。通常在此处附图中描述和示出的本申请实施例的组件可以以各种不同的配置来布置和设计。因此,以下对在附图中提供的本申请的实施例的详细描述并非旨在限制要求保护的本申请的范围,而是仅仅表示本申请的选定实施例。基于本申请的实施例,本领域技术人员在没有做出创造性劳动的前提下所获得的所有其他实施例,都属于本申请保护的范围。
应注意到:相似的标号和字母在下面的附图中表示类似项,因此,一旦某一项在一个附图中被定义,则在随后的附图中不需要对其进行进一步定义和解释。同时,在本申请的描述中,术语“第一”、“第二”等仅用于区分描述,而不能理解为指示或暗示相对重要性。
请参照图1,图1是本申请一些实施例中的机器人定位放置控制方法,用于机器人控制装置,以控制机器人把PCBA板放置在测试台的测试置具上,包括以下步骤:
A1.获取由三维相机采集的二维码的二维码图像信息;该二维码设置在测试台上;
A2.根据二维码图像信息获取二维码在机器人基坐标系下的位姿信息;
A3.根据二维码图像信息获取预先标定的测试置具相对二维码的偏置矩阵信息;
A4.根据二维码在机器人基坐标系下的位姿信息和偏置矩阵信息计算测试置具在机器人基坐标系下的位姿信息;
A5.根据测试置具在机器人基坐标系下的位姿信息向机器人发送控制指令,使机器人把PCBA板放置在测试置具上。
该机器人定位放置控制方法,通过设置在测试台上的二维码的图像获取该二维码在机器人基坐标系下的位姿信息,并根据测试台上的测试置具与该二维码之间的偏置矩阵信息计算得到测试置具在机器人基坐标系下的位姿信息,进而控制机器人把PCBA板放置在测试置具上;由于每个测试台的二维码和测试置具之间的相对位置是固定的,其偏置矩阵信息是固定的,当更换测试台或测试台的位置被挪动,只需要知道二维码在机器人基坐标系下的实际的位姿信息,就可快速地计算得到对应的测试置具在机器人基坐标系下的实际的位姿信息,进而可自动调整放置位置,避免在测试台位置变化时需要重新示教而影响工作效率。
其中,该二维码可设置在测试台的顶部或侧面上,可根据实际需要设置。通过三维相机采集的二维码图像信息是包含深度信息的,从中可提取图中各像素点与三维相机的距离。
在实际应用中,该三维相机可以是设置在机器人端部的也可以是固定设置在机器人外的。
优选地,步骤A2包括:
A201.根据二维码图像信息获取二维码在三维相机的相机坐标系下的第一位姿信息;
A202.根据第一位姿信息和预先标定得到的第一位姿转换矩阵,计算二维码在机器人基坐标系下的位姿信息。
其中,位姿信息包括位置坐标数据和姿态角度数据,其中位置坐标数据包括三个坐标的坐标值,姿态角度数据包括三个姿态角度值。前述的第一位姿转换矩阵可通过机器人手眼标定得到,在计算二维码在机器人基坐标系下的位姿信息的时候,直接由该第一位姿转换矩阵乘以第一位姿信息即可(相乘时,第一位姿信息以矩阵形式与第一位姿转换矩阵相乘)。
根据二维码图像信息获取二维码在三维相机的相机坐标系下的第一位姿信息的具体方法可采用现有技术中的方法,或者采用以下实施方式中的方法:
在一些实施方式中,根据二维码图像信息获取二维码在三维相机的相机坐标系下的第一位姿信息的步骤包括:
A2011.通过图像识别方法获取二维码图像信息中的二维码中心点在相机坐标系下的位置坐标数据,作为第一位姿信息的位置坐标数据;
A2012.通过图像识别方法获取二维码图像信息中的二维码的三个定位图标中心点在相机坐标系下的位置坐标数据;
A2013.根据三个定位图标中心点在相机坐标系下的位置坐标数据,计算二维码在相机坐标系下的姿态角度数据,作为第一位姿信息的姿态角度数据。
例如,步骤A2011中,通过边缘检测算法(如canny算法)提取二维码图像信息中的二维码的第一轮廓线,分别计算该第一轮廓线的像素点的三个坐标值(指相机坐标系下的坐标值)的均值,作为二维码中心点的三个坐标值,该三个坐标值就是二维码中心点在相机坐标系下的位置坐标数据。计算二维码中心点在相机坐标系下的位置坐标数据的公式如下:
Figure 438381DEST_PATH_IMAGE001
Figure 152259DEST_PATH_IMAGE002
Figure 994314DEST_PATH_IMAGE003
其中,
Figure 858364DEST_PATH_IMAGE004
Figure 737983DEST_PATH_IMAGE005
Figure 622763DEST_PATH_IMAGE006
分别为二维码中心点在相机坐标系下的位置坐标数据中的三个坐标值,
Figure 217692DEST_PATH_IMAGE007
Figure 478909DEST_PATH_IMAGE008
Figure 210105DEST_PATH_IMAGE009
分别为该第一轮廓线的第i个像素点在相机坐标系下的三个坐标值,n为该第一轮廓线的像素点总数。
在实际应用中,检测台上的二维码的边缘可能有局部位置污损,导致计算得到的二维码中心点位置坐标数据并非该二维码真正中心点的位置坐标数据。因此,也可在二维码的中心设在一个中心识别标志(例如图4中二维码的中心识别标志90),从而,步骤A2011中,通过边缘检测算法(如canny算法)提取二维码图像信息中的二维码的中心识别标志的第二轮廓线,分别计算该第二轮廓线的像素点的三个坐标值(指相机坐标系下的坐标值)的均值,作为二维码中心点的三个坐标值,该三个坐标值就是二维码中心点在相机坐标系下的位置坐标数据。具体地,计算二维码中心点的三个坐标值的公式如下:
Figure 531365DEST_PATH_IMAGE010
Figure 754535DEST_PATH_IMAGE011
Figure 819443DEST_PATH_IMAGE012
其中,
Figure 936304DEST_PATH_IMAGE013
Figure 569411DEST_PATH_IMAGE014
Figure 401582DEST_PATH_IMAGE015
分别为二维码中心点的三个坐标值,
Figure 4601DEST_PATH_IMAGE016
Figure 116914DEST_PATH_IMAGE017
Figure 779976DEST_PATH_IMAGE018
分别为该第二轮廓线的第i个像素点在相机坐标系下的三个坐标值,
Figure 836794DEST_PATH_IMAGE019
为该第二轮廓线的像素点总数。
需要说明得到是,本申请中的二维码为QR二维码(Quick Response Code),该二维码是包含三个定位图标的,该三个定位图标分别设置在二维码的三个角处(例如图4所示的二维码),步骤A2012包括:通过边缘检测算法(如canny算法)分别提取二维码图像信息中的二维码的三个定位图标的第三轮廓线,分别计算该第三轮廓线的像素点的三个坐标值(指相机坐标系下的坐标值)的均值,作为相应的定位图标中心点的三个坐标值,该三个坐标值就是相应的定位图标中心点在相机坐标系下的位置坐标数据。具体地,计算定位图标中心点的三个坐标值的公式如下:
Figure 384450DEST_PATH_IMAGE020
Figure 210324DEST_PATH_IMAGE021
Figure 309867DEST_PATH_IMAGE022
其中,
Figure 463768DEST_PATH_IMAGE023
Figure 939748DEST_PATH_IMAGE024
Figure 761074DEST_PATH_IMAGE025
分别为第j个定位图标中心点在相机坐标系下的三个坐标值,j=1、2、3,
Figure 31518DEST_PATH_IMAGE026
Figure 800278DEST_PATH_IMAGE027
Figure 689737DEST_PATH_IMAGE028
分别为第j个定位图标的第三轮廓线的第i个像素点在相机坐标系下的三个坐标值,
Figure 490203DEST_PATH_IMAGE029
为第j个定位图标的第三轮廓线的像素点总数。
此处,把与二维码没有定位图标的角在同一对角线上的定位图标称为第一定位图标,分别把另外两个定位图标称为第二定位图标和第三定位图标(例如图4中二维码的第一定位图标91、第二定位图标92和第三定位图标93),可以用二维码中心点作为二维码坐标系的原点,用第一定位图标中心指向第二定位图标中心的方向作为二维码坐标系的横轴方向、用第一定位图标中心指向第三定位图标中心的方向作为二维码坐标系的纵轴方向、根据右手定则确定二维码坐标系的竖轴方向,从而建立二维码坐标系。
进而,在步骤A2013中,根据该三个定位图标的中心点在相机坐标系下的位置坐标数据计算二维码坐标系的三个坐标轴的方向矢量(即计算从第一定位图标中心指向第二定位图标中心的单位矢量得到横轴方向的方向矢量,计算从第一定位图标中心指向第三定位图标中心的单位矢量得到纵轴方向的方向矢量,并通过右手定则确定竖轴方向的方向矢量,该竖轴方向的方向矢量为单位矢量),再根据二维码坐标系的三个坐标轴的方向矢量计算二维码坐标系相对相机坐标系旋转的三个欧拉角(具体计算方法为现有技术),以该三个欧拉角为二维码在相机坐标系下的姿态角度数据中的三个姿态角度值。
其中,测试置具相对二维码的偏置矩阵信息可通过对机器人示教的方式预先标定得到,具体标定过程为:先用该三维相机采集测试台的二维码的二维码图像信息,根据该二维码图像信息获取该二维码在机器人基坐标系下的位姿信息(具体方法参考步骤A2),然后通过示教使机器人把PCBA板放置在该测试台的测试置具,并记录放置时机器人末端的位姿信息(可从机器人控制器中读取),最后根据该二维码在机器人基坐标系下的位姿信息和放置时机器人末端的位姿信息计算得到偏置矩阵信息(假设计算过程中,二维码在机器人基坐标系下的位姿矩阵为Ao,示教放置时机器人末端的位姿矩阵为Bo,偏置矩阵为X,则有Bo =Ao* X,Ao -1 * Bo = X,其中Ao -1为矩阵Ao的逆,求得偏置矩阵X并进行保存)。由于测试台可能不止一个,对于每一个测试台均可通过上述标定过程得到对应的偏置矩阵信息。
在一些实施方式中,步骤A3包括:
对二维码图像信息中的二维码进行解析,得到解析信息;
从解析信息中提取测试台的编号信息;
根据编号信息在本地数据库中查询得到偏置矩阵信息。
即,在该实施方式中,在机器人控制装置的本地数据库中会预先存储各测试台的编号信息和对应的偏置矩阵信息,而测试台的二维码的解析信息包含对应的测试台的编号信息;通过解析二维码得到测试台的编号信息,进而可在本地数据库中查询得到对应的偏置矩阵信息。
在另一些实施方式中,步骤A3包括:
对二维码图像信息中的二维码进行解析,得到解析信息;
从解析信息中提取偏置矩阵信息。
即,在该实施方式中,把偏置矩阵信息作为二维码的解析信息之一记载在二维码上,直接识别该二维码即可得到偏置矩阵信息,方便快捷,且无需在机器人控制装置中预先存储各测试台的偏置矩阵信息,降低对机器人控制装置的存储资源的占用,当有新增加的测试台时,也无需进行机器人控制装置的本地数据库的更新。
具体地,步骤A4中,根据二维码在机器人基坐标系下的位姿信息和偏置矩阵信息计算测试置具在机器人基坐标系下的位姿信息的步骤具体包括:
用二维码在机器人基坐标系下的位姿信息与偏置矩阵信息相乘,得到测试置具在机器人基坐标系下的位姿信息(假设当前二维码在机器人基坐标系下的位姿矩阵为Ac,偏置矩阵为X已知,需要求得的测试置具在机器人基坐标系下的位姿矩阵,即机器人放置位姿矩阵为Bc,则有Bc= Ac * X)。
在一些实施方式中,步骤A5包括:
A501.根据测试置具在机器人基坐标系下的位姿信息规划放置路径,得到放置路径信息;
A502.根据放置路径信息生成控制指令;控制指令包含放置路径信息;
A503.把控制指令发送至机器人,使机器人沿放置路径把PCBA板放置在测试置具上。
其中,规划的放置路径的放置路径信息包括多个路径点的位姿信息,且这些路径点中包括一个放置点,该放置点的位姿信息与测试置具在机器人基坐标系下的位姿信息相同,从而当机器人沿该放置路径移动时,当到达放置点时即把PCBA板准确地放置在该测试置具上。具体的路径规划方法可采用现有的规划方法,此处不对其进行限定。
优选地,放置路径包括一个过渡路径点,过渡路径点位于测试置具正上方的预设高度处。
该预设高度可根据实际需要设置,在该实施方式中,机器人进行PCBA板放置时会先移动到过渡路径点,然后会带动PCBA板竖直往下移动至测试置具处(即过渡路径点后包括一段竖直的路径),可保证测试置具上的一些定位柱和探针准确插入PCBA板上对应的插孔中,避免损坏测试置具和PCBA板(若PCBA板在放入测试置具的过程中具有横向的速度,则容易导致定位柱、探针或PCBA板上的一些连接部位的变形或折断)。
在实际应用中,机器人需要从PCBA板生产线中多次取出PCBA板放置在测试台进行测试,在每次取出一个PCBA板进行测试时,均可执行一次上述的步骤A1-A5。但测试台的位置可能并没有发生移动,从而,可每完成预设数量(可根据实际需要设置,例如20块)的PCBA板的测试,执行一次上述的步骤A1-A5,从而提高工作效率。
实际上,为了提高效率,也可在步骤A2之后,先判断当前获取的二维码在机器人基坐标系下的位姿信息与上一次获取的二维码在机器人基坐标系下的位姿信息之间的偏差是否过大,若是,才执行步骤A3-A5,若否,则向机器人发送控制指令,使机器人沿上一次规划得到的放置路径把PCBA板放置在测试置具上。其中,若当前获取的二维码在机器人基坐标系下的位姿信息的至少一个参数与上一次获取的二维码在机器人基坐标系下的位姿信息的相应参数之间的偏差(为绝对值)超过相应的预设偏差阈值,则判定当前获取的二维码在机器人基坐标系下的位姿信息与上一次获取的二维码在机器人基坐标系下的位姿信息之间的偏差过大。
当前获取的二维码在机器人基坐标系下的位姿信息与上一次获取的二维码在机器人基坐标系下的位姿信息之间的偏差过大,说明测试台发生了移动或转动,否则说明测试台的位置没有发生变化,因此,只有在测试台发生了移动或转动时才重新规划放置路径,可降低规划放置路径的频率,提高工作效率。其中,当三维相机设置在机器人端部的时候,可预先设定一个拍照位姿点,使机器人以固定位姿进行二维码的二维码图像信息的采集,由于机器人位置控制是存在误差的,若每次在不同的位姿点进行拍照,则会引入不同的位姿误差,从而在判断当前获取的二维码在机器人基坐标系下的位姿信息与上一次获取的二维码在机器人基坐标系下的位姿信息之间的偏差是否过大的时候,容易发生误判;此处,每次均在同一拍照位姿点进行拍照,位姿误差是基本相当的,从而有利于降低误判的概率。
进一步地,当三维相机设置在机器人端部且预先设定了一个拍照位姿点的时候,进行路径规划时可只规划从拍照位姿点到放置点的之间的路径,从而PCBA板生产线到拍照位姿点的路径可固定不变,从而可提高路径规划的效率。机器人工作时,先从PCBA板生产线取出PCBA板并沿固定路径移动到拍照位姿点,然后进行拍照以采集二维码的二维码图像信息,接着按规划的放置路径移动到测试置具处把PCBA板放入该测试置具中。
由上可知,该机器人定位放置控制方法,通过获取由三维相机采集的二维码的二维码图像信息;二维码设置在测试台上;根据二维码图像信息获取二维码在机器人基坐标系下的位姿信息;根据二维码图像信息获取预先标定的测试置具相对二维码的偏置矩阵信息;根据二维码在机器人基坐标系下的位姿信息和偏置矩阵信息计算测试置具在机器人基坐标系下的位姿信息;根据测试置具在机器人基坐标系下的位姿信息向机器人发送控制指令,使机器人把PCBA板放置在测试置具上;由于每个测试台的二维码和测试置具之间的相对位置是固定的,其偏置矩阵信息是固定的,当更换测试台或测试台的位置被挪动,只需要知道二维码在机器人基坐标系下的实际的位姿信息,就可快速地计算得到对应的测试置具在机器人基坐标系下的实际的位姿信息,进而可自动调整放置位置,避免在测试台位置变化时需要重新示教而影响工作效率。
请参考图2,本申请提供了一种机器人定位放置控制装置,用于机器人控制装置,以控制机器人把PCBA板放置在测试台的测试置具上,包括:
第一获取模块1,用于获取由三维相机采集的二维码的二维码图像信息;该二维码设置在测试台上;
第二获取模块2,用于根据二维码图像信息获取二维码在机器人基坐标系下的位姿信息;
第三获取模块3,用于根据二维码图像信息获取预先标定的测试置具相对二维码的偏置矩阵信息;
第一计算模块4,用于根据二维码在机器人基坐标系下的位姿信息和偏置矩阵信息计算测试置具在机器人基坐标系下的位姿信息;
第一执行模块5,用于根据测试置具在机器人基坐标系下的位姿信息向机器人发送控制指令,使机器人把PCBA板放置在测试置具上。
该机器人定位放置控制装置,通过设置在测试台上的二维码的图像获取该二维码在机器人基坐标系下的位姿信息,并根据测试台上的测试置具与该二维码之间的偏置矩阵信息计算得到测试置具在机器人基坐标系下的位姿信息,进而控制机器人把PCBA板放置在测试置具上;由于每个测试台的二维码和测试置具之间的相对位置是固定的,其偏置矩阵信息是固定的,当更换测试台或测试台的位置被挪动,只需要知道二维码在机器人基坐标系下的实际的位姿信息,就可快速地计算得到对应的测试置具在机器人基坐标系下的实际的位姿信息,进而可自动调整放置位置,避免在测试台位置变化时需要重新示教而影响工作效率。
其中,该二维码可设置在测试台的顶部或侧面上,可根据实际需要设置。通过三维相机采集的二维码图像信息是包含深度信息的,从中可提取图中各像素点与三维相机的距离。
在实际应用中,该三维相机可以是设置在机器人端部的也可以是固定设置在机器人外的。
优选地,第二获取模块2用于在根据二维码图像信息获取二维码在机器人基坐标系下的位姿信息的时候,执行:
根据二维码图像信息获取二维码在三维相机的相机坐标系下的第一位姿信息;
根据第一位姿信息和预先标定得到的第一位姿转换矩阵,计算二维码在机器人基坐标系下的位姿信息。
其中,位姿信息包括位置坐标数据和姿态角度数据,其中位置坐标数据包括三个坐标的坐标值,姿态角度数据包括三个姿态角度值。前述的第一位姿转换矩阵可通过机器人手眼标定得到,在计算二维码在机器人基坐标系下的位姿信息的时候,直接由该第一位姿转换矩阵乘以第一位姿信息即可(相乘时,第一位姿信息以矩阵形式与第一位姿转换矩阵相乘)。
根据二维码图像信息获取二维码在三维相机的相机坐标系下的第一位姿信息的具体方法可采用现有技术中的方法,或者采用以下实施方式中的方法:
在一些实施方式中,第二获取模块2用于在根据二维码图像信息获取二维码在三维相机的相机坐标系下的第一位姿信息的时候,执行:
通过图像识别方法获取二维码图像信息中的二维码中心点在相机坐标系下的位置坐标数据,作为第一位姿信息的位置坐标数据;
通过图像识别方法获取二维码图像信息中的二维码的三个定位图标中心点在相机坐标系下的位置坐标数据;
根据三个定位图标中心点在相机坐标系下的位置坐标数据,计算二维码在相机坐标系下的姿态角度数据,作为第一位姿信息的姿态角度数据。
例如,第二获取模块2在通过图像识别方法获取二维码图像信息中的二维码中心点在相机坐标系下的位置坐标数据的时候,通过边缘检测算法(如canny算法)提取二维码图像信息中的二维码的第一轮廓线,分别计算该第一轮廓线的像素点的三个坐标值(指相机坐标系下的坐标值)的均值,作为二维码中心点的三个坐标值,该三个坐标值就是二维码中心点在相机坐标系下的位置坐标数据。计算二维码中心点在相机坐标系下的位置坐标数据的公式如下:
Figure 197128DEST_PATH_IMAGE030
Figure 325621DEST_PATH_IMAGE031
Figure 877825DEST_PATH_IMAGE032
其中,
Figure 267218DEST_PATH_IMAGE004
Figure 20410DEST_PATH_IMAGE005
Figure 760833DEST_PATH_IMAGE006
分别为二维码中心点在相机坐标系下的位置坐标数据中的三个坐标值,
Figure 382307DEST_PATH_IMAGE007
Figure 767152DEST_PATH_IMAGE008
Figure 550300DEST_PATH_IMAGE009
分别为该第一轮廓线的第i个像素点在相机坐标系下的三个坐标值,n为该第一轮廓线的像素点总数。
在实际应用中,检测台上的二维码的边缘可能有局部位置污损,导致计算得到的二维码中心点位置坐标数据并非该二维码真正中心点的位置坐标数据。因此,也可在二维码的中心设在一个中心识别标志(例如图4中二维码的中心识别标志90),从而,第二获取模块2在通过图像识别方法获取二维码图像信息中的二维码中心点在相机坐标系下的位置坐标数据的时候,通过边缘检测算法(如canny算法)提取二维码图像信息中的二维码的心识别标志的第二轮廓线,分别计算该第二轮廓线的像素点的三个坐标值(指相机坐标系下的坐标值)的均值,作为二维码中心点的三个坐标值,该三个坐标值就是二维码中心点在相机坐标系下的位置坐标数据。具体地,计算二维码中心点的三个坐标值的公式如下:
Figure 775090DEST_PATH_IMAGE033
Figure 810042DEST_PATH_IMAGE034
Figure 439606DEST_PATH_IMAGE035
其中,
Figure 128077DEST_PATH_IMAGE013
Figure 577513DEST_PATH_IMAGE014
Figure 150576DEST_PATH_IMAGE015
分别为二维码中心点的三个坐标值,
Figure 634647DEST_PATH_IMAGE016
Figure 759598DEST_PATH_IMAGE017
Figure 165172DEST_PATH_IMAGE018
分别为该第二轮廓线的第i个像素点在相机坐标系下的三个坐标值,
Figure 666560DEST_PATH_IMAGE019
为该第二轮廓线的像素点总数。
需要说明得到是,本申请中的二维码为QR二维码(Quick Response Code),该二维码是包含三个定位图标的,该三个定位图标分别设置在二维码的三个角处(例如图4所示的二维码),步骤A2012包括:通过边缘检测算法(如canny算法)分别提取二维码图像信息中的二维码的三个定位图标的第三轮廓线,分别计算该第三轮廓线的像素点的三个坐标值(指相机坐标系下的坐标值)的均值,作为相应的定位图标中心点的三个坐标值,该三个坐标值就是相应的定位图标中心点在相机坐标系下的位置坐标数据。具体地,计算定位图标中心点的三个坐标值的公式如下:
Figure 146083DEST_PATH_IMAGE036
Figure 444865DEST_PATH_IMAGE037
Figure 603314DEST_PATH_IMAGE038
其中,
Figure 783759DEST_PATH_IMAGE039
Figure 976843DEST_PATH_IMAGE040
Figure 443597DEST_PATH_IMAGE041
分别为第j个定位图标中心点在相机坐标系下的三个坐标值,j=1、2、3,
Figure 495866DEST_PATH_IMAGE042
Figure 73478DEST_PATH_IMAGE043
Figure 652227DEST_PATH_IMAGE044
分别为第j个定位图标的第三轮廓线的第i个像素点在相机坐标系下的三个坐标值,
Figure 165248DEST_PATH_IMAGE029
为第j个定位图标的第三轮廓线的像素点总数。
此处,把与二维码没有定位图标的角在同一对角线上的定位图标称为第一定位图标,分别把另外两个定位图标称为第二定位图标和第三定位图标(例如图4中二维码的第一定位图标91、第二定位图标92和第三定位图标93),可以用二维码中心点作为二维码坐标系的原点,用第一定位图标中心指向第二定位图标中心的方向作为二维码坐标系的横轴方向、用第一定位图标中心指向第三定位图标中心的方向作为二维码坐标系的纵轴方向、根据右手定则确定二维码坐标系的竖轴方向,从而建立二维码坐标系。
进而,第二获取模块2在通过图像识别方法获取二维码图像信息中的二维码的三个定位图标中心点在相机坐标系下的位置坐标的时候,根据该三个定位图标的中心点在相机坐标系下的位置坐标数据计算二维码坐标系的三个坐标轴的方向矢量(即计算从第一定位图标中心指向第二定位图标中心的单位矢量得到横轴方向的方向矢量,计算从第一定位图标中心指向第三定位图标中心的单位矢量得到纵轴方向的方向矢量,并通过右手定则确定竖轴方向的方向矢量,该竖轴方向的方向矢量为单位矢量),再根据二维码坐标系的三个坐标轴的方向矢量计算二维码坐标系相对相机坐标系旋转的三个欧拉角(具体计算方法为现有技术),以该三个欧拉角为二维码在相机坐标系下的姿态角度数据中的三个姿态角度值。
其中,测试置具相对二维码的偏置矩阵信息可通过对机器人示教的方式预先标定得到,具体标定过程为:先用该三维相机采集测试台的二维码的二维码图像信息,根据该二维码图像信息获取该二维码在机器人基坐标系下的位姿信息(具体方法参考前文),然后通过示教使机器人把PCBA板放置在该测试台的测试置具,并记录放置时机器人末端的位姿信息(可从机器人控制器中读取),最后根据该二维码在机器人基坐标系下的位姿信息和放置时机器人末端的位姿信息计算得到偏置矩阵信息(假设计算过程中,二维码在机器人基坐标系下的位姿矩阵为Ao,示教放置时机器人末端的位姿矩阵为Bo,偏置矩阵为X,则有Bo =Ao* X,Ao -1 * Bo = X,其中Ao -1为矩阵Ao的逆,求得偏置矩阵X并进行保存)。
由于测试台可能不止一个,对于每一个测试台均可通过上述标定过程得到对应的偏置矩阵信息。
在一些实施方式中,第三获取模块3用于在根据二维码图像信息获取预先标定的测试置具相对二维码的偏置矩阵信息的时候,执行:
对二维码图像信息中的二维码进行解析,得到解析信息;
从解析信息中提取测试台的编号信息;
根据编号信息在本地数据库中查询得到偏置矩阵信息。
即,在该实施方式中,在机器人控制装置的本地数据库中会预先存储各测试台的编号信息和对应的偏置矩阵信息,而测试台的二维码的解析信息包含对应的测试台的编号信息;通过解析二维码得到测试台的编号信息,进而可在本地数据库中查询得到对应的偏置矩阵信息。
在另一些实施方式中,第三获取模块3用于在根据二维码图像信息获取预先标定的测试置具相对二维码的偏置矩阵信息的时候,执行:
对二维码图像信息中的二维码进行解析,得到解析信息;
从解析信息中提取偏置矩阵信息。
即,在该实施方式中,把偏置矩阵信息作为二维码的解析信息之一记载在二维码上,直接识别该二维码即可得到偏置矩阵信息,方便快捷,且无需在机器人控制装置中预先存储各测试台的偏置矩阵信息,降低对机器人控制装置的存储资源的占用,当有新增加的测试台时,也无需进行机器人控制装置的本地数据库的更新。
具体地,第一计算模块4用于在根据二维码在机器人基坐标系下的位姿信息和偏置矩阵信息计算测试置具在机器人基坐标系下的位姿信息的时候,执行:
用二维码在机器人基坐标系下的位姿信息与偏置矩阵信息相乘,得到测试置具在机器人基坐标系下的位姿信息(假设当前二维码在机器人基坐标系下的位姿矩阵为Ac,偏置矩阵为X已知,需要求得的测试置具在机器人基坐标系下的位姿矩阵,即机器人放置位姿矩阵为Bc,则有Bc= Ac * X)。
在一些实施方式中,第一执行模块5用于在根据测试置具在机器人基坐标系下的位姿信息向机器人发送控制指令,使机器人把PCBA板放置在测试置具上的时候,执行:
根据测试置具在机器人基坐标系下的位姿信息规划放置路径,得到放置路径信息;
根据放置路径信息生成控制指令;控制指令包含放置路径信息;
把控制指令发送至机器人,使机器人沿放置路径把PCBA板放置在测试置具上。
其中,规划的放置路径的放置路径信息包括多个路径点的位姿信息,且这些路径点中包括一个放置点,该放置点的位姿信息与测试置具在机器人基坐标系下的位姿信息相同,从而当机器人沿该放置路径移动时,当到达放置点时即把PCBA板准确地放置在该测试置具上。具体的路径规划方法可采用现有的规划方法,此处不对其进行限定。
优选地,放置路径包括一个过渡路径点,过渡路径点位于测试置具正上方的预设高度处。
该预设高度可根据实际需要设置,在该实施方式中,机器人进行PCBA板放置时会先移动到过渡路径点,然后会带动PCBA板竖直往下移动至测试置具处(即过渡路径点后包括一段竖直的路径),可保证测试置具上的一些定位柱和探针准确插入PCBA板上对应的插孔中,避免损坏测试置具和PCBA板(若PCBA板在放入测试置具的过程中具有横向的速度,则容易导致定位柱、探针或PCBA板上的一些连接部位的变形或折断)。
在实际应用中,机器人需要从PCBA板生产线中多次取出PCBA板放置在测试台进行测试,在每次取出一个PCBA板进行测试时,第一获取模块1、第二获取模块2、第三获取模块3、第一计算模块4和第一执行模块5均可执行一次对应的操作(即第一获取模块1获取由三维相机采集的二维码的二维码图像信息;第二获取模块2根据二维码图像信息获取二维码在机器人基坐标系下的位姿信息;第三获取模块3根据二维码图像信息获取预先标定的测试置具相对二维码的偏置矩阵信息;第一计算模块4根据二维码在机器人基坐标系下的位姿信息和偏置矩阵信息计算测试置具在机器人基坐标系下的位姿信息;第一执行模块5根据测试置具在机器人基坐标系下的位姿信息向机器人发送控制指令,使机器人把PCBA板放置在测试置具上)。但测试台的位置可能并没有发生移动,从而,可每完成预设数量(可根据实际需要设置,例如20块)的PCBA板的测试,第一获取模块1、第二获取模块2、第三获取模块3、第一计算模块4和第一执行模块5执行一次对应的操作,从而提高工作效率。
实际上,为了提高效率,该机器人定位放置控制装置还可包括第一判断模块和第二执行模块;
其中,第一判断模块用于在第二获取模块2根据二维码图像信息获取二维码在机器人基坐标系下的位姿信息后,判断当前获取的二维码在机器人基坐标系下的位姿信息与上一次获取的二维码在机器人基坐标系下的位姿信息之间的偏差是否过大;
其中,第三获取模块3、第一计算模块4和第一执行模块5用于在当前获取的二维码在机器人基坐标系下的位姿信息与上一次获取的二维码在机器人基坐标系下的位姿信息之间的偏差过大时,才执行对应的操作;
其中,第二执行模块用于在当前获取的二维码在机器人基坐标系下的位姿信息与上一次获取的二维码在机器人基坐标系下的位姿信息之间的偏差不过大时,则向机器人发送控制指令,使机器人沿上一次规划得到的放置路径把PCBA板放置在测试置具上。
其中,若当前获取的二维码在机器人基坐标系下的位姿信息的至少一个参数与上一次获取的二维码在机器人基坐标系下的位姿信息的相应参数之间的偏差(为绝对值)超过相应的预设偏差阈值,则判定当前获取的二维码在机器人基坐标系下的位姿信息与上一次获取的二维码在机器人基坐标系下的位姿信息之间的偏差过大。
当前获取的二维码在机器人基坐标系下的位姿信息与上一次获取的二维码在机器人基坐标系下的位姿信息之间的偏差过大,说明测试台发生了移动或转动,否则说明测试台的位置没有发生变化,因此,只有在测试台发生了移动或转动时才重新规划放置路径,可降低规划放置路径的频率,提高工作效率。其中,当三维相机设置在机器人端部的时候,可预先设定一个拍照位姿点,使机器人以固定位姿进行二维码的二维码图像信息的采集,由于机器人位置控制是存在误差的,若每次在不同的位姿点进行拍照,则会引入不同的位姿误差,从而在判断当前获取的二维码在机器人基坐标系下的位姿信息与上一次获取的二维码在机器人基坐标系下的位姿信息之间的偏差是否过大的时候,容易发生误判;此处,每次均在同一拍照位姿点进行拍照,位姿误差是基本相当的,从而有利于降低误判的概率。
进一步地,当三维相机设置在机器人端部且预先设定了一个拍照位姿点的时候,进行路径规划时可只规划从拍照位姿点到放置点的之间的路径,从而PCBA板生产线到拍照位姿点的路径可固定不变,从而可提高路径规划的效率。机器人工作时,先从PCBA板生产线取出PCBA板并沿固定路径移动到拍照位姿点,然后进行拍照以采集二维码的二维码图像信息,接着按规划的放置路径移动到测试置具处把PCBA板放入该测试置具中。
由上可知,该机器人定位放置控制装置,通过获取由三维相机采集的二维码的二维码图像信息;二维码设置在测试台上;根据二维码图像信息获取二维码在机器人基坐标系下的位姿信息;根据二维码图像信息获取预先标定的测试置具相对二维码的偏置矩阵信息;根据二维码在机器人基坐标系下的位姿信息和偏置矩阵信息计算测试置具在机器人基坐标系下的位姿信息;根据测试置具在机器人基坐标系下的位姿信息向机器人发送控制指令,使机器人把PCBA板放置在测试置具上;由于每个测试台的二维码和测试置具之间的相对位置是固定的,其偏置矩阵信息是固定的,当更换测试台或测试台的位置被挪动,只需要知道二维码在机器人基坐标系下的实际的位姿信息,就可快速地计算得到对应的测试置具在机器人基坐标系下的实际的位姿信息,进而可自动调整放置位置,避免在测试台位置变化时需要重新示教而影响工作效率。
请参照图3,图3为本申请实施例提供的一种电子设备的结构示意图,该电子设备包括:处理器301和存储器302,处理器301和存储器302通过通信总线303和/或其他形式的连接机构(未标出)互连并相互通讯,存储器302存储有处理器301可执行的计算机程序,当电子设备运行时,处理器301执行该计算机程序,以执行上述实施例的任一可选的实现方式中的机器人定位放置控制方法,以实现以下功能:获取由三维相机采集的二维码的二维码图像信息;二维码设置在测试台上;根据二维码图像信息获取二维码在机器人基坐标系下的位姿信息;根据二维码图像信息获取预先标定的测试置具相对二维码的偏置矩阵信息;根据二维码在机器人基坐标系下的位姿信息和偏置矩阵信息计算测试置具在机器人基坐标系下的位姿信息;根据测试置具在机器人基坐标系下的位姿信息向机器人发送控制指令,使机器人把PCBA板放置在测试置具上。
本申请实施例提供一种存储介质,其上存储有计算机程序,计算机程序被处理器执行时,执行上述实施例的任一可选的实现方式中的机器人定位放置控制方法,以实现以下功能:获取由三维相机采集的二维码的二维码图像信息;二维码设置在测试台上;根据二维码图像信息获取二维码在机器人基坐标系下的位姿信息;根据二维码图像信息获取预先标定的测试置具相对二维码的偏置矩阵信息;根据二维码在机器人基坐标系下的位姿信息和偏置矩阵信息计算测试置具在机器人基坐标系下的位姿信息;根据测试置具在机器人基坐标系下的位姿信息向机器人发送控制指令,使机器人把PCBA板放置在测试置具上。其中,存储介质可以由任何类型的易失性或非易失性存储设备或者它们的组合实现,如静态随机存取存储器(Static Random Access Memory, 简称SRAM),电可擦除可编程只读存储器(Electrically Erasable Programmable Read-Only Memory, 简称EEPROM),可擦除可编程只读存储器(Erasable Programmable Read Only Memory, 简称EPROM),可编程只读存储器(Programmable Red-Only Memory, 简称PROM),只读存储器(Read-Only Memory, 简称ROM),磁存储器,快闪存储器,磁盘或光盘。
在本申请所提供的实施例中,应该理解到,所揭露装置和方法,可以通过其它的方式实现。以上所描述的装置实施例仅仅是示意性的,例如,所述单元的划分,仅仅为一种逻辑功能划分,实际实现时可以有另外的划分方式,又例如,多个单元或组件可以结合或者可以集成到另一个系统,或一些特征可以忽略,或不执行。另一点,所显示或讨论的相互之间的耦合或直接耦合或通信连接可以是通过一些通信接口,装置或单元的间接耦合或通信连接,可以是电性,机械或其它的形式。
另外,作为分离部件说明的单元可以是或者也可以不是物理上分开的,作为单元显示的部件可以是或者也可以不是物理单元,即可以位于一个地方,或者也可以分布到多个网络单元上。可以根据实际的需要选择其中的部分或者全部单元来实现本实施例方案的目的。
再者,在本申请各个实施例中的各功能模块可以集成在一起形成一个独立的部分,也可以是各个模块单独存在,也可以两个或两个以上模块集成形成一个独立的部分。
在本文中,诸如第一和第二等之类的关系术语仅仅用来将一个实体或者操作与另一个实体或操作区分开来,而不一定要求或者暗示这些实体或操作之间存在任何这种实际的关系或者顺序。
以上所述仅为本申请的实施例而已,并不用于限制本申请的保护范围,对于本领域的技术人员来说,本申请可以有各种更改和变化。凡在本申请的精神和原则之内,所作的任何修改、等同替换、改进等,均应包含在本申请的保护范围之内。

Claims (7)

1.一种机器人定位放置控制方法,用于机器人控制装置,以控制机器人把PCBA板放置在测试台的测试置具上,其特征在于,包括以下步骤:
A1.获取由三维相机采集的二维码的二维码图像信息;所述二维码设置在所述测试台上;
A2.根据所述二维码图像信息获取所述二维码在机器人基坐标系下的位姿信息;
A3.根据所述二维码图像信息获取预先标定的所述测试置具相对所述二维码的偏置矩阵信息;
A4.根据所述二维码在机器人基坐标系下的位姿信息和所述偏置矩阵信息计算所述测试置具在机器人基坐标系下的位姿信息;
A5.根据所述测试置具在机器人基坐标系下的位姿信息向所述机器人发送控制指令,使所述机器人把所述PCBA板放置在所述测试置具上;
步骤A3包括:对所述二维码图像信息中的二维码进行解析,得到解析信息;从所述解析信息中提取所述偏置矩阵信息;
步骤A5包括:
根据所述测试置具在机器人基坐标系下的位姿信息规划放置路径,得到放置路径信息;
根据所述放置路径信息生成控制指令;所述控制指令包含所述放置路径信息;
把所述控制指令发送至所述机器人,使所述机器人沿所述放置路径把所述PCBA板放置在所述测试置具上;
步骤A2之后,先判断当前获取的二维码在机器人基坐标系下的位姿信息与上一次获取的二维码在机器人基坐标系下的位姿信息之间的偏差是否过大,若是,才执行步骤A3-A5,若否,则向机器人发送控制指令,使机器人沿上一次规划得到的放置路径把PCBA板放置在测试置具上。
2.根据权利要求1所述的机器人定位放置控制方法,其特征在于,步骤A2包括:
根据所述二维码图像信息获取所述二维码在所述三维相机的相机坐标系下的第一位姿信息;
根据所述第一位姿信息和预先标定得到的第一位姿转换矩阵,计算所述二维码在机器人基坐标系下的位姿信息。
3.根据权利要求2所述的机器人定位放置控制方法,其特征在于,所述根据所述二维码图像信息获取所述二维码在所述三维相机的相机坐标系下的第一位姿信息的步骤包括:
通过图像识别方法获取所述二维码图像信息中的二维码中心点在所述相机坐标系下的位置坐标数据,作为所述第一位姿信息的位置坐标数据;
通过图像识别方法获取所述二维码图像信息中的二维码的三个定位图标中心点在所述相机坐标系下的位置坐标数据;
根据所述三个定位图标中心点在所述相机坐标系下的位置坐标数据,计算所述二维码在所述相机坐标系下的姿态角度数据,作为所述第一位姿信息的姿态角度数据。
4.根据权利要求1所述的机器人定位放置控制方法,其特征在于,所述放置路径包括一个过渡路径点,所述过渡路径点位于所述测试置具正上方的预设高度处。
5.一种机器人定位放置控制装置,用于机器人控制装置,以控制机器人把PCBA板放置在测试台的测试置具上,其特征在于,包括:
第一获取模块,用于获取由三维相机采集的二维码的二维码图像信息;所述二维码设置在所述测试台上;
第二获取模块,用于根据所述二维码图像信息获取所述二维码在机器人基坐标系下的位姿信息;
第三获取模块,用于根据所述二维码图像信息获取预先标定的所述测试置具相对所述二维码的偏置矩阵信息;
第一计算模块,用于根据所述二维码在机器人基坐标系下的位姿信息和所述偏置矩阵信息计算所述测试置具在机器人基坐标系下的位姿信息;
第一执行模块,用于根据所述测试置具在机器人基坐标系下的位姿信息向所述机器人发送控制指令,使所述机器人把PCBA板放置在所述测试置具上;
第三获取模块用于在根据二维码图像信息获取预先标定的测试置具相对二维码的偏置矩阵信息的时候,执行:对所述二维码图像信息中的二维码进行解析,得到解析信息;从所述解析信息中提取所述偏置矩阵信息;
第一执行模块用于在根据所述测试置具在机器人基坐标系下的位姿信息向所述机器人发送控制指令,使所述机器人把PCBA板放置在所述测试置具上的时候,执行:
根据所述测试置具在机器人基坐标系下的位姿信息规划放置路径,得到放置路径信息;
根据所述放置路径信息生成控制指令;所述控制指令包含所述放置路径信息;
把所述控制指令发送至所述机器人,使所述机器人沿所述放置路径把所述PCBA板放置在所述测试置具上;
所述器人定位放置控制装置还包括第一判断模块和第二执行模块;
其中,第一判断模块用于在第二获取模块根据二维码图像信息获取二维码在机器人基坐标系下的位姿信息后,判断当前获取的二维码在机器人基坐标系下的位姿信息与上一次获取的二维码在机器人基坐标系下的位姿信息之间的偏差是否过大;
其中,第三获取模块、第一计算模块和第一执行模块用于在当前获取的二维码在机器人基坐标系下的位姿信息与上一次获取的二维码在机器人基坐标系下的位姿信息之间的偏差过大时,才执行对应的操作;
其中,第二执行模块用于在当前获取的二维码在机器人基坐标系下的位姿信息与上一次获取的二维码在机器人基坐标系下的位姿信息之间的偏差不过大时,则向机器人发送控制指令,使机器人沿上一次规划得到的放置路径把PCBA板放置在测试置具上。
6.一种电子设备,其特征在于,包括处理器以及存储器,所述存储器存储有计算机可读取指令,当所述计算机可读取指令由所述处理器执行时,运行如权利要求1-4任一项所述机器人定位放置控制方法中的步骤。
7.一种存储介质,其上存储有计算机程序,其特征在于,所述计算机程序被处理器执行时运行如权利要求1-4任一项所述机器人定位放置控制方法中的步骤。
CN202111228181.XA 2021-10-21 2021-10-21 机器人定位放置控制方法、装置、电子设备及存储介质 Active CN113664838B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202111228181.XA CN113664838B (zh) 2021-10-21 2021-10-21 机器人定位放置控制方法、装置、电子设备及存储介质

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202111228181.XA CN113664838B (zh) 2021-10-21 2021-10-21 机器人定位放置控制方法、装置、电子设备及存储介质

Publications (2)

Publication Number Publication Date
CN113664838A CN113664838A (zh) 2021-11-19
CN113664838B true CN113664838B (zh) 2022-01-18

Family

ID=78550777

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202111228181.XA Active CN113664838B (zh) 2021-10-21 2021-10-21 机器人定位放置控制方法、装置、电子设备及存储介质

Country Status (1)

Country Link
CN (1) CN113664838B (zh)

Families Citing this family (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN114415664A (zh) * 2021-12-16 2022-04-29 北京航天测控技术有限公司 一种机器人导航方法及装置
CN115479592A (zh) * 2022-08-30 2022-12-16 浙江国自机器人技术股份有限公司 库位标定方法、装置、系统、电子装置和存储介质
CN116147527A (zh) * 2023-02-15 2023-05-23 思看科技(杭州)股份有限公司 三维扫描系统及其扫描路径规划方法

Family Cites Families (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
KR100258950B1 (ko) * 1997-09-23 2000-06-15 윤종용 부품 실장기의 위치설정방법
JP4301775B2 (ja) * 2002-07-18 2009-07-22 シャープ株式会社 2次元コード読み取り装置,2次元コード読み取り方法,2次元コード読み取りプログラム及び該プログラムの記録媒体
CN105467294B (zh) * 2015-11-23 2018-09-28 上海无线电设备研究所 一种用于pcba自动测试的定位系统和方法
CN106989746A (zh) * 2017-03-27 2017-07-28 远形时空科技(北京)有限公司 导航方法及导航装置
CN108594822A (zh) * 2018-05-10 2018-09-28 哈工大机器人(昆山)有限公司 基于二维码的机器人定位方法、机器人充电方法及系统

Also Published As

Publication number Publication date
CN113664838A (zh) 2021-11-19

Similar Documents

Publication Publication Date Title
CN113664838B (zh) 机器人定位放置控制方法、装置、电子设备及存储介质
CN106514651B (zh) 测量装置以及校准方法
CN107073719B (zh) 机器人和机器人系统
CN107687855B (zh) 机器人定位方法、装置及机器人
CN109407603B (zh) 一种控制机械臂抓取物体的方法及装置
JP2007245283A (ja) ワーク姿勢検知装置、ワーク姿勢検知方法、ピッキングシステム、およびピッキング方法
CN113370221B (zh) 机器人tcp标定系统、方法、装置、设备及存储介质
JP2017102529A (ja) ワーク位置姿勢算出装置およびハンドリングシステム
US20220230348A1 (en) Method and apparatus for determining a three-dimensional position and pose of a fiducial marker
EP4005745A1 (en) Autonomous robot tooling system, control system, control method, and storage medium
CN109715307A (zh) 具有工作区图像捕获设备的弯曲机以及用于表示工作区的方法
CN110621150A (zh) 印制电路板的组装方法及相关装置
JP6424432B2 (ja) 制御装置、ロボットシステム、ロボット及びロボット制御方法
CN113240731B (zh) 托盘中心位置的确定方法、装置、电子设备及存储介质
CN112621765B (zh) 一种基于机械手的设备自动组装控制方法及装置
CN113840695A (zh) 标定检验组件、机器人系统、检验方法和标定方法
CN113601510A (zh) 基于双目视觉的机器人移动控制方法、装置、系统及设备
CN106507656A (zh) 装配位置的示教
CN112529856A (zh) 确定操作对象位置的方法、机器人和自动化系统
CN112643324A (zh) 自动打螺丝设备及采用该设备的自动打螺丝的方法
EP4144494A1 (en) Image processing method, image processing device, robot mounted-type conveyance device, and system
CN114862963A (zh) 贴合定位方法、装置、设备及存储介质
US11577400B2 (en) Method and apparatus for managing robot system
CN114266822A (zh) 基于双目机器人的工件质检方法、装置、机器人及介质
CN112560513A (zh) Nfc测试系统及方法

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
GR01 Patent grant
GR01 Patent grant