[go: up one dir, main page]

CN108607819A - Material sorting system and method - Google Patents

Material sorting system and method Download PDF

Info

Publication number
CN108607819A
CN108607819A CN201810380261.9A CN201810380261A CN108607819A CN 108607819 A CN108607819 A CN 108607819A CN 201810380261 A CN201810380261 A CN 201810380261A CN 108607819 A CN108607819 A CN 108607819A
Authority
CN
China
Prior art keywords
robot
image
processing equipment
image data
material sorting
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
CN201810380261.9A
Other languages
Chinese (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.)
Chongqing University of Post and Telecommunications
Original Assignee
Chongqing University of Post and Telecommunications
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 Chongqing University of Post and Telecommunications filed Critical Chongqing University of Post and Telecommunications
Priority to CN201810380261.9A priority Critical patent/CN108607819A/en
Publication of CN108607819A publication Critical patent/CN108607819A/en
Pending legal-status Critical Current

Links

Classifications

    • BPERFORMING OPERATIONS; TRANSPORTING
    • B07SEPARATING SOLIDS FROM SOLIDS; SORTING
    • B07CPOSTAL SORTING; SORTING INDIVIDUAL ARTICLES, OR BULK MATERIAL FIT TO BE SORTED PIECE-MEAL, e.g. BY PICKING
    • B07C5/00Sorting according to a characteristic or feature of the articles or material being sorted, e.g. by control effected by devices which detect or measure such characteristic or feature; Sorting by manually actuated devices, e.g. switches
    • B07C5/34Sorting according to other particular properties
    • B07C5/342Sorting according to other particular properties according to optical properties, e.g. colour
    • B07C5/3422Sorting according to other particular properties according to optical properties, e.g. colour using video scanning devices, e.g. TV-cameras
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B07SEPARATING SOLIDS FROM SOLIDS; SORTING
    • B07CPOSTAL SORTING; SORTING INDIVIDUAL ARTICLES, OR BULK MATERIAL FIT TO BE SORTED PIECE-MEAL, e.g. BY PICKING
    • B07C5/00Sorting according to a characteristic or feature of the articles or material being sorted, e.g. by control effected by devices which detect or measure such characteristic or feature; Sorting by manually actuated devices, e.g. switches
    • B07C5/02Measures preceding sorting, e.g. arranging articles in a stream orientating
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B07SEPARATING SOLIDS FROM SOLIDS; SORTING
    • B07CPOSTAL SORTING; SORTING INDIVIDUAL ARTICLES, OR BULK MATERIAL FIT TO BE SORTED PIECE-MEAL, e.g. BY PICKING
    • B07C5/00Sorting according to a characteristic or feature of the articles or material being sorted, e.g. by control effected by devices which detect or measure such characteristic or feature; Sorting by manually actuated devices, e.g. switches
    • B07C5/36Sorting apparatus characterised by the means used for distribution
    • B07C5/361Processing or control devices therefor, e.g. escort memory
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B07SEPARATING SOLIDS FROM SOLIDS; SORTING
    • B07CPOSTAL SORTING; SORTING INDIVIDUAL ARTICLES, OR BULK MATERIAL FIT TO BE SORTED PIECE-MEAL, e.g. BY PICKING
    • B07C5/00Sorting according to a characteristic or feature of the articles or material being sorted, e.g. by control effected by devices which detect or measure such characteristic or feature; Sorting by manually actuated devices, e.g. switches
    • B07C5/36Sorting apparatus characterised by the means used for distribution
    • B07C5/361Processing or control devices therefor, e.g. escort memory
    • B07C5/362Separating or distributor mechanisms
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B07SEPARATING SOLIDS FROM SOLIDS; SORTING
    • B07CPOSTAL SORTING; SORTING INDIVIDUAL ARTICLES, OR BULK MATERIAL FIT TO BE SORTED PIECE-MEAL, e.g. BY PICKING
    • B07C2501/00Sorting according to a characteristic or feature of the articles or material to be sorted
    • B07C2501/0063Using robots

Landscapes

  • Engineering & Computer Science (AREA)
  • Multimedia (AREA)
  • Manipulator (AREA)

Abstract

The embodiment of the present invention provides a kind of Material Sorting system and method.The Material Sorting system includes:First imaging sensor and the second imaging sensor, the image data for obtaining the object;The image acquisition device being connect with described first image sensor and second imaging sensor, for acquiring described image data;The processing equipment being connect with described image collector, the processing equipment are used to be calculated the three-dimensional information of the object and the volume of the object according to described image data;The processing equipment is additionally operable to generate the movement instruction of control robot according to the three-dimensional information and volume;The robot being connect with the processing equipment, the robot are used to receive the movement instruction of the processing equipment, to adjust end according to the movement instruction to capture the object.

Description

物料分拣系统及方法Material sorting system and method

技术领域technical field

本发明涉及控制技术领域,具体而言,涉及一种物料分拣系统及方法。The invention relates to the technical field of control, in particular to a material sorting system and method.

背景技术Background technique

目前采用的分拣技术,其一系列运动是采用示教或者离线编程的方法,所有的动作和摆放的位置都要预先进行严格的设定,一旦工作环境条件变化,就会出现分拣错误,智能化水平低。因此,需要一种能够更准确地定位物料的物料分拣方式。The current sorting technology uses a series of movements through teaching or offline programming. All actions and positions must be strictly set in advance. Once the working environment conditions change, sorting errors will occur. , low level of intelligence. Therefore, there is a need for a material sorting method capable of more accurately locating materials.

发明内容Contents of the invention

有鉴于此,本发明实施例的目的在于提供一种物料分拣系统及方法。In view of this, the purpose of the embodiments of the present invention is to provide a material sorting system and method.

本发明实施例提供的一种物料分拣系统,所述物料分拣系统包括:A material sorting system provided in an embodiment of the present invention, the material sorting system includes:

第一图像传感器,用于获取目标物的第一图像数据;The first image sensor is used to acquire the first image data of the target;

第二图像传感器,用于获取所述目标物的第二图像数据;a second image sensor, configured to acquire second image data of the target;

与所述第一图像传感器和所述第二图像传感器连接的图像采集器,用于采集所述第一图像传感器获取的第一图像数据及第二图像传感器获取的第二图像数据;An image collector connected to the first image sensor and the second image sensor, configured to collect first image data obtained by the first image sensor and second image data obtained by the second image sensor;

与所述图像采集器连接的处理设备,所述处理设备用于从所述图像采集器获取所述第一图像数据及第二图像数据,并根据所述第一图像数据及第二图像数据计算得到所述目标物的三维信息及该目标物的体积;A processing device connected to the image collector, the processing device is used to obtain the first image data and the second image data from the image collector, and calculate according to the first image data and the second image data Obtaining the three-dimensional information of the target object and the volume of the target object;

所述处理设备还用于根据所述三维信息及体积生成控制机器人的运动指令;The processing device is also used to generate motion instructions for controlling the robot according to the three-dimensional information and volume;

与所述处理设备连接的机器人,所述机器人用于接收所述处理设备的运动指令,以根据所述运动指令调整末端以抓取所述目标物。A robot connected to the processing device, the robot is used to receive a motion command from the processing device, so as to adjust the end according to the motion command to grab the target.

本发明实施例还提供一种物料分拣方法,包括:The embodiment of the present invention also provides a material sorting method, including:

获取第一采集设备采集的目标物的第一图像数据及第二采集设备采集的目标物的第二图像数据;Acquiring first image data of the target collected by the first collection device and second image data of the target collected by the second collection device;

使用所述第一图像数据及第二图像数据定位所述目标物的三维信息及体积;using the first image data and the second image data to locate the three-dimensional information and volume of the target;

根据所述三维信息及体积生成控制机器人的运动指令;Generate motion instructions for controlling the robot according to the three-dimensional information and volume;

将所述运动指令发送给机器人,以使所述机器人根据所述运动指令调整末端以抓取所述目标物。Sending the motion command to the robot, so that the robot adjusts the end according to the motion command to grab the target.

与现有技术相比,本发明实施例的物料分拣系统及方法,通过获取目标物的两个图像数据,使用两个图像数据计算得到目标物的三维信息和体积,可以使生成的运动指令能够更好地使机器人定位到所述目标物的位置,从而降低机器人抓取目标物的误差。Compared with the prior art, the material sorting system and method of the embodiment of the present invention obtains two image data of the target object, and uses the two image data to calculate the three-dimensional information and volume of the target object, so that the generated motion command can be The robot can be better positioned to the position of the target, thereby reducing the error of the robot grabbing the target.

为使本发明的上述目的、特征和优点能更明显易懂,下文特举实施例,并配合所附附图,作详细说明如下。In order to make the above objects, features and advantages of the present invention more comprehensible, the following specific embodiments are described in detail in conjunction with the accompanying drawings.

附图说明Description of drawings

为了更清楚地说明本发明实施例的技术方案,下面将对实施例中所需要使用的附图作简单地介绍,应当理解,以下附图仅示出了本发明的某些实施例,因此不应被看作是对范围的限定,对于本领域普通技术人员来讲,在不付出创造性劳动的前提下,还可以根据这些附图获得其他相关的附图。In order to illustrate the technical solutions of the embodiments of the present invention more clearly, the accompanying drawings used in the embodiments will be briefly introduced below. It should be understood that the following drawings only show some embodiments of the present invention, and thus It should be regarded as a limitation on the scope, and those skilled in the art can also obtain other related drawings based on these drawings without creative work.

图1为本发明实施例提供的物料分拣系统的运行环境示意图。Fig. 1 is a schematic diagram of the operating environment of the material sorting system provided by the embodiment of the present invention.

图2为本发明实施例提供的物料分拣方法的流程图。Fig. 2 is a flowchart of a material sorting method provided by an embodiment of the present invention.

图3为本发明实施例提供的物料分拣方法的部分流程图。Fig. 3 is a partial flow chart of the material sorting method provided by the embodiment of the present invention.

图4为本发明实施例提供的物料分拣方法的部分流程图。Fig. 4 is a partial flowchart of the material sorting method provided by the embodiment of the present invention.

图标:10-物料分拣系统;110-第一图像传感器;120-第二图像传感器;200-图像采集器;300-处理设备;400-机器人;500-机器人控制器;600-支架;610-横臂;620-支撑臂;700-传送带;800-触发控制装置。Icons: 10-material sorting system; 110-first image sensor; 120-second image sensor; 200-image collector; 300-processing equipment; 400-robot; 500-robot controller; 600-bracket; 610- Cross arm; 620-support arm; 700-conveyor belt; 800-trigger control device.

具体实施方式Detailed ways

下面将结合本发明实施例中附图,对本发明实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例仅仅是本发明一部分实施例,而不是全部的实施例。通常在此处附图中描述和示出的本发明实施例的组件可以以各种不同的配置来布置和设计。因此,以下对在附图中提供的本发明的实施例的详细描述并非旨在限制要求保护的本发明的范围,而是仅仅表示本发明的选定实施例。基于本发明的实施例,本领域技术人员在没有做出创造性劳动的前提下所获得的所有其他实施例,都属于本发明保护的范围。The following will clearly and completely describe the technical solutions in the embodiments of the present invention with reference to the accompanying drawings in the embodiments of the present invention. Obviously, the described embodiments are only some, not all, embodiments of the present invention. The components of the embodiments of the invention generally described and illustrated in the figures herein may be arranged and designed in a variety of different configurations. Accordingly, the following detailed description of the embodiments of the invention provided in the accompanying drawings is not intended to limit the scope of the claimed invention, but merely represents selected embodiments of the invention. Based on the embodiments of the present invention, all other embodiments obtained by those skilled in the art without making creative efforts belong to the protection scope of the present invention.

应注意到:相似的标号和字母在下面的附图中表示类似项,因此,一旦某一项在一个附图中被定义,则在随后的附图中不需要对其进行进一步定义和解释。同时,在本发明的描述中,术语“第一”、“第二”等仅用于区分描述,而不能理解为指示或暗示相对重要性。It should be noted that like numerals and letters denote similar items in the following figures, therefore, once an item is defined in one figure, it does not require further definition and explanation in subsequent figures. Meanwhile, in the description of the present invention, the terms "first", "second", etc. are only used to distinguish descriptions, and cannot be understood as indicating or implying relative importance.

对于工作在结构化或非结构化环境中的机器人来说,视觉系统是非常重要的,将视觉和机器人控制结合起来的机器人视觉伺服是当前的一个重要研究方向和提高机器人智能化水平的研究热点之一。以往的分拣不搭配视觉系统,在分拣时需要对物料进行机械定位,效率低下,过程漫长,速度慢。因此,双目立体视觉与工业机器人的视觉伺服控制技术相结合对于提高分拣实时引导具有重要作用。目前,在物流行业、码垛及流水线作业等行业中分拣技术呈现智能化、高效率的发展趋势。工业机器人和双目立体视觉所组成的混合物料的分拣动态引导方法一方面具有效率高、环境适应能力强,能够实时得到物料的三维信息,另一方面采用双目立体视觉进行定位具有效率高、精度合适、非常适合于实时作业的控制,对于运动物体定位中,图像的获取瞬间完成,系统能对物料进行无接触的方式识别,应用前景广阔。但是,目前采用的分拣技术,其一系列运动是采用示教或者离线编程的方法,所有的动作和摆放的位置都要预先进行严格的设定,一旦工作环境条件变化,就会出现分拣错误,智能化水平低。其具体可能会存在问题如下:1)通常情况下传送带上的物料是通过人工或者辅助机器人协助放料,因此,就会造成工件在定位时出现三维空间上的误差;包括平移误差和旋转误差。所以机器人在进行实时分拣引导时,要进行末端执行器的姿态修正,以适应分拣的作业,当物料的尺寸不一致时,若不进行机器人末端姿态调整,势必会降低分拣质量。For robots working in a structured or unstructured environment, the visual system is very important. Robot visual servoing that combines vision and robot control is an important research direction and a research hotspot for improving the level of robot intelligence. one. In the past, sorting was not equipped with a vision system, and the materials needed to be mechanically positioned during sorting, which was inefficient, long and slow. Therefore, the combination of binocular stereo vision and visual servo control technology of industrial robots plays an important role in improving the real-time guidance of sorting. At present, sorting technology presents a trend of intelligent and high-efficiency development in the logistics industry, palletizing and assembly line operations and other industries. The dynamic guidance method for sorting mixed materials composed of industrial robots and binocular stereo vision has high efficiency and strong environmental adaptability, and can obtain three-dimensional information of materials in real time. On the other hand, using binocular stereo vision for positioning has high efficiency. , The accuracy is appropriate, and it is very suitable for the control of real-time operations. For the positioning of moving objects, the acquisition of images is completed in an instant, and the system can identify materials in a non-contact manner, with broad application prospects. However, in the currently used sorting technology, a series of movements are taught or offline programming. All actions and placements must be strictly set in advance. Once the working environment conditions change, there will be separation Picking mistakes, the level of intelligence is low. The specific possible problems are as follows: 1) Usually, the materials on the conveyor belt are assisted by manual or auxiliary robots. Therefore, three-dimensional space errors will occur when the workpiece is positioned; including translation errors and rotation errors. Therefore, when the robot is performing real-time sorting guidance, it is necessary to correct the posture of the end effector to adapt to the sorting operation. When the size of the material is inconsistent, if the robot’s terminal posture is not adjusted, the sorting quality will inevitably be reduced.

实践表明,传送带上随机摆放的物料误差是客观不可避免,相对于传统人工示教分拣而言,如何提高分拣系统的智能化水平和分拣效率,是解决问题的关键。针对上述问题,采用基于位置型的视觉伺服控制,其特点表现为机器人末端位姿与期望位姿进行比较,计算出机器人的末端位姿偏差,其误差定义在伺服系统的工作空间内。因此,其优点在于使用空间位姿信息描述机器人任务,控制法则设计容易且鲁棒性好。Practice has shown that the random placement of material errors on the conveyor belt is objective and inevitable. Compared with traditional manual teaching sorting, how to improve the intelligence level and sorting efficiency of the sorting system is the key to solving the problem. Aiming at the above problems, the position-based visual servo control is adopted, which is characterized by comparing the end pose of the robot with the expected pose, and calculating the end pose deviation of the robot. The error is defined in the working space of the servo system. Therefore, its advantage lies in the use of spatial pose information to describe robot tasks, and the design of control laws is easy and robust.

因此,开发出一套成本低廉、结构简便、分拣效率高,满足基于位置视觉伺服控制的混合物料三维信息提取的控制和处理系统,对视觉分拣实时引导提供技术支持,市场潜力巨大。针对上述技术研究,本申请通过以下几个实施例进行详细描述。Therefore, to develop a control and processing system with low cost, simple structure and high sorting efficiency, which can satisfy the three-dimensional information extraction of mixed materials based on position visual servo control, and provide technical support for real-time guidance of visual sorting, the market potential is huge. In view of the above-mentioned technical research, the present application is described in detail through the following examples.

本发明实施例提供一种物料分拣系统10,如图1所示,本实施例中的物料分拣系统10包括:第一图像传感器110、第二图像传感器120、图像采集器200、处理设备300及机器人400。An embodiment of the present invention provides a material sorting system 10. As shown in FIG. 1, the material sorting system 10 in this embodiment includes: a first image sensor 110, a second image sensor 120, an image collector 200, and a processing device 300 and 400 for robots.

所述第一图像传感器110用于获取目标物的第一图像数据。所述第二图像传感器120,用于获取所述目标物的第二图像数据。在一种实施方式中,所述第一图像传感器110与所述第二图像传感器120与图1所示的传送带620的距离相同,相对于所述第一图像传感器110和所述第二图像传感器120的载体的转动角度相同或相近。例如,所述第一图像传感器110和所述第二图像传感器120均安装在一与所述传送带620平行的横杆上,所述第一图像传感器110和所述第二图像传感器120相对于所述横杆角度相同或相近,所述第一图像传感器110和所述第二图像传感器120相对于所述传送带620的角度相同或相近。The first image sensor 110 is used to acquire first image data of the target object. The second image sensor 120 is configured to acquire second image data of the target. In one embodiment, the first image sensor 110 and the second image sensor 120 are at the same distance from the conveyor belt 620 shown in FIG. 1 , relative to the first image sensor 110 and the second image sensor The rotation angles of the carriers of 120 are the same or close. For example, the first image sensor 110 and the second image sensor 120 are installed on a horizontal bar parallel to the conveyor belt 620, and the first image sensor 110 and the second image sensor 120 are relatively The angles of the crossbars are the same or similar, and the angles of the first image sensor 110 and the second image sensor 120 relative to the conveyor belt 620 are the same or similar.

所述图像采集器200与所述第一图像传感器110和所述第二图像传感器120连接。所述图像采集器200用于采集所述第一图像传感器110获取的第一图像数据及第二图像传感器120获取的第二图像数据。The image collector 200 is connected with the first image sensor 110 and the second image sensor 120 . The image collector 200 is used to collect the first image data obtained by the first image sensor 110 and the second image data obtained by the second image sensor 120 .

所述处理设备300与所述图像采集器200连接,所述处理设备300用于从所述图像采集器200获取所述第一图像数据及第二图像数据,并根据所述第一图像数据及第二图像数据计算得到所述目标物的三维信息及该目标物的体积。The processing device 300 is connected to the image collector 200, and the processing device 300 is used to acquire the first image data and the second image data from the image collector 200, and according to the first image data and the The second image data is calculated to obtain the three-dimensional information of the target object and the volume of the target object.

所述处理设备300还用于根据所述三维信息及体积生成控制所述机器人400的运动指令。The processing device 300 is further configured to generate motion commands for controlling the robot 400 according to the three-dimensional information and volume.

所述机器人400与所述处理设备300连接,所述机器人400用于接收所述处理设备300的运动指令,以根据所述运动指令调整末端以抓取所述目标物。The robot 400 is connected with the processing device 300, and the robot 400 is configured to receive a motion command from the processing device 300, so as to adjust the end according to the motion command to grab the target.

本实施例中,通过获取所述目标物的体积,可以在生成所述运动指令时,可以使所述机器人末端在所述体积大小范围内沿着所述目标物所在平面张开或闭合,以使所述机器人末端能够更好地抓取所述目标物。进一步地,所述处理设备还可以计算出所述目标物上表面的长度和宽度。In this embodiment, by acquiring the volume of the target, when the movement command is generated, the end of the robot can be opened or closed within the range of the volume along the plane where the target is located, so as to enabling the end of the robot to better grasp the target. Further, the processing device may also calculate the length and width of the upper surface of the target.

例如,所述目标物的上表面的宽度是20cm,长度是50cm,所述机器人末端的张合度可根据所述目标物的宽度和长度,在17-60cm范围内张开,以使所述机器人能够成功抓取所述目标物。For example, the width of the upper surface of the target is 20cm, and the length is 50cm. The degree of opening and closing of the end of the robot can be opened in the range of 17-60cm according to the width and length of the target, so that the robot The target can be successfully grasped.

本实施例中,通过计算第一图像数据与第二图像数据对应点间的位置偏差,来获取所述目标物三维信息。In this embodiment, the three-dimensional information of the target is obtained by calculating the position deviation between the corresponding points of the first image data and the second image data.

本实施例中可通过手眼系统将目标物的三维信息从摄像机坐标系转换到机器人末端坐标系。In this embodiment, the three-dimensional information of the target can be converted from the camera coordinate system to the robot end coordinate system through the hand-eye system.

本实施例中,所述第一图像传感器110可以是CMOS图像传感器(CMOS ImageSensor,简称CIS)。所述CMOS图像传感器是接触式感光器件。所述CMOS图像传感器使用的材料可以是用来制造光敏电阻的硫化镉。所述第一图像传感器110也可以是CCD(chargecoupled device)扫描仪。所述CCD扫描仪是利用微电子技术制成的一种半导体芯片,CCD扫描仪的芯片上有许多光敏单元,通过由一系列透镜、反射镜等组成的光学系统将图象传送到CCD芯片上,实现光电转换功能。本实施例中,所述第二图像传感器120也可以是CMOS图像传感器或CCD扫描仪。In this embodiment, the first image sensor 110 may be a CMOS image sensor (CMOS ImageSensor, CIS for short). The CMOS image sensor is a contact photosensitive device. The material used in the CMOS image sensor may be cadmium sulfide used to manufacture photoresistors. The first image sensor 110 may also be a CCD (charge coupled device) scanner. Described CCD scanner is a kind of semiconductor chip that utilizes microelectronics technology to make, and there are many photosensitive units on the chip of CCD scanner, and image is transmitted to the CCD chip through the optical system that is made up of a series of lenses, mirrors etc. , realize the photoelectric conversion function. In this embodiment, the second image sensor 120 may also be a CMOS image sensor or a CCD scanner.

本实施例中,所述处理设备300可以是网络服务器、数据库服务器等、也可以是个人电脑(personal computer,PC)、平板电脑、智能手机、个人数字助理(personal digitalassistant,PDA)等。In this embodiment, the processing device 300 may be a network server, a database server, etc., or may be a personal computer (personal computer, PC), a tablet computer, a smart phone, a personal digital assistant (personal digital assistant, PDA), etc.

本实施例中所述图像采集器200可以是多路图像采集卡,所述多路图像采集卡实时将图像信号采集到所述处理设备300中。The image collector 200 in this embodiment may be a multi-channel image acquisition card, and the multi-channel image acquisition card collects image signals into the processing device 300 in real time.

在一种实施方式中,采用多路图像采集卡将图像信号采集到处理设备300中,以数据文件的形式保存在硬盘。所述多路图像采集卡可以将所述第一图像传感器110和所述第二图像传感器120所拍摄的视频信号从所述第一图像传感器110和所述第二图像传感器120上转存到所述处理设备300中,并运用所述处理设备300中的图像处理算法完成对目标物的定位识别后转化为机器人400运动指令以控制机器人400的末端执行器到达所述目标物的实际位置。In one embodiment, a multi-channel image acquisition card is used to acquire image signals into the processing device 300 and save them in the hard disk in the form of data files. The multi-channel image acquisition card can transfer the video signals captured by the first image sensor 110 and the second image sensor 120 from the first image sensor 110 and the second image sensor 120 to the In the processing device 300, and use the image processing algorithm in the processing device 300 to complete the positioning and recognition of the target object, and then convert it into a motion command of the robot 400 to control the end effector of the robot 400 to reach the actual position of the target object.

本实施例中采用双目立体视觉技术实现计算目标物在三维笛卡尔空间位置的精确检测,通过高精度的图像传感器获得高质量的图像,通过所述处理设备300进行图像处理可输出用于机器人末端位姿平移调整的平面坐标,同时可进行旋转坐标计算并将结果传递给机器人控制器500修正末端旋转姿态。该部分内容通过双目立体视觉系统与视觉伺服融合处理方式,实现机器人400对目标物的分拣动态引导。In this embodiment, the binocular stereo vision technology is used to realize the accurate detection of the position of the calculation target in the three-dimensional Cartesian space, a high-quality image is obtained through a high-precision image sensor, and the image is processed by the processing device 300 and can be output for the robot. The plane coordinates of the terminal pose translation adjustment, and at the same time, the calculation of the rotation coordinates can be performed and the result can be sent to the robot controller 500 to correct the terminal rotation posture. This part realizes the dynamic guidance of the robot 400 for sorting objects through the binocular stereo vision system and visual servo fusion processing.

本发申请实施例采用双目立体视觉技术,是建立在成像点的视差基础上的,对双目第一图像传感器110和第二图像传感器120到的三维空间中目标物的特征在两个成像平面进行立体匹配,也就是在不同的两个成像平面上找到同一个特征点的成像坐标,一旦有了正确的立体匹配关系,就可以得到相应匹配区域的视差图像,由此获得三维空间中目标物的三维信息,要使机器人400的末端执行器运动到所设定的期望位置(所述目标物的位置),实现末端姿态的在线调整,需要计算出机器人400的末端执行器的当前位姿与期望位置的相对位置或与机器人400基坐标之间的相对位置,机器人400在以这些相对位置量根据逆运动学关系求解出各个关节的控制量,进而实现机器人400的末端姿态在线调整,实现对混合物料的实时定位分拣。The embodiment of the present application adopts the binocular stereo vision technology, which is based on the parallax of the imaging points. The characteristics of the target object in the three-dimensional space captured by the binocular first image sensor 110 and the second image sensor 120 are imaged in two The plane is used for stereo matching, that is, the imaging coordinates of the same feature point are found on two different imaging planes. Once the correct stereo matching relationship is obtained, the parallax image of the corresponding matching area can be obtained, and the object in the three-dimensional space can be obtained. The three-dimensional information of the object, in order to move the end effector of the robot 400 to the set desired position (the position of the target object) and realize the online adjustment of the end posture, it is necessary to calculate the current pose of the end effector of the robot 400 The relative position to the desired position or the relative position to the base coordinates of the robot 400, the robot 400 uses these relative position quantities to solve the control quantities of each joint according to the inverse kinematics relationship, and then realizes the online adjustment of the terminal posture of the robot 400, realizing Real-time positioning and sorting of mixed materials.

所述第一图像传感器110与所述第二传感器在目标物上方通过两个视点观察同一目标物的两幅图像,根据三角测量原理计算不同图像对应像素间的视差,获取深度信息,从而实现三维重构,获得所述目标物的三维信息。在此基础上,需要进行双目立体视觉标定,目的是计算在所述第一图像传感器110与所述第二传感器形成的双目系统中所述第一图像传感器110与所述第二传感器之间的相对位置关系,即求取所述第一图像传感器110与所述第二传感器之间的旋转矩阵R和平移矩阵T。所述三角测量在三角学与几何学上是一借由测量目标点与固定基准线的已知端点的角度,测量目标距离的方法。The first image sensor 110 and the second sensor observe two images of the same target through two viewpoints above the target, calculate the parallax between corresponding pixels of different images according to the principle of triangulation, and obtain depth information, thereby realizing three-dimensional and reconstructing to obtain the three-dimensional information of the target. On this basis, it is necessary to perform binocular stereo vision calibration, the purpose is to calculate the distance between the first image sensor 110 and the second sensor in the binocular system formed by the first image sensor 110 and the second sensor. The relative positional relationship between the first image sensor 110 and the second sensor is to obtain the rotation matrix R and the translation matrix T. In trigonometry and geometry, triangulation is a method of measuring the distance to a target by measuring the angle between the target point and a known endpoint of a fixed datum line.

本实施例中,如图1所示,所述物料分拣系统10还包括机器人控制器500,所述机器人控制器500用于接收所述处理设备300生产的运动指令,以控制所述机器人400运动。In this embodiment, as shown in FIG. 1 , the material sorting system 10 further includes a robot controller 500, and the robot controller 500 is configured to receive motion instructions produced by the processing equipment 300 to control the robot 400 sports.

本实施例中,所述机器人400还用于将所述目标物抓取放置在设定区域。所述处理设备300还用于每放置一次计算所述设定区域的剩余空间。所述处理设备300还用于根据所述目标物的体积及所述剩余空间计算所述设定区域是否能够容纳所述目标物,当不能容纳所述目标物时,将生成提示消息。In this embodiment, the robot 400 is also used to grab and place the target object in a set area. The processing device 300 is further configured to calculate the remaining space of the set area every time the device is placed. The processing device 300 is further configured to calculate whether the set area can accommodate the target object according to the volume of the target object and the remaining space, and generate a prompt message when the target object cannot be accommodated.

本实施例中,所述提示消失可以是显示在所述处理设备300上的文字消息,也可以是由所述处理设备300的音频设备播放的语音消息,还可以是发送给指定电子终端的信息消息。In this embodiment, the disappearance of the prompt can be a text message displayed on the processing device 300, or a voice message played by the audio device of the processing device 300, or a message sent to a designated electronic terminal information.

在一种实施方式中,通过第一图像数据及第二图像数据计算得到所述目标物的边缘三维坐标,根据多个边缘三维坐标计算得到所述目标物的体积。In one embodiment, the three-dimensional coordinates of the edge of the target are calculated through the first image data and the second image data, and the volume of the target is calculated according to the plurality of three-dimensional edge coordinates.

本实施例中,所述物料分拣系统10还包括:设置在指定位置的触发控制装置800,该触发控制装置800,用于当检测到所述目标物时,向所述处理设备300发送检测信号。In this embodiment, the material sorting system 10 further includes: a trigger control device 800 arranged at a designated position, and the trigger control device 800 is used to send a detection message to the processing equipment 300 when the target object is detected. Signal.

所述处理设备300在接收到所述检测信号后,用于向所述第一图像传感器110及第二图像发送触发指令,触发所述第一图像传感器110及第二图像传感器120工作。After receiving the detection signal, the processing device 300 is configured to send a trigger command to the first image sensor 110 and the second image sensor to trigger the first image sensor 110 and the second image sensor 120 to work.

所述处理设备300还用于向与所述处理设备300连接的其它设备发送启动指令,以使所述其它设备开启。The processing device 300 is further configured to send a startup instruction to other devices connected to the processing device 300, so that the other devices are turned on.

在一种实施方式中,所述触发控制装置800安装在传送带620的一端。例如,安装在传送带620接收目标物的一端。图中仅示出了所述触发控制装置800,可以理解的是,所述触发控制装置800可以安装在一个安装架上。In one embodiment, the trigger control device 800 is installed at one end of the conveyor belt 620 . For example, it is installed at one end of the conveyor belt 620 to receive objects. Only the trigger control device 800 is shown in the figure, and it can be understood that the trigger control device 800 can be installed on a mounting bracket.

当所述触发控制装置800扫描到有物料时,将检测信号传递给所述处理设备300,所述处理设备300发出控制指令,触发所述第一图像传感器110和第二图像传感器120进行图像采集并使其他设备同时打开,从而保证系统的扫描速度,提高工作效率。所述其它设备可以包括图像采集器200、机器人400、机器人控制器500等。When the trigger control device 800 detects that there is material, the detection signal is transmitted to the processing device 300, and the processing device 300 issues a control command to trigger the first image sensor 110 and the second image sensor 120 to perform image acquisition. And make other devices open at the same time, so as to ensure the scanning speed of the system and improve work efficiency. The other devices may include an image collector 200, a robot 400, a robot controller 500, and the like.

本实施例中,所述物料分拣系统10还包括:支架600,所述支架600包括横臂610和支撑臂620。In this embodiment, the material sorting system 10 further includes: a bracket 600 , and the bracket 600 includes a cross arm 610 and a support arm 620 .

所述第一图像传感器110和所述第二图像传感器120安装在所述支架600的横臂610上。The first image sensor 110 and the second image sensor 120 are installed on the cross arm 610 of the bracket 600 .

本实施例中,所述支撑臂620上设置多个第一安装位,所述横臂610安装在所述多个第一安装位中的任一安装位处。In this embodiment, the support arm 620 is provided with a plurality of first installation positions, and the cross arm 610 is installed in any one of the plurality of first installation positions.

所述第一安装位置可以是设置在所述支撑臂620上的安装洞,所述横臂610通过固定件安装在所述安装洞处。The first installation position may be an installation hole provided on the support arm 620, and the cross arm 610 is installed in the installation hole through a fixing member.

所述横臂610上设置至少三个第二安装位,所述第一图像传感器110及所述第二图像传感器120安装在所述至少三个第二安装位的两个第二安装位上。At least three second installation positions are provided on the cross arm 610 , and the first image sensor 110 and the second image sensor 120 are installed on two second installation positions of the at least three second installation positions.

本实施例中,所述第二安装位可以是设置在所述横臂610上的凹槽,所述凹槽上设置有安装孔,所述第一图像传感器110和所述第二图像传感器120上连接有安装片,所述安装片上有与所述安装孔对应的通孔。需要安装所述第一图像传感器110或第二图像传感器120时,可以将所述通孔与所述安装孔对应放置,再通过固定件固定。In this embodiment, the second installation position may be a groove provided on the cross arm 610, the groove is provided with installation holes, the first image sensor 110 and the second image sensor 120 A mounting sheet is connected to the top, and the mounting sheet has a through hole corresponding to the mounting hole. When the first image sensor 110 or the second image sensor 120 needs to be installed, the through hole can be placed corresponding to the installation hole, and then fixed by a fixing piece.

本实施例中,如图1所示,所述横臂610可以设置在传送带620的正上方。所述第一图像传感器110和所述第二传感器可以相对所述横臂610旋转。In this embodiment, as shown in FIG. 1 , the cross arm 610 may be arranged directly above the conveyor belt 620 . The first image sensor 110 and the second sensor can rotate relative to the cross arm 610 .

所述横臂610与所述传送带620的距离可以通过调整所述横臂610安装在不同的第一安装位处以实现调整。The distance between the cross arm 610 and the conveyor belt 620 can be adjusted by adjusting the cross arm 610 to be installed at different first installation positions.

通过上述设置在允许的成像范围内,将所述第一图像传感器110和所述第二图像传感器120在高度和横向方向的调节,以适应不同环境下的安装,同时Through the above settings within the allowable imaging range, the first image sensor 110 and the second image sensor 120 can be adjusted in height and lateral directions to adapt to installation in different environments, and at the same time

双目立体视觉系统通过采集传送带620上物料的三维深度图像,进而通过处理系统将获得的图像中计算出混合物料的方向、坐标以及抓取点。考虑到物料的尺寸信息,在允许的测量精度范围内,设计高度可调的支架600和双目角度和横向方向可调的结构。采用悬臂式的支架600可以避开机器人400的工作空间,提高机器人400工作的安全性。The binocular stereo vision system collects the three-dimensional depth image of the material on the conveyor belt 620, and then calculates the direction, coordinates and grabbing point of the mixed material from the obtained image through the processing system. Considering the size information of the material, within the allowable range of measurement accuracy, a height-adjustable bracket 600 and a binocular angle- and lateral-direction adjustable structure are designed. The use of the cantilever bracket 600 can avoid the working space of the robot 400 and improve the safety of the robot 400 working.

本实施例中,所述第一图像传感器110的镜头处安装有第一滤波片;所述第二图像传感器120的镜头处安装有第二滤波片。In this embodiment, a first filter is installed at the lens of the first image sensor 110 ; a second filter is installed at the lens of the second image sensor 120 .

本实施例中,所述第一图像传感器110与所述第二图像传感器120垂直角度或以呈一定夹角直射传送带620上的物料。In this embodiment, the first image sensor 110 and the second image sensor 120 are perpendicular to each other or at a certain angle and directly illuminate the materials on the conveyor belt 620 .

在所述第一图像传感器110和所述第二图像传感器120的镜头前安装特定波长的滤波片,其作用是保证图像采集的高质量和防止外界强光的干扰。Filters with specific wavelengths are installed in front of the lenses of the first image sensor 110 and the second image sensor 120 to ensure the high quality of image collection and prevent interference from external strong light.

进一步地,本实施例中的物料分拣系统10主要包括由两部分,其一是包括双目立体视觉成像系统,主要可包括平行安装的所述第一图像传感器110和所述第二图像传感器120、支架600构成。主要定位完成传送带620上混合物料的坐标、方向及抓取点的提取。其二是处理设备300、图像采集器200、融合位置视觉伺服控制的机器人末端姿态修正方法,主要是将双目立体视觉所获得的物料的三维信息结合位置视觉伺服控制,实现对混合物料的实时分拣。Further, the material sorting system 10 in this embodiment mainly includes two parts, one of which includes a binocular stereo vision imaging system, which mainly includes the first image sensor 110 and the second image sensor installed in parallel 120. A bracket 600 is formed. The main positioning is to complete the extraction of the coordinates, direction and grabbing point of the mixed material on the conveyor belt 620 . The second is the processing device 300, the image collector 200, and the method for correcting the attitude of the robot end by combining the position visual servo control, which mainly combines the three-dimensional information of the material obtained by the binocular stereo vision with the position visual servo control to realize the real-time monitoring of the mixed material. sorting.

本发明实施例采用双目立体视觉技术与视觉伺服控制技术相结合的控制方式,定位准确,而且精确度高,易于控制实现。通过单个的视觉系统,可以提取任意物料的三维轮廓,并且可以得到轮廓上任意点的三维信息。同时实现了基于处理设备的控制方式,在优势互补的基础上融合双目立体视觉系统提出了一种新的视觉伺服控制方法。采用相互平行安装的第一图像传感器和第二图像传感器作为图像采集设备,不受工业现场环境干扰和温度影响,能够为机器人的实时分拣提供可靠的信号输入,有利于提高机器人分拣的智能化水平。具体体现在以下几点:The embodiment of the present invention adopts a control method combining binocular stereo vision technology and visual servo control technology, which has accurate positioning, high precision, and easy control and realization. Through a single vision system, the three-dimensional contour of any material can be extracted, and the three-dimensional information of any point on the contour can be obtained. At the same time, the control method based on processing equipment is realized, and a new visual servo control method is proposed by combining the binocular stereo vision system on the basis of complementary advantages. The first image sensor and the second image sensor installed parallel to each other are used as the image acquisition equipment, which are not affected by the interference and temperature of the industrial site environment, and can provide reliable signal input for the real-time sorting of the robot, which is conducive to improving the intelligence of the robot sorting level. Specifically reflected in the following points:

①在成像单元上采用双目立体视觉,具有效率高、精度合适、系统结构简单、成本低等优点,非常适合于制造现场,采用触发控制装置,当检测到传送带上的物料时,将信号传递给处理设备,计算机通过发送指令,使其它系统同时打开,提高工作效率,采用高性能的处理设备,高效的进行图像处理和信息处理。①The imaging unit adopts binocular stereo vision, which has the advantages of high efficiency, appropriate precision, simple system structure, and low cost. It is very suitable for the manufacturing site. It uses a trigger control device to transmit the signal when the material on the conveyor belt is detected To the processing equipment, the computer sends instructions to enable other systems to open at the same time, improving work efficiency, and using high-performance processing equipment to efficiently perform image processing and information processing.

②采用双目立体视觉技术与基于位置的视觉伺服控制方式实现混合物料的实时分拣,一方面通过双目立体视觉技术,重建物料三维信息,包括混合物料的方向、坐标以及抓取点,再通过基于位置的视觉伺服控制方法,实时调整机器人的末端姿态和相关参数,进行精确的分拣作业任务。本发明实施例提出的方法具有更高的准确性和实时性。②Binocular stereo vision technology and position-based visual servo control method are used to realize real-time sorting of mixed materials. On the one hand, binocular stereo vision technology is used to reconstruct the three-dimensional information of materials, including the direction, coordinates and grabbing points of mixed materials, and then Through the position-based visual servo control method, the terminal posture and related parameters of the robot are adjusted in real time to perform precise sorting tasks. The method proposed by the embodiment of the present invention has higher accuracy and real-time performance.

③本发明实施例提供的物料分拣系统,可对混合物料进行三维形貌可视化重建,除了用于物料定位抓取外,还可以用于对目标物的体积测量,准确进行数据分析降低爆仓现象。③The material sorting system provided by the embodiment of the present invention can carry out visual reconstruction of the three-dimensional shape of the mixed material. In addition to being used for material positioning and grabbing, it can also be used for volume measurement of the target object, and accurate data analysis can reduce warehouse explosion. Phenomenon.

④本发明实施例除了用于生产线上混合物料的分拣引导外,还可以用于激光切割路径引导、焊接、码垛、搬运等作业,以及其它基于机器人技术与视觉伺服控制领域的实时生产加工。④In addition to being used for sorting and guiding mixed materials on the production line, the embodiment of the present invention can also be used for laser cutting path guidance, welding, palletizing, handling and other operations, as well as other real-time production and processing based on robotics and visual servo control .

本发明实施例的物料分拣系统,通过获取目标物的两个图像数据,使用两个图像数据计算得到目标物的三维信息和体积,可以使生成的运动指令能够更好地使机器人定位到所述目标物的位置,从而降低机器人抓取目标物的误差。In the material sorting system of the embodiment of the present invention, by obtaining two image data of the target object, and using the two image data to calculate the three-dimensional information and volume of the target object, the generated motion command can better position the robot to the desired location. The position of the target object is described, thereby reducing the error of the robot grabbing the target object.

请参阅图2,是本发明实施例提供的应用于图1所示的处理设备的物料分拣方法的流程图。下面将对图2所示的具体流程进行详细阐述。Please refer to FIG. 2 , which is a flowchart of a material sorting method applied to the processing equipment shown in FIG. 1 provided by an embodiment of the present invention. The specific process shown in FIG. 2 will be described in detail below.

步骤S101,获取第一采集设备采集的目标物的第一图像数据及第二采集设备采集的目标物的第二图像数据。Step S101 , acquiring first image data of a target collected by a first collection device and second image data of a target collected by a second collection device.

步骤S102,使用所述第一图像数据及第二图像数据定位所述目标物的三维信息及体积。Step S102, using the first image data and the second image data to locate the 3D information and volume of the target.

步骤S103,根据所述三维信息及体积生成控制机器人的运动指令。Step S103, generating motion commands for controlling the robot according to the three-dimensional information and volume.

本实施例中,所述步骤S103包括:计算所述三维信息及所述机器人的末端当前姿态的相对位置,以所述相对位置作为运动轨迹生成所述运动指令。In this embodiment, the step S103 includes: calculating the relative position of the three-dimensional information and the current pose of the terminal of the robot, and using the relative position as a motion track to generate the motion instruction.

本实施例中,可以使用手眼标定方式计算得到所述机器人的末端需要运动的位置。In this embodiment, the position where the end of the robot needs to move can be calculated by using the hand-eye calibration method.

步骤S104,将所述运动指令发送给机器人,以使所述机器人根据所述运动指令调整末端以抓取所述目标物。Step S104, sending the motion command to the robot, so that the robot adjusts the end according to the motion command to grab the target.

本实施例中,所述机器人将所述目标物抓取放置在设定区域,如图3所示,所述方法还包括:步骤S105至步骤S107。In this embodiment, the robot grabs and places the target object in a set area, as shown in FIG. 3 , the method further includes: step S105 to step S107.

步骤S105,每放置一次计算所述设定区域的剩余空间。Step S105, calculating the remaining space of the set area every time the device is placed.

步骤S106,根据所述目标物的体积及所述剩余空间计算所述设定区域是否能够容纳所述目标物。Step S106 , calculating whether the set area can accommodate the target object according to the volume of the target object and the remaining space.

步骤S107,当不能容纳所述目标物时,将生成提示消息。Step S107, when the target cannot be accommodated, a prompt message will be generated.

本实施例中,如图4所示,所述方法还包括:步骤S108至步骤S109。In this embodiment, as shown in FIG. 4 , the method further includes: Step S108 to Step S109.

步骤S108,接收到触发控制装置发送的检测信号后,向所述第一图像传感器及第二图像发送触发指令,触发所述第一图像传感器及第二图像传感器工作。Step S108 , after receiving the detection signal sent by the trigger control device, sending a trigger command to the first image sensor and the second image sensor to trigger the first image sensor and the second image sensor to work.

步骤S109,向与所述处理设备连接的其它设备发送启动指令,以使所述其它设备开启。Step S109, sending an activation instruction to other devices connected to the processing device, so as to enable the other devices to be turned on.

进一步地,所述方法还包括对所述机器人进行手眼标定。本实施例中,所述物料分拣系统还包括设置在所述机器人末端的末端执行器光学靶标和安装在其它位置的目标运动体光学靶标(图1中未示出)。例如,所述目标运动体光学靶标可以安装在图1所示的传送带的边缘。在一种实施方式中,可以通过以下步骤对所述机器人进行手眼标定:Further, the method further includes performing hand-eye calibration on the robot. In this embodiment, the material sorting system further includes an end effector optical target arranged at the end of the robot and an optical target of a target moving body installed at other positions (not shown in FIG. 1 ). For example, the target moving body optical target can be installed on the edge of the conveyor belt shown in FIG. 1 . In one embodiment, the robot can be calibrated by hand and eye through the following steps:

步骤1:获取所述第一图像传感器和所述第二图像传感器采集的初始化状态下末端执行器光学靶标和目标运动体光学靶标的位置信息图像,根据摄像机模型计算出机器人的末端执行器光学靶标在摄像机坐标系下的位姿齐次矩阵表达式M2V和目标运动体光学靶标在摄像机坐标系下的位姿齐次矩阵表达式M1V,之后进入步骤2;Step 1: Obtain the position information images of the optical target of the end effector and the optical target of the target moving body in the initialization state collected by the first image sensor and the second image sensor, and calculate the optical target of the end effector of the robot according to the camera model The pose homogeneous matrix expression M 2V in the camera coordinate system and the pose homogeneous matrix expression M 1V of the target moving body optical target in the camera coordinate system, then go to step 2;

步骤2:通过测量工具测出末端执行器光学靶标在机器人末端执行器坐标系下的位姿齐次矩阵表达式M2T;通过关节角度传感器获取机器人的六个关节角确定机器人末端执行器在初始位置上的位姿齐次矩阵,再经机器人运动学正解得到MTB;根据坐标变换关系,计算出末端执行器光学靶标在机器人基座标系B下的齐次矩阵为M2B=MTB·M2T,之后进入步骤3;Step 2: Measure the pose homogeneous matrix expression M 2T of the optical target of the end effector in the coordinate system of the end effector of the robot through the measuring tool; obtain the six joint angles of the robot through the joint angle sensor to determine the initial position of the end effector of the robot The pose homogeneous matrix at the position, and then M TB is obtained through the forward solution of robot kinematics; according to the coordinate transformation relationship, the homogeneous matrix of the optical target of the end effector under the robot base frame B is calculated as M 2B = M TB · M 2T , then go to step 3;

步骤3:确定机器人基座标系的转换矩阵,根据机器人末端执行器光学靶标在摄像机坐标系下和机器人基座标系下的齐次矩阵计算出从摄像机坐标系变换到机器人基座标系的转换矩阵Mmap=M2B·M2V -1,之后进入步骤4;Step 3: Determine the transformation matrix of the robot base frame, and calculate the transformation matrix from the camera coordinate system to the robot base frame according to the homogeneous matrix of the robot end effector optical target in the camera coordinate system and the robot base frame Transformation matrix M map =M 2B ·M 2V -1 , then enter step 4;

步骤4:计算目标运动体和机器人末端执行器的位置关系Mbind,机器人在进行目标跟踪的过程中机器人末端执行器与目标运动体之间始终保持一个固定的偏置关系,根据步骤1中所述第一图像传感器和所述第二图像传感器获取到末端执行器光学靶标齐次矩阵M2V和目标运动体光学靶标齐次矩阵M1V后计算出偏置关系:Mbind=M2V -1·M1V,之后进入步骤5;Step 4: Calculate the positional relationship M bind between the target moving body and the robot end effector. During the target tracking process, the robot always maintains a fixed offset relationship between the robot end effector and the target moving body. According to the After the first image sensor and the second image sensor acquire the homogeneous matrix M 2V of the optical target of the end effector and the homogeneous matrix M 1V of the optical target of the target moving body, the offset relationship is calculated: M bind = M 2V −1 · M 1V , then go to step 5;

步骤5:计算末端执行器光学靶标和目标运动体光学靶标在摄像机坐标系V下的位置误差,所述第一图像传感器和所述第二图像传感器以一定的频率不断地计算出新的M1V和M2V,通过MerrV=M1V-M2V·Mbind计算得到在摄像机视觉坐标系V下的位置误差MerrV;再通过公式MerrB=Mmap·MerrV计算出在机器人基坐标B下的位置误差MerrB,之后进入步骤6;Step 5: Calculate the position error of the optical target of the end effector and the optical target of the target moving body in the camera coordinate system V, and the first image sensor and the second image sensor continuously calculate a new M 1V at a certain frequency and M 2V , the position error M errV in the camera visual coordinate system V is calculated by M errV = M 1V -M 2V · M bind ; and then calculated by the formula M errB = M map · M errV The position error M errB , then go to step 6;

步骤6:判定误差值,齐次矩阵MerrB中包含了三维空间中机器人末端执行器和目标运动体在X、Y、Z方向上的位置误差ΔX、ΔY、ΔZ,如果误差值在容许的范围ε内,则进入步骤1,否则进入步骤7;Step 6: Determine the error value. The homogeneous matrix M errB contains the position errors ΔX, ΔY, and ΔZ of the robot end effector and the target moving body in the three-dimensional space in the X , Y , and Z directions. If the error value is in If it is within the allowable range ε, go to step 1, otherwise go to step 7;

步骤7:根据PID算法利用误差值计算出在机器人末端执行器坐标系T下的速度控制量VX、VY、VZ,并发送给机器人控制器让机器人末端执行器按照给定速度运动,之后进入步骤1,实现在一定的空间范围内机器人快速而准确的跟踪运动的目标。Step 7: Calculate the speed control variables V X , V Y , and V Z in the robot end effector coordinate system T by using the error value according to the PID algorithm, and send them to the robot controller to make the robot end effector move at a given speed. Then enter step 1 to achieve the goal of the robot tracking motion quickly and accurately within a certain space range.

关于本实施例的其它细节还可以进一步地参考上述系统实施例中的描述,在此不再赘述。For other details of this embodiment, reference may be made to the descriptions in the foregoing system embodiments, which will not be repeated here.

本发明实施例的物料分拣方法,通过获取目标物的两个图像数据,使用两个图像数据计算得到目标物的三维信息和体积,可以使生成的运动指令能够更好地使机器人定位到所述目标物的位置,从而降低机器人抓取目标物的误差。In the material sorting method of the embodiment of the present invention, by obtaining two image data of the target object, and using the two image data to calculate the three-dimensional information and volume of the target object, the generated motion instructions can better position the robot to the desired location. The position of the target object is described, thereby reducing the error of the robot grabbing the target object.

在本申请所提供的几个实施例中,应该理解到,所揭露的装置和方法,也可以通过其它的方式实现。以上所描述的装置实施例仅仅是示意性的,例如,附图中的流程图和框图显示了根据本发明的多个实施例的装置、方法和计算机程序产品的可能实现的体系架构、功能和操作。在这点上,流程图或框图中的每个方框可以代表一个模块、程序段或代码的一部分,所述模块、程序段或代码的一部分包含一个或多个用于实现规定的逻辑功能的可执行指令。也应当注意,在有些作为替换的实现方式中,方框中所标注的功能也可以以不同于附图中所标注的顺序发生。例如,两个连续的方框实际上可以基本并行地执行,它们有时也可以按相反的顺序执行,这依所涉及的功能而定。也要注意的是,框图和/或流程图中的每个方框、以及框图和/或流程图中的方框的组合,可以用执行规定的功能或动作的专用的基于硬件的系统来实现,或者可以用专用硬件与计算机指令的组合来实现。In the several embodiments provided in this application, it should be understood that the disclosed devices and methods may also be implemented in other ways. The device embodiments described above are only illustrative. For example, the flowcharts and block diagrams in the accompanying drawings show the architecture, functions and possible implementations of devices, methods and computer program products according to multiple embodiments of the present invention. operate. In this regard, each block in a flowchart or block diagram may represent a module, program segment, or part of code that includes one or more Executable instructions. It should also be noted that, in some alternative implementations, the functions noted in the block may occur out of the order noted in the figures. For example, two blocks in succession may, in fact, be executed substantially concurrently, or they may sometimes be executed in the reverse order, depending upon the functionality involved. It should also be noted that each block of the block diagrams and/or flowchart illustrations, and combinations of blocks in the block diagrams and/or flowchart illustrations, can be implemented by a dedicated hardware-based system that performs the specified function or action , or may be implemented by a combination of dedicated hardware and computer instructions.

另外,在本发明各个实施例中的各功能模块可以集成在一起形成一个独立的部分,也可以是各个模块单独存在,也可以两个或两个以上模块集成形成一个独立的部分。In addition, each functional module in each embodiment of the present invention can be integrated together to form an independent part, or each module can exist independently, or two or more modules can be integrated to form an independent part.

所述功能如果以软件功能模块的形式实现并作为独立的产品销售或使用时,可以存储在一个计算机可读取存储介质中。基于这样的理解,本发明的技术方案本质上或者说对现有技术做出贡献的部分或者该技术方案的部分可以以软件产品的形式体现出来,该计算机软件产品存储在一个存储介质中,包括若干指令用以使得一台计算机设备(可以是个人计算机,服务器,或者网络设备等)执行本发明各个实施例所述方法的全部或部分步骤。而前述的存储介质包括:U盘、移动硬盘、只读存储器(ROM,Read-Only Memory)、随机存取存储器(RAM,Random Access Memory)、磁碟或者光盘等各种可以存储程序代码的介质。需要说明的是,在本文中,诸如第一和第二等之类的关系术语仅仅用来将一个实体或者操作与另一个实体或操作区分开来,而不一定要求或者暗示这些实体或操作之间存在任何这种实际的关系或者顺序。而且,术语“包括”、“包含”或者其任何其他变体意在涵盖非排他性的包含,从而使得包括一系列要素的过程、方法、物品或者设备不仅包括那些要素,而且还包括没有明确列出的其他要素,或者是还包括为这种过程、方法、物品或者设备所固有的要素。在没有更多限制的情况下,由语句“包括一个……”限定的要素,并不排除在包括所述要素的过程、方法、物品或者设备中还存在另外的相同要素。If the functions are implemented in the form of software function modules and sold or used as independent products, they can be stored in a computer-readable storage medium. Based on this understanding, the essence of the technical solution of the present invention or the part that contributes to the prior art or the part of the technical solution can be embodied in the form of a software product, and the computer software product is stored in a storage medium, including Several instructions are used to make a computer device (which may be a personal computer, a server, or a network device, etc.) execute all or part of the steps of the method described in each embodiment of the present invention. The aforementioned storage medium includes: U disk, mobile hard disk, read-only memory (ROM, Read-Only Memory), random access memory (RAM, Random Access Memory), magnetic disk or optical disk and other media that can store program codes. . It should be noted that in this article, relational terms such as first and second are only used to distinguish one entity or operation from another entity or operation, and do not necessarily require or imply that there is a relationship between these entities or operations. any such actual relationship or order exists between them. Furthermore, the term "comprises", "comprises" or any other variation thereof is intended to cover a non-exclusive inclusion such that a process, method, article, or apparatus comprising a set of elements includes not only those elements, but also includes elements not expressly listed. other elements of or also include elements inherent in such a process, method, article, or apparatus. Without further limitations, an element defined by the phrase "comprising a ..." does not exclude the presence of additional identical elements in the process, method, article or apparatus comprising said element.

以上所述仅为本发明的优选实施例而已,并不用于限制本发明,对于本领域的技术人员来说,本发明可以有各种更改和变化。凡在本发明的精神和原则之内,所作的任何修改、等同替换、改进等,均应包含在本发明的保护范围之内。应注意到:相似的标号和字母在下面的附图中表示类似项,因此,一旦某一项在一个附图中被定义,则在随后的附图中不需要对其进行进一步定义和解释。The above descriptions are only preferred embodiments of the present invention, and are not intended to limit the present invention. For those skilled in the art, the present invention may have various modifications and changes. Any modifications, equivalent replacements, improvements, etc. made within the spirit and principles of the present invention shall be included within the protection scope of the present invention. It should be noted that like numerals and letters denote similar items in the following figures, therefore, once an item is defined in one figure, it does not require further definition and explanation in subsequent figures.

以上所述,仅为本发明的具体实施方式,但本发明的保护范围并不局限于此,任何熟悉本技术领域的技术人员在本发明揭露的技术范围内,可轻易想到变化或替换,都应涵盖在本发明的保护范围之内。因此,本发明的保护范围应以权利要求的保护范围为准。The above is only a specific embodiment of the present invention, but the scope of protection of the present invention is not limited thereto. Anyone skilled in the art can easily think of changes or substitutions within the technical scope disclosed in the present invention. Should be covered within the protection scope of the present invention. Therefore, the protection scope of the present invention should be based on the protection scope of the claims.

Claims (10)

1. a kind of Material Sorting system, which is characterized in that the Material Sorting system includes:
First imaging sensor, the first image data for obtaining object;
Second imaging sensor, the second image data for obtaining the object;
The image acquisition device being connect with described first image sensor and second imaging sensor, for acquiring described first The second image data that the first image data and the second imaging sensor that imaging sensor obtains obtain;
The processing equipment being connect with described image collector, the processing equipment are used to obtain described the from described image collector One image data and the second image data, and the target is calculated according to described first image data and the second image data The volume of the three-dimensional information of object and the object;
The processing equipment is additionally operable to generate the movement instruction of control robot according to the three-dimensional information and volume;
The robot being connect with the processing equipment, the robot is used to receive the movement instruction of the processing equipment, with root End is adjusted to capture the object according to the movement instruction.
2. Material Sorting system as described in claim 1, which is characterized in that the robot is additionally operable to grab the object It takes and is placed on setting regions;
The processing equipment is additionally operable to every remaining space placed and once calculate the setting regions;
The processing equipment is additionally operable to whether calculate the setting regions according to the volume of the object and the remaining space The object can be accommodated, when the object cannot be accommodated, prompting message will be generated.
3. Material Sorting system as described in claim 1, which is characterized in that the Material Sorting system further includes:
Trigger control device in designated position is set, the trigger control device, for when detecting the object, to institute It states processing equipment and sends detection signal;
The processing equipment sends triggering after receiving the detection signal, to described first image sensor and the second image Instruction triggers described first image sensor and the work of the second imaging sensor;
The processing equipment is additionally operable to send enabled instruction to the miscellaneous equipment connecting with the processing equipment, so that described other Opening of device.
4. Material Sorting system as claimed in claim 3, which is characterized in that the Material Sorting system further includes:
Holder, the holder include transverse arm and support arm;
Described first image sensor and the second imaging sensor are mounted on the transverse arm of the holder.
5. Material Sorting system as claimed in claim 4, which is characterized in that multiple first installations are arranged on the support arm Position, the transverse arm are mounted at any installation position in the multiple first installation position;
At least three second installation positions, described first image sensor and second imaging sensor peace are set on the transverse arm On two the second installation positions of described at least three second installation positions.
6. Material Sorting system as described in claim 1, which is characterized in that installed at the camera lens of described first image sensor There is the first filter plate;The second filter plate is installed at the camera lens of second imaging sensor.
7. a kind of Material Sorting method, which is characterized in that including:
Obtain the of the first image data of the object of the first collecting device acquisition and the object of the second collecting device acquisition Two image datas;
The three-dimensional information and volume of the object are positioned using described first image data and the second image data;
The movement instruction of control robot is generated according to the three-dimensional information and volume;
The movement instruction is sent to robot, so that the robot adjusts end to capture according to the movement instruction State object.
8. Material Sorting method as claimed in claim 7, which is characterized in that the object is captured and placed by the robot In setting regions, the method further includes:
Often place the remaining space for once calculating the setting regions;
Calculate whether the setting regions can accommodate the object according to the volume of the object and the remaining space;
When the object cannot be accommodated, prompting message will be generated.
9. Material Sorting method as claimed in claim 7, which is characterized in that be applied to processing equipment, the processing equipment with Trigger control device connects, and the method further includes:
After receiving the detection signal that the trigger control device is sent, sent to described first image sensor and the second image Triggering command triggers described first image sensor and the work of the second imaging sensor;
Enabled instruction is sent to the miscellaneous equipment being connect with the processing equipment, so that the miscellaneous equipment is opened.
10. Material Sorting method as claimed in claim 7, which is characterized in that described to be given birth to according to the three-dimensional information and volume Include at the step of movement instruction for controlling robot:
Calculate the relative position of the end current pose of the three-dimensional information and the robot;
Using the relative position as movement instruction described in trace generator.
CN201810380261.9A 2018-04-25 2018-04-25 Material sorting system and method Pending CN108607819A (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201810380261.9A CN108607819A (en) 2018-04-25 2018-04-25 Material sorting system and method

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201810380261.9A CN108607819A (en) 2018-04-25 2018-04-25 Material sorting system and method

Publications (1)

Publication Number Publication Date
CN108607819A true CN108607819A (en) 2018-10-02

Family

ID=63660838

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201810380261.9A Pending CN108607819A (en) 2018-04-25 2018-04-25 Material sorting system and method

Country Status (1)

Country Link
CN (1) CN108607819A (en)

Cited By (17)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN109465205A (en) * 2018-11-20 2019-03-15 上海发那科机器人有限公司 A kind of the dynamic sorting system and method for sorting of view-based access control model identification technology
CN109465809A (en) * 2018-12-17 2019-03-15 中北大学 An intelligent garbage sorting robot based on binocular stereo vision positioning and recognition
CN110561437A (en) * 2019-09-19 2019-12-13 工业云制造(四川)创新中心有限公司 Blank automatic processing and taking method, storage medium and terminal
CN111105181A (en) * 2018-10-25 2020-05-05 格雷奥朗佩特有限公司 Identification and planning system and method for order fulfillment
CN111805532A (en) * 2020-03-27 2020-10-23 高雪亚 Cloud computing type robot drive control system
CN111860358A (en) * 2020-07-23 2020-10-30 广元量知汇科技有限公司 Material acceptance method based on industrial Internet
CN111993418A (en) * 2020-08-06 2020-11-27 西安科技大学 Coal gangue sorting robot multi-target multi-manipulator collaborative sorting system and sorting strategy
CN112150439A (en) * 2020-09-23 2020-12-29 创新奇智(青岛)科技有限公司 Automatic sorting equipment and sorting method for injection molding parts
CN112889009A (en) * 2018-10-19 2021-06-01 通快机床两合公司 Method for displaying workpiece representations for assisting a sorting process
CN113316504A (en) * 2019-01-25 2021-08-27 索尼互动娱乐股份有限公司 Robot control system
CN113379905A (en) * 2021-07-16 2021-09-10 秦皇岛信能能源设备有限公司 Wheel hub is 3D vision intelligent identification and control system for production line
CN113909132A (en) * 2021-10-27 2022-01-11 山东东辰瑞森新材料科技有限公司 Material detecting table
CN115008471A (en) * 2022-07-11 2022-09-06 上海浩亚智能科技股份有限公司 Intelligent control system of logistics carrying robot
CN115701818A (en) * 2023-01-04 2023-02-14 江苏汉邦智能系统集成有限公司 Intelligent garbage classification control system based on artificial intelligence
US12103162B2 (en) 2019-01-25 2024-10-01 Sony Interactive Entertainment Inc. Robotic device having an image analysis system
CN120243454A (en) * 2025-06-05 2025-07-04 江苏中科睿鼎智能科技股份有限公司 A system and method for conveying and sorting electronic products
US12377548B2 (en) 2019-01-25 2025-08-05 Sony Interactive Entertainment Inc. Robot controlling system

Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2006086366A2 (en) * 2005-02-10 2006-08-17 Siemens Corporate Research, Inc. Sortation platforms with in-bulk identification and continuous tracking of items
CN101128268A (en) * 2003-06-12 2008-02-20 美国邮政服务公司 Dynamic Adjustment of Bins in Mail Sorting
CN104400783A (en) * 2014-09-24 2015-03-11 哈尔滨工业大学 Control method achieving tension feedback and joint position feedback and used for flexibility driving unit for robot joint
CN105562361A (en) * 2015-12-23 2016-05-11 西安工程大学 Independent sorting method of fabric sorting robot
CN107413674A (en) * 2017-06-08 2017-12-01 北京农业信息技术研究中心 A kind of crop seed on-line sorting method and system

Patent Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN101128268A (en) * 2003-06-12 2008-02-20 美国邮政服务公司 Dynamic Adjustment of Bins in Mail Sorting
WO2006086366A2 (en) * 2005-02-10 2006-08-17 Siemens Corporate Research, Inc. Sortation platforms with in-bulk identification and continuous tracking of items
CN104400783A (en) * 2014-09-24 2015-03-11 哈尔滨工业大学 Control method achieving tension feedback and joint position feedback and used for flexibility driving unit for robot joint
CN105562361A (en) * 2015-12-23 2016-05-11 西安工程大学 Independent sorting method of fabric sorting robot
CN107413674A (en) * 2017-06-08 2017-12-01 北京农业信息技术研究中心 A kind of crop seed on-line sorting method and system

Non-Patent Citations (3)

* Cited by examiner, † Cited by third party
Title
任秉银等: "正交双目视觉长轴类零件装配端位姿检测方法", 《哈尔滨工业大学学报》 *
侯宏录等: "硅棒特征点三维坐标视觉检测技术研究", 《光学仪器》 *
李伟等: "基于正交双目视觉的药液杂质粒径标定", 《光学精密工程》 *

Cited By (23)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN112889009A (en) * 2018-10-19 2021-06-01 通快机床两合公司 Method for displaying workpiece representations for assisting a sorting process
CN111105181A (en) * 2018-10-25 2020-05-05 格雷奥朗佩特有限公司 Identification and planning system and method for order fulfillment
CN109465205A (en) * 2018-11-20 2019-03-15 上海发那科机器人有限公司 A kind of the dynamic sorting system and method for sorting of view-based access control model identification technology
CN109465809A (en) * 2018-12-17 2019-03-15 中北大学 An intelligent garbage sorting robot based on binocular stereo vision positioning and recognition
CN109465809B (en) * 2018-12-17 2024-07-19 中北大学 Intelligent garbage classification robot based on binocular stereoscopic vision positioning identification
US12377548B2 (en) 2019-01-25 2025-08-05 Sony Interactive Entertainment Inc. Robot controlling system
US12260579B2 (en) 2019-01-25 2025-03-25 Sony Interactive Entertainment Inc. Robot controlling system
US12103162B2 (en) 2019-01-25 2024-10-01 Sony Interactive Entertainment Inc. Robotic device having an image analysis system
CN113316504A (en) * 2019-01-25 2021-08-27 索尼互动娱乐股份有限公司 Robot control system
CN110561437A (en) * 2019-09-19 2019-12-13 工业云制造(四川)创新中心有限公司 Blank automatic processing and taking method, storage medium and terminal
CN111805532B (en) * 2020-03-27 2021-11-26 成芳 Cloud computing type robot drive control system
CN111805532A (en) * 2020-03-27 2020-10-23 高雪亚 Cloud computing type robot drive control system
CN111860358A (en) * 2020-07-23 2020-10-30 广元量知汇科技有限公司 Material acceptance method based on industrial Internet
CN111860358B (en) * 2020-07-23 2021-05-14 浙江赛慕威供应链管理有限公司 Material acceptance method based on industrial internet
CN111993418B (en) * 2020-08-06 2021-09-14 西安科技大学 Multi-target multi-mechanical-arm collaborative sorting system and sorting strategy for coal and gangue sorting robot
CN111993418A (en) * 2020-08-06 2020-11-27 西安科技大学 Coal gangue sorting robot multi-target multi-manipulator collaborative sorting system and sorting strategy
CN112150439B (en) * 2020-09-23 2023-10-20 创新奇智(青岛)科技有限公司 Automatic sorting equipment and sorting method for injection molding parts
CN112150439A (en) * 2020-09-23 2020-12-29 创新奇智(青岛)科技有限公司 Automatic sorting equipment and sorting method for injection molding parts
CN113379905A (en) * 2021-07-16 2021-09-10 秦皇岛信能能源设备有限公司 Wheel hub is 3D vision intelligent identification and control system for production line
CN113909132A (en) * 2021-10-27 2022-01-11 山东东辰瑞森新材料科技有限公司 Material detecting table
CN115008471A (en) * 2022-07-11 2022-09-06 上海浩亚智能科技股份有限公司 Intelligent control system of logistics carrying robot
CN115701818A (en) * 2023-01-04 2023-02-14 江苏汉邦智能系统集成有限公司 Intelligent garbage classification control system based on artificial intelligence
CN120243454A (en) * 2025-06-05 2025-07-04 江苏中科睿鼎智能科技股份有限公司 A system and method for conveying and sorting electronic products

Similar Documents

Publication Publication Date Title
CN108607819A (en) Material sorting system and method
CN110842928B (en) Visual guiding and positioning method for compound robot
CN108274092B (en) Automatic groove cutting system and method based on three-dimensional vision and model matching
US8244402B2 (en) Visual perception system and method for a humanoid robot
JP6855492B2 (en) Robot system, robot system control device, and robot system control method
CN206263418U (en) A kind of real-time seam tracking system of six degree of freedom welding robot line laser
CN102581445B (en) Visual real-time deviation rectifying system and visual real-time deviation rectifying method for robot
CN111745267A (en) A real-time tracking system and method for groove weld based on laser displacement sensor
CN104786226A (en) Posture and moving track positioning system and method of robot grabbing online workpiece
CN110666805A (en) Industrial robot sorting method based on active vision
CN108161931A (en) The workpiece automatic identification of view-based access control model and intelligent grabbing system
CN103895042A (en) Industrial robot workpiece positioning grabbing method and system based on visual guidance
CN104802174A (en) Robot control system, robot, program and robot control method
CN114067210B (en) An intelligent grasping method for mobile robots based on monocular vision guidance
CN112109072B (en) Accurate 6D pose measurement and grabbing method for large sparse feature tray
CN107097122A (en) A kind of robot for independently grinding large-scale free form surface
US12128571B2 (en) 3D computer-vision system with variable spatial resolution
CN115533892A (en) A system and method for blade measurement and coordinate system vision correction based on dual 3D laser heads
CN107932502A (en) A kind of SCARA method for planning track of robot based on binocular stereo vision
CN117428777A (en) A hand-eye calibration method for bag-unpacking robots
CN117103276A (en) Precise grabbing method and system for robot
Luo et al. Robotic conveyor tracking with dynamic object fetching for industrial automation
JP6507792B2 (en) Robot and robot system
CN112123329A (en) A robot 3D vision hand-eye calibration method
Nakhaeinia et al. Adaptive robotic contour following from low accuracy RGB-D surface profiling and visual servoing

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

Application publication date: 20181002

RJ01 Rejection of invention patent application after publication