WO2018218438A1 - Robot and method for adjusting robot posture - Google Patents

Robot and method for adjusting robot posture Download PDF

Info

Publication number
WO2018218438A1
WO2018218438A1 PCT/CN2017/086362 CN2017086362W WO2018218438A1 WO 2018218438 A1 WO2018218438 A1 WO 2018218438A1 CN 2017086362 W CN2017086362 W CN 2017086362W WO 2018218438 A1 WO2018218438 A1 WO 2018218438A1
Authority
WO
WIPO (PCT)
Prior art keywords
robot
sensor
measured
distance
posture
Prior art date
Application number
PCT/CN2017/086362
Other languages
French (fr)
Chinese (zh)
Inventor
刘子雨
索利洋
Original Assignee
深圳配天智能技术研究院有限公司
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 深圳配天智能技术研究院有限公司 filed Critical 深圳配天智能技术研究院有限公司
Priority to CN201780030217.9A priority Critical patent/CN109311604B/en
Priority to PCT/CN2017/086362 priority patent/WO2018218438A1/en
Publication of WO2018218438A1 publication Critical patent/WO2018218438A1/en

Links

Images

Classifications

    • BPERFORMING OPERATIONS; TRANSPORTING
    • B65CONVEYING; PACKING; STORING; HANDLING THIN OR FILAMENTARY MATERIAL
    • B65GTRANSPORT OR STORAGE DEVICES, e.g. CONVEYORS FOR LOADING OR TIPPING, SHOP CONVEYOR SYSTEMS OR PNEUMATIC TUBE CONVEYORS
    • B65G49/00Conveying systems characterised by their application for specified purposes not otherwise provided for
    • B65G49/05Conveying systems characterised by their application for specified purposes not otherwise provided for for fragile or damageable materials or articles
    • B65G49/06Conveying systems characterised by their application for specified purposes not otherwise provided for for fragile or damageable materials or articles for fragile sheets, e.g. glass

Definitions

  • the driver is coupled to the gripping assembly for adjusting a posture of the gripping assembly in response to the control signal such that a posture of the gripping assembly satisfies a predetermined condition.
  • the robot embodiment of the present invention comprises: a controller 30, a driver 40, at least three sensors 201, 202 and 203 and a gripping assembly 10 mounted on the robot arm of the robot;
  • the point at which the distance between the measured plates 50 is abruptly changed is D 2 , and the coordinates of the points A 2 , B 2 , C 2 , and D 2 are used to calculate the position of the symmetric center of the rectangular plate 50 to be tested, four The position and area of the vertex, resulting in a rectangle Measuring the attitude of the plate 50.

Abstract

A robot and a method for adjusting robot posture, the robot comprising: a controller (30), a driver (40), at least three sensors (201, 202, 203), and a gripping assembly that is mounted on a robotic arm of the robot (10); the gripping assembly (10) is used for gripping a tested plate (50); the at least three sensors (201, 202, 203) are used for detecting the distance between each sensor (201, 202, 203) and the tested plate (50); the controller (30) is used for calculating the posture of the tested plate (50), generating a corresponding control signal and sending the same to the driver (40); and the driver (40) is used for responding to the control signal and adjusting the posture of the gripping assembly (10). The robot may automatically adjust the posture of the gripping assembly (10) according to the placement position and posture of the tested plate (50).

Description

一种机器人及调整机器人姿态的方法Robot and method for adjusting robot posture 【技术领域】[Technical Field]
本发明涉及机器人技术领域,特别涉及一种机器人及调整机器人姿态的方法。The present invention relates to the field of robot technology, and in particular, to a robot and a method for adjusting a posture of a robot.
【背景技术】【Background technique】
工业机器人是面向工业领域的多自由度的机器人,被广泛应用在搬运、焊接和包装等复杂的作业中,为企业节约了大量的劳动成本,大幅提高了生产效率。作为现代工业领域不可或缺的重要装备和手段,机器人已经成为衡量一个国家科技和制造水平的重要标志。Industrial robots are multi-degree-of-freedom robots for the industrial field. They are widely used in complex operations such as handling, welding and packaging, which saves the company a lot of labor costs and greatly improves production efficiency. As an indispensable equipment and means in the modern industrial field, robots have become an important indicator of a country's level of technology and manufacturing.
工业机器人在进行平板(例如玻璃)搬运时,需要获取机器人与平板的距离和平板相对于机器人的姿态。由于每一批平板的放置角度不同,机器人的姿态需要靠人工来调整,这样会消耗大量的时间和人力。为实现工厂的自动化和无人化,需要机械臂能够根据不同形状和姿态的平板自动调整抓取姿态和抓取位置。When an industrial robot carries a flat plate (for example, glass), it is necessary to acquire the distance between the robot and the flat plate and the posture of the flat plate relative to the robot. Since the placement angle of each batch of plates is different, the posture of the robot needs to be adjusted manually, which consumes a lot of time and labor. In order to automate and unmann the factory, the robotic arm is required to automatically adjust the gripping posture and the gripping position according to the flat plate of different shapes and postures.
【发明内容】[Summary of the Invention]
本发明主要解决的技术问题是提供一种机器人及调整机器人姿态的方法,能够实现机器人根据被测平板的放置位置和姿态自动调整抓取组件的姿态。The technical problem to be solved by the present invention is to provide a robot and a method for adjusting the posture of the robot, which can automatically adjust the posture of the grasping assembly according to the placement position and posture of the tested tablet.
为解决上述技术问题,本发明采用的一个技术方案是提供一种机器人,包括:控制器、驱动器、至少三个传感器以及安装于机器人的机械臂上的抓取组件;In order to solve the above technical problem, one technical solution adopted by the present invention is to provide a robot including: a controller, a driver, at least three sensors, and a grabbing assembly mounted on a robot arm of the robot;
所述抓取组件,用于抓取被测平板;The grasping component is configured to grab the tested tablet;
所述至少三个传感器分散设置于所述抓取组件上或分散设置于与所述抓取组件具有相对位置关系的位置,用于检测各个传感器与被测平板件间的距离;The at least three sensors are disposed on the grasping assembly or are disposed in a position in a relative position relationship with the grasping assembly for detecting a distance between each sensor and the measured flat member;
所述控制器与每个传感器及所述驱动器相连,用于接收所述每个传感器与 所述被测平板间的距离,根据所述每个传感器与被测平板间的距离计算出被测平板的姿态,生成相应的控制信号并发送给所述驱动器;The controller is coupled to each of the sensors and the driver for receiving each of the sensors and Calculating the posture of the tested tablet according to the distance between each measured panel and the measured tablet, generating a corresponding control signal and transmitting the corresponding control signal to the driver;
所述驱动器与所述抓取组件相连,用于响应所述控制信号而调整所述抓取组件的姿态,使得所述抓取组件的姿态满足预定条件。The driver is coupled to the gripping assembly for adjusting a posture of the gripping assembly in response to the control signal such that a posture of the gripping assembly satisfies a predetermined condition.
为解决上述技术问题,本发明采用的另一个技术方案是提供一种调整机器人姿态的方法,应用于机器人的控制器中,其中,所述机器人还包括驱动器、至少三个传感器以及安装于机器人的机械臂上的抓取组件,所述至少三个传感器分散设置于所述抓取组件上或分散设置于与所述抓取组件具有相对位置关系的位置,所述方法包括:In order to solve the above technical problem, another technical solution adopted by the present invention is to provide a method for adjusting a posture of a robot, which is applied to a controller of a robot, wherein the robot further includes a driver, at least three sensors, and a robot mounted on the robot. a gripping assembly on the robot arm, the at least three sensors are disposed on the gripping assembly or disposed at a position in a relative positional relationship with the gripping assembly, the method comprising:
利用所述至少三个传感器检测各个传感器与被测平板间的距离;Detecting a distance between each sensor and the measured panel by using the at least three sensors;
根据所述每个传感器与被测平板间的距离计算出被测平板的姿态,生成相应的控制信号并发送给驱动器,以使得所述驱动器响应所述控制信号而调整所述抓取组件的姿态,使得所述抓取组件的姿态满足预定条件。Calculating a posture of the tested panel according to a distance between each sensor and the measured panel, generating a corresponding control signal and transmitting the signal to the driver, so that the driver adjusts the posture of the grabbing component in response to the control signal The posture of the gripping assembly is made to satisfy a predetermined condition.
本发明通过检测机器人抓取部与被测平板之间的距离,实现自动调整机器人上抓取组件的姿态,准确有效地抓取被测平板,节省大量时间和人工,提高工作效率。The invention realizes the automatic adjustment of the posture of the grasping component on the robot by detecting the distance between the gripping portion of the robot and the tested flat plate, accurately and efficiently grabs the tested flat plate, saves a lot of time and labor, and improves work efficiency.
【附图说明】[Description of the Drawings]
图1是本发明机器人实施例的结构示意图;1 is a schematic structural view of an embodiment of a robot of the present invention;
图2是本发明机器人实施例的抓取组件的结构示意图;2 is a schematic structural view of a gripping assembly of an embodiment of the robot of the present invention;
图3是本发明机器人实施例的圆形平板坐标标记示意图;3 is a schematic diagram of a circular plate coordinate mark of an embodiment of the robot of the present invention;
图4是本发明机器人实施例的矩形平板坐标标记示意图;4 is a schematic diagram of a rectangular plate coordinate mark of an embodiment of the robot of the present invention;
图5是本发明调整机器人姿态的方法实施例流程图。FIG. 5 is a flow chart of an embodiment of a method for adjusting a posture of a robot according to the present invention.
【具体实施方式】【detailed description】
下面将结合本发明实施例中的附图,对本发明实施例中的技术方案进行清 楚、完整地描述。The technical solution in the embodiment of the present invention will be clarified in the following with reference to the accompanying drawings in the embodiments of the present invention. Chu, complete description.
参见图1,本发明机器人实施例包括:控制器30、驱动器40、至少三个传感器201、202和203以及安装于机器人的机械臂上的抓取组件10;Referring to Figure 1, the robot embodiment of the present invention comprises: a controller 30, a driver 40, at least three sensors 201, 202 and 203 and a gripping assembly 10 mounted on the robot arm of the robot;
抓取组件10,用于抓取被测平板50;Grasping assembly 10 for grabbing the tested panel 50;
至少三个传感器201、202和203,分散设置于抓取组件10上或分散设置于与抓取组件10具有相对位置关系的位置,用于检测各个传感器与被测平板50间的距离;The at least three sensors 201, 202, and 203 are disposed on the grasping assembly 10 or are disposed in a position relative to the grasping assembly 10 for detecting the distance between each sensor and the measured panel 50;
可选的,抓取组件10上设置有至少一个抓取部101,三个传感器201、202和203直接分散固定于抓取部101四周,且位于抓取部101所定义的抓取面正对被测平板50一侧,能够感测被测平板50的同时,不影响抓取部101的抓取动作,也不在抓取时碰落或损坏三个传感器201、202和203。当然,也可以直接集成于抓取部101内部。Optionally, the gripping assembly 10 is provided with at least one gripping portion 101. The three sensors 201, 202 and 203 are directly dispersed and fixed around the gripping portion 101, and the gripping surface defined by the gripping portion 101 is directly opposite. The side of the flat plate 50 to be tested can sense the flat plate 50 to be tested without affecting the grasping action of the gripping portion 101, and does not knock or damage the three sensors 201, 202, and 203 at the time of grasping. Of course, it can also be directly integrated inside the gripping unit 101.
控制器30与每个传感器及驱动器40相连,用于接收每个传感器与被测平板50间的距离,根据每个传感器与被测平板50间的距离计算出被测平板50的姿态,生成相应的控制信号并发送给驱动器40;The controller 30 is connected to each of the sensors and the driver 40 for receiving the distance between each sensor and the measured panel 50, and calculating the posture of the tested panel 50 according to the distance between each sensor and the measured panel 50, and generating corresponding Control signal is sent to the driver 40;
驱动器40与抓取组件10相连,用于响应控制信号而调整抓取组件10的姿态,使得抓取组件10的姿态满足预定条件。The driver 40 is coupled to the gripping assembly 10 for adjusting the attitude of the gripping assembly 10 in response to a control signal such that the attitude of the gripping assembly 10 satisfies a predetermined condition.
可选的,其中一种预定条件是使各抓取部101与被测平板50距离相等,还有一种预定条件是使各抓取部101与被测平板50距离的差值小于第一阈值。Optionally, one of the predetermined conditions is that the distance between each of the gripping portions 101 and the measured plate 50 is equal, and a predetermined condition is that the difference between the distances of the gripping portions 101 and the measured plate 50 is less than the first threshold.
参见图1和图2,具体地,驱动器40响应控制信号而调整抓取组件10的姿态可采用如下步骤实现:Referring to FIG. 1 and FIG. 2, in particular, the driver 40 adjusts the posture of the gripping assembly 10 in response to the control signal by using the following steps:
1)调整抓取组件10的姿态,使至少三个传感器201、202和203中的第一传感器201和第二传感器202之间的连线平行于第一方向;1) adjusting the attitude of the gripping assembly 10 such that the line between the first sensor 201 and the second sensor 202 of the at least three sensors 201, 202 and 203 is parallel to the first direction;
2)调整抓取组件10的姿态,使抓取组件10绕与第一方向垂直的第二方向转动,直到第一传感器201、第二传感器202分别与被测平板50之间的距离相等或差值小于第一阈值; 2) adjusting the posture of the gripping assembly 10 to rotate the gripping assembly 10 in a second direction perpendicular to the first direction until the distance between the first sensor 201 and the second sensor 202 and the panel 50 to be tested are equal or poor The value is less than the first threshold;
3)调整抓取组件10的姿态,使抓取组件10绕第一方向转动,直到第一传感器201、第三传感器203分别与被测平板50之间的距离相等或差值小于第一阈值。3) Adjusting the posture of the gripping assembly 10 to rotate the gripping assembly 10 in the first direction until the distance between the first sensor 201 and the third sensor 203 and the panel 50 to be tested is equal or the difference is less than the first threshold.
其中,在驱动器40响应控制信号而调整抓取组件10的姿态之前,驱动器40调整抓取组件10的姿态,以使得至少一个传感器检测到与被测平板50的距离达到第二阈值,从而使被测平板50位于机器人的检测范围。例如,机器人的抓取组件10离水平地面的距离为1.5米,被测平板50放置于0.5米高的平台上;在机器人向被测平板50移动的过程中,传感器检测到抓取组件10与其抓取方向上的物体的距离为1.5米,当机器人靠近被测平板50,至少一个传感器检测到距离等于1米(即第二阈值)或者小于1米时,表明被测平板50已经在传感器的检测范围内,此时,可以开始通过驱动器40对机器人上的抓取组件10的姿态进行调整。Wherein, before the driver 40 adjusts the posture of the gripping assembly 10 in response to the control signal, the driver 40 adjusts the posture of the gripping assembly 10 such that the at least one sensor detects that the distance from the measured panel 50 reaches a second threshold, thereby The measuring plate 50 is located in the detection range of the robot. For example, the distance between the gripping assembly 10 of the robot and the horizontal ground is 1.5 meters, and the flat plate 50 to be tested is placed on the platform of 0.5 meters high; during the movement of the robot to the tested flat 50, the sensor detects the gripping assembly 10 and The distance of the object in the grasping direction is 1.5 meters. When the robot is close to the measured plate 50, at least one sensor detects that the distance is equal to 1 meter (ie, the second threshold) or less than 1 meter, indicating that the measured plate 50 is already in the sensor. Within the detection range, at this time, the posture of the gripping assembly 10 on the robot can be adjusted by the driver 40.
可选的,传感器是超声波传感器。当然,还可以是激光测距仪等其他距离传感器。Optionally, the sensor is an ultrasonic sensor. Of course, it can also be other distance sensors such as laser range finder.
在本实施例中,以抓取组件10的中心或抓取组件10所在的平面上的某一点为原点,以抓取组件10所在的平面上相互垂直的第一方向和第二方向分别为X轴和Y轴,以垂直于抓取组件10所在的平面的第三方向为Z轴;其中第一传感器201和第二传感器202之间的连线平行于X轴。In this embodiment, a point on the plane of the gripping assembly 10 or the plane on which the gripping assembly 10 is located is taken as an origin, and the first direction and the second direction perpendicular to each other on the plane where the gripping assembly 10 is located are respectively X. The shaft and the Y-axis are Z-axis in a third direction perpendicular to the plane in which the gripping assembly 10 is located; wherein the line between the first sensor 201 and the second sensor 202 is parallel to the X-axis.
在一个应用场景中,为实现使各抓取部101与被测平板50距离均一致,控制器30发送控制信号,控制驱动器40驱动机器人向被测平板50移动,使至少一个传感器检测到与被测平板50的距离达到第二阈值,表明机器人到达检测范围;控制器30再发出控制信号,使驱动器40带动抓取组件10绕Y轴转动,直到第一传感器201、第二传感器202分别与被测平板50之间的距离相等;然后使抓取组件10再绕X轴转动,直到第一传感器201、第三传感器203分别与被测平板50之间的距离相等,由于第一传感器201和第二传感器202之间的连线平行于X轴,此时,必然存在第一传感器201、第二传感器202、第三传感器203 与被测平板50之间的距离都相等,即抓取组件10平行于被测平板50,完成机器人姿态的自动调整。In an application scenario, in order to achieve uniformity between the respective grabbing portions 101 and the measured tablet 50, the controller 30 sends a control signal, and the control driver 40 drives the robot to move to the tested tablet 50, so that at least one sensor detects and is The distance between the measuring plate 50 reaches a second threshold, indicating that the robot reaches the detection range; the controller 30 re-issues the control signal, causing the driver 40 to drive the gripping assembly 10 to rotate about the Y axis until the first sensor 201 and the second sensor 202 are respectively The distance between the measuring plates 50 is equal; then the grasping assembly 10 is rotated about the X axis until the distance between the first sensor 201 and the third sensor 203 and the measured plate 50 is equal, due to the first sensor 201 and the first The connection between the two sensors 202 is parallel to the X axis. At this time, the first sensor 201, the second sensor 202, and the third sensor 203 are necessarily present. The distance between the measured plate 50 and the measured plate 50 is equal, that is, the grasping assembly 10 is parallel to the measured plate 50, and the automatic adjustment of the robot posture is completed.
参见图2至图4,在本实施例中,当被测平板50为圆形时,控制器30还用于控制机器人上的第一传感器201从圆形被测平板50上方的任一点开始沿X轴的正向运动,当第一传感器201检测到与圆形被测平板50之间的距离发生突变时,表明到达圆形被测平板50的边上,标记此点为A1;同理,控制机器人上的第一传感器201沿X轴的负向运动,标记第一传感器201到被测平板50之间的距离发生突变时的点为B1;控制器30还用于控制机器人上的第一传感器201回到对应点A1的位置,以点A1为点C1,沿Y轴的负向运动,标记第一传感器201到被测平板50之间的距离发生突变时的点为D1;利用点A1、B1、C1和D1的坐标来计算出圆形被测平板50的圆心位置、圆的边的位置和面积,从而得到圆形被测平板50的姿态。Referring to FIG. 2 to FIG. 4, in the embodiment, when the panel 50 to be tested is circular, the controller 30 is further configured to control the first sensor 201 on the robot to start from any point above the circular panel 50. The positive movement of the X-axis, when the first sensor 201 detects a sudden change in the distance from the circular plate 50 to be tested, indicates that it reaches the side of the circular plate 50 to be tested, and marks this point as A 1 ; controlling the first sensor on the robot 201 along the X axis negative direction, when the marker 201 to the measured distance between the first sensor plate 50 is mutated B 1; controller 30 is further configured to control the robot The first sensor 201 returns to the position corresponding to the point A 1 , and the point A 1 is the point C 1 , and the negative movement along the Y axis indicates that the point at which the distance between the first sensor 201 and the measured plate 50 is abrupt is D 1 ; The coordinates of the points A 1 , B 1 , C 1 and D 1 are used to calculate the position of the center of the circular plate 50 to be measured, the position and the area of the side of the circle, thereby obtaining the posture of the circular plate 50 to be measured.
具体的,由于X轴与Y轴垂直,所以B1与D1的连线经过圆形被测平板50的圆心,B1D1为圆形被测平板50的直径,得到圆心位置为点B1和点D1的连线的中点;根据中点和直径得到圆的边的位置;计算点A1和点B1在X轴方向上的差值为d1,计算点C1和点D1在Y轴方向上的差值为d2,根据勾股定理以及圆的面积公式得到圆形被测平板50的面积为Specifically, since the X axis is perpendicular to the Y axis, the line connecting B 1 and D 1 passes through the center of the circular plate 50 to be measured, and B 1 D 1 is the diameter of the circular plate 50 to be measured, and the position of the center of the circle is obtained as point B. the midpoints of the points D 1 and 1; according to the midpoint of the diameter of a circle obtained edge position; point C 1 and point difference calculating point and the point a 1 B 1 in the X-axis direction is d 1, is calculated The difference of D 1 in the Y-axis direction is d 2 , and the area of the circular measured panel 50 is obtained according to the Pythagorean theorem and the area formula of the circle.
Figure PCTCN2017086362-appb-000001
Figure PCTCN2017086362-appb-000001
当被测平板50为矩形时,控制器30还用于控制机器人上的第一传感器201从矩形被测平板50上方的任一点开始沿X轴的正向运动,当第一传感器201检测到与矩形被测平板50之间的距离发生突变时,表明到达矩形被测平板50的边上,标记此点为A2;同理,控制机器人上的第一传感器201沿X轴的负向运动,标记第一传感器201到被测平板50之间的距离发生突变时的点为B2;控制器30还用于控制机器人上的第一传感器201从矩形被测平板50上方的任一点开始沿Y轴的正向运行,标记第一传感器201到被测平板50之间的距离发生突变时的点为C2;控制机器人上的第一传感器201沿X轴的负向运动,标记第一 传感器201到被测平板50之间的距离发生突变时的点为D2,;利用点A2、B2、C2和D2的坐标来计算出矩形被测平板50的对称中心的位置、四个顶点的位置和面积,从而得到矩形被测平板50的姿态。When the measured plate 50 is rectangular, the controller 30 is further configured to control the first sensor 201 on the robot to start the positive movement along the X axis from any point above the rectangular measured plate 50, when the first sensor 201 detects When the distance between the rectangular measured panels 50 is abrupt, it indicates that the edge of the rectangular measured panel 50 is reached, and the point is marked as A 2 ; similarly, the negative movement of the first sensor 201 on the robot along the X-axis is controlled. The point at which the distance between the first sensor 201 and the measured plate 50 is abruptly changed is B 2 ; the controller 30 is further configured to control the first sensor 201 on the robot to start from any point above the rectangular measured plate 50 along the Y The forward running of the shaft, the point at which the distance between the first sensor 201 and the measured plate 50 is abruptly changed is C 2 ; the negative movement of the first sensor 201 on the control robot along the X axis is marked, and the first sensor 201 is marked. The point at which the distance between the measured plates 50 is abruptly changed is D 2 , and the coordinates of the points A 2 , B 2 , C 2 , and D 2 are used to calculate the position of the symmetric center of the rectangular plate 50 to be tested, four The position and area of the vertex, resulting in a rectangle Measuring the attitude of the plate 50.
具体的,矩形被测平板50的一边与X轴或Y轴平行,点A2与点B2的连线即为矩形被测平板50的长(或宽),计算点A2和点B2在X轴方向上的差值为d3,由于X轴与Y轴垂直,C2与D2的连线即为被测平板50的宽(或长),计算点C2和点D2在Y轴方向上的差值为d4,点A2和点B2的中点所在的与X轴平行的线与点A2和点B2的中点所在的与Y轴平行的线的交点为矩形被测平板50的对称中心;根据对称中心、矩形被测平板50的长、宽和矩形边的方向得到四个顶点的位置;根据矩形被测平板50的长、宽得到矩形被测平板50的面积为:Specifically, one side of the rectangular measured plate 50 is parallel to the X axis or the Y axis, and the line connecting the point A 2 and the point B 2 is the length (or width) of the rectangular measured plate 50, and the point A 2 and the point B 2 are calculated. The difference in the X-axis direction is d 3 , since the X-axis is perpendicular to the Y-axis, the line connecting C 2 and D 2 is the width (or length) of the plate 50 to be tested, and the calculation point C 2 and point D 2 are the difference in the Y-axis direction is d 4, Y-axis line parallel to the midpoint of the point a 2 and point B 2 is located in a line parallel to the X axis and the point a 2 and point B 2 of the points of intersection where It is the symmetrical center of the rectangular plate 50 to be tested; the positions of the four vertices are obtained according to the symmetry center, the length, the width and the direction of the rectangular side of the rectangular plate 50; the rectangular test plate is obtained according to the length and width of the rectangular plate 50 to be tested. The area of 50 is:
Sr=|d3|×|d4|。S r =|d 3 |×|d 4 |.
参见图1至图4,控制器30还用于根据被测平板50的姿态调整抓取组件10的姿态和抓取部101的位置,控制机器人沿第三方向抓取被测平板50。Referring to FIG. 1 to FIG. 4, the controller 30 is further configured to adjust the posture of the gripping assembly 10 and the position of the gripping portion 101 according to the posture of the tested tablet 50, and control the robot to grasp the panel 50 to be tested in the third direction.
可选的,抓取部101为吸盘,抓取组件10设置有至少两个吸盘,至少两个吸盘既可固定设置在抓取组件10上,也可以活动设置在抓取组件10上。Optionally, the gripping portion 101 is a suction cup, and the gripping assembly 10 is provided with at least two suction cups, and at least two suction cups can be fixedly disposed on the gripping assembly 10 or can be movably disposed on the gripping assembly 10.
可选的,抓取部101还可以是机械手指等其他具有抓取功能的零件。Optionally, the gripping portion 101 may also be a part with a gripping function such as a mechanical finger.
具体的,当抓取部101固定设置在抓取组件10上时,控制抓取组件10在其本身所在平面上移动,使抓取组件10的中心与被测平板50的中心的连线与被测平板50垂直;当抓取部101活动设置在抓取组件10上时,则根据被测平板50的形状和面积,适当调整抓取组件10在其本身所在平面上的位置及抓取部101在抓取组件10上的位置。Specifically, when the gripping portion 101 is fixedly disposed on the gripping assembly 10, the gripping assembly 10 is controlled to move on its own plane, so that the center of the gripping assembly 10 and the center of the tested tablet 50 are connected and The measuring plate 50 is vertical; when the gripping portion 101 is movably disposed on the gripping assembly 10, the position of the gripping assembly 10 on its own plane and the gripping portion 101 are appropriately adjusted according to the shape and area of the plate 50 to be tested. The position on the grab assembly 10.
具体的,当被测平板50为圆形时,控制器30根据圆形被测平板50的圆心和圆的边的位置、圆形被测平板50的面积,控制器30控制抓取部101移动到对应圆形被测平板50的抓取点;可选的,抓取组件10包括三个抓取部101,抓取部101对应圆形被测平板50的抓取位置,控制器30根据圆形被测平板50的面积选择靠近圆的边的位置或者靠近圆心的位置为抓取位置,抓取部101形成等边三角形且等边三角形的重心对应圆形被测平板50的圆心,以使每个抓取部 101的受力相同,便于抓取被测平板50;当然,抓取点也可以是其他便于抓取被测平板50的位置。Specifically, when the measured flat plate 50 is circular, the controller 30 controls the movement of the gripping portion 101 according to the position of the center of the circular measured flat plate 50 and the position of the circular side of the circle, and the area of the circular measured plate 50. The grabbing point corresponding to the circular measuring plate 50; optionally, the gripping assembly 10 includes three gripping portions 101, the gripping portion 101 corresponds to the gripping position of the circular measured panel 50, and the controller 30 according to the circle The area of the shape-measuring plate 50 is selected to be close to the edge of the circle or the position near the center of the circle is the grasping position, the gripping portion 101 forms an equilateral triangle, and the center of gravity of the equilateral triangle corresponds to the center of the circular plate 50 to be measured, so that Each grab The force of 101 is the same, which is convenient for grasping the plate 50 to be tested; of course, the grabbing point may also be other positions for easily grasping the plate 50 to be tested.
具体的,当被测平板50为矩形时,控制器30根据矩形被测平板50的对称中心的位置、四个顶点的位置和面积,控制器30控制抓取部101移动到对应矩形被测平板50的抓取点;可选的,抓取组件10包括两个抓取部101,抓取部101对应矩形被测平板50的抓取位置,控制器30根据矩形被测平板50的面积选择靠近矩形的四个顶点的位置或对称中心的位置为抓取位置,抓取部101的连线的中心对应矩形被测平板50的对称中心,以使每个抓取部101的受力相同,便于抓取被测平板50;当然,抓取点也可以是其他便于抓取被测平板50的位置。Specifically, when the measured flat panel 50 is rectangular, the controller 30 controls the gripping portion 101 to move to the corresponding rectangular measured flat panel according to the position of the symmetric center of the rectangular measured flat panel 50, the position and the area of the four vertices. The gripping point of 50; optionally, the gripping assembly 10 includes two gripping portions 101, the gripping portion 101 corresponds to the gripping position of the rectangular panel 50 to be tested, and the controller 30 selects the proximity according to the area of the rectangular panel 50 to be tested. The position of the four vertices of the rectangle or the position of the center of symmetry is the gripping position, and the center of the line of the gripping portion 101 corresponds to the center of symmetry of the rectangular plate 50 to be tested, so that the force of each gripping portion 101 is the same, which is convenient. The plate to be tested 50 is grasped; of course, the grabbing point may also be other positions for easily grasping the plate 50 to be tested.
本发明通过检测机器人抓取部与被测平板之间的距离,实现自动调整机器人姿态;通过自动标记坐标,实现根据被测平板的姿态自动调整抓取部在抓取组件所在平面上的位置,准确有效地抓取被测平板,节省大量时间和人工,提高工作效率。The invention automatically adjusts the posture of the robot by detecting the distance between the gripping portion of the robot and the flat plate to be tested; and automatically adjusts the position of the gripping portion on the plane of the gripping component according to the posture of the tested flat plate by automatically marking the coordinates, Accurate and effective capture of the tested flat panel, saving a lot of time and labor, and improving work efficiency.
参见图5,本发明调整机器人姿态的方法实施例,应用于机器人的控制器中,其中,机器人还包括驱动器、至少三个传感器以及安装于机器人的机械臂上的抓取组件,至少三个传感器分散设置于抓取组件上或分散设置于与抓取组件具有相对位置关系的位置,方法包括:Referring to FIG. 5, a method embodiment of the present invention for adjusting a posture of a robot is applied to a controller of a robot, wherein the robot further includes a driver, at least three sensors, and a gripping assembly mounted on the robot arm of the robot, at least three sensors. Dispersingly disposed on the grasping component or dispersedly disposed at a position in a relative position relationship with the grasping component, the method includes:
S101、使至少一个传感器检测到与被测平板的距离达到第二阈值;S101, causing at least one sensor to detect that the distance from the measured panel reaches a second threshold;
当至少一个传感器检测到抓取组件与其抓取方向上的物体的距离小于等于第二阈值时,机器人到达检测范围。The robot reaches the detection range when the at least one sensor detects that the distance of the gripping component from the object in its gripping direction is less than or equal to the second threshold.
S102、利用至少三个传感器检测各个传感器与被测平板间的距离;S102. Detecting, by using at least three sensors, a distance between each sensor and the tested slab;
S103、根据每个传感器与被测平板间的距离计算出被测平板的姿态,生成相应的控制信号并发送给驱动器;S103: Calculate a posture of the tested tablet according to a distance between each sensor and the measured tablet, generate a corresponding control signal, and send the signal to the driver;
S1041、使驱动器响应控制信号而调整抓取组件的姿态,使至少三个传感器中的第一传感器和第二传感器之间的连线平行于第一方向;S1041, causing a driver to adjust a posture of the grabbing component in response to the control signal, so that a line between the first sensor and the second sensor of the at least three sensors is parallel to the first direction;
S1042、调整抓取组件的姿态,使抓取组件绕与第一方向垂直的第二方向转 动,直到第一传感器、第二传感器分别与被测平板之间的距离相等或差值小于第一阈值;S1042, adjusting a posture of the gripping component, so that the gripping component rotates in a second direction perpendicular to the first direction Moving until the distance between the first sensor and the second sensor and the measured panel are equal or the difference is less than the first threshold;
S1043、调整抓取组件的姿态,使抓取组件绕第一方向转动,直到第一传感器、第三传感器分别与被测平板之间的距离相等或差值小于第一阈值。S1043: Adjust the posture of the grasping component to rotate the grasping component in the first direction until the distance between the first sensor and the third sensor and the measured panel are equal or the difference is less than the first threshold.
其中,第一方向和第二方向在抓取组件所在的平面上,第三方向与抓取组件所在的平面垂直,第一方向、第二方向和第三方向两两垂直。The first direction and the second direction are on a plane where the gripping component is located, and the third direction is perpendicular to a plane in which the gripping component is located, and the first direction, the second direction, and the third direction are perpendicular to each other.
可选的,其中一种预定条件是抓取组件上各抓取部与被测平板间的距离相等,还有一种预定条件是使各抓取部与被测平板距离的差值小于第一阈值。Optionally, one of the predetermined conditions is that the distance between each of the grasping parts on the grasping component and the measured flat plate is equal, and a predetermined condition is that the difference between the distances of the grabbing parts and the measured flat plate is less than the first threshold. .
在一个应用场景中,为实现使各抓取部与被测平板距离均一致,控制器发送控制信号,控制驱动器驱动机器人向被测平板移动,使至少一个传感器检测到与被测平板的距离达到第二阈值,表明机器人到达检测范围;控制器再发出控制信号,使驱动器带动抓取组件绕第二方向转动,直到第一传感器、第二传感器分别与被测平板之间的距离相等;然后使抓取组件再绕第一方向转动,直到第一传感器、第三传感器分别与被测平板之间的距离相等,由于第一传感器和第二传感器之间的连线平行于第一方向,此时,必然存在第一传感器、第二传感器、第三传感器与被测平板之间的距离都相等,即抓取组件平行于被测平板,完成机器人姿态的自动调整。In an application scenario, in order to achieve the same distance between each grabbing unit and the measured panel, the controller sends a control signal, and the control driver drives the robot to move to the tested tablet, so that at least one sensor detects that the distance from the measured panel reaches a second threshold, indicating that the robot reaches the detection range; the controller then sends a control signal to cause the driver to drive the gripping assembly to rotate in the second direction until the distance between the first sensor and the second sensor and the panel to be tested are equal; The grasping assembly is further rotated in the first direction until the distance between the first sensor and the third sensor and the measured plate are equal, because the connection between the first sensor and the second sensor is parallel to the first direction, The distance between the first sensor, the second sensor, and the third sensor and the measured plate must be equal, that is, the grasping component is parallel to the measured flat plate, and the automatic adjustment of the robot posture is completed.
S105、判断被测平板为圆形或矩形;在被测平板为圆形时,执行步骤S1061;在被测平板为矩形时,执行步骤S1071。具体的,可以通过根据接收的用户输入数据来判断被测平板是圆形还是矩形。S105, determining that the measured flat plate is circular or rectangular; when the measured flat plate is circular, step S1061 is performed; and when the measured flat plate is rectangular, step S1071 is performed. Specifically, whether the measured flat panel is circular or rectangular can be determined according to the received user input data.
S1061、被测平板为圆形时,控制机器人沿第一方向的正向运动,标记第一传感器到被测平板之间的距离发生突变时的点为A1,控制机器人沿第一方向的负向运动,标记第一传感器到被测平板之间的距离发生突变时的点为B1S1061, the test plate is circular, the control forward motion of the robot in a first direction, a first sensor mark distance between the point mutation is measured plates A 1, negative control of the robot in a first direction To the movement, the point at which the distance between the first sensor and the plate to be tested is abrupt is B 1 ;
S1062、控制机器人沿第二方向的正向运动,标记第一传感器到被测平板之间的距离发生突变时的点为C1,控制机器人沿第二方向的负向运动,标记第一传感器到被测平板之间的距离发生突变时的点为D1S1062, control the forward motion of the robot in a second direction, a first sensor mark distance between the point mutation is measured plates C 1, the control of the robot in the second direction to the negative direction, the first mark sensor The point at which the distance between the tested plates is abrupt is D 1 ;
S1063、利用点A1、B1、C1和D1的坐标来计算得出被测平板的姿态;S1063. Calculate the posture of the tested tablet by using coordinates of points A 1 , B 1 , C 1 , and D 1 ;
控制器根据点A1、B1、C1和D1的坐标,可以确定圆形被测平板的圆心位置、圆的边的位置和面积,即被测平板的姿态,控制器根据被测平板的姿态控制抓取部移动到对应圆形被测平板的抓取点。According to the coordinates of the points A 1 , B 1 , C 1 and D 1 , the controller can determine the position of the center of the circular plate to be measured, the position and the area of the side of the circle, that is, the posture of the plate to be tested, and the controller according to the plate to be tested The attitude control gripper moves to the grab point of the corresponding circular test panel.
具体的,由于第一方向与第二方向垂直,所以A1与D1的连线经过圆形被测平板的圆心,A1D1为圆形被测平板的直径,得到圆心位置为点A1和点D1的连线的中点;根据中点和直径得到圆的边的位置;计算点A1和点B1在第一方向方向上的差值为d1,计算点C1和点D1在第二方向方向上的差值为d2,根据勾股定理以及圆的面积公式得到圆形被测平板的面积为Specifically, since the first direction is perpendicular to the second direction, the line connecting A 1 and D 1 passes through the center of the circular measuring plate, and A 1 D 1 is the diameter of the circular measuring plate, and the center position is the point A. 1 point and the midpoint D 1; obtained according to the midpoint of the diameter and position of the edge of the circle; a 1 point and calculating the difference between a point B in the first direction is d 1, and calculates a point C The difference of the point D 1 in the direction of the second direction is d 2 , and the area of the circular measured plate is obtained according to the Pythagorean theorem and the area formula of the circle.
Figure PCTCN2017086362-appb-000002
Figure PCTCN2017086362-appb-000002
S1071、被测平板为矩形时,控制机器人沿第一方向的正向运动,标记第一传感器到被测平板之间的距离发生突变时的点为A2,控制机器人沿第一方向的负向运动,标记第一传感器到被测平板之间的距离发生突变时的点为B2S1071: When the measured flat plate is rectangular, the forward movement of the robot in the first direction is controlled, and the point at which the distance between the first sensor and the tested flat plate is abrupt is A 2 , and the negative direction of the controlling robot in the first direction is controlled. Movement, the point at which the distance between the first sensor and the measured plate is abrupt is B 2 ;
S1072、控制机器人沿第二方向的正向运动,标记第一传感器到被测平板之间的距离发生突变时的点为C2,控制机器人沿第二方向的负向运动,标记第一传感器到被测平板之间的距离发生突变时的点为D2S1072, control the forward motion of the robot in a second direction, a first sensor to the point marking the measured distance between the plates is mutated C 2, the control of the robot in the second direction to the negative direction, the first mark sensor The point at which the distance between the tested plates is abrupt is D 2 ;
S1073、利用A2、B2、C2和D2的坐标来计算得出被测平板的姿态;S1073, calculating coordinates of the measured panel by using coordinates of A 2 , B 2 , C 2 , and D 2 ;
控制器根据点A2、B2、C2和D2的坐标,可以确定矩形被测平板的对称中心的位置、四个顶点的位置和面积,即被测平板的姿态,控制器根据被测平板的姿态控制抓取部移动到对应圆形被测平板的抓取点。According to the coordinates of the points A 2 , B 2 , C 2 and D 2 , the controller can determine the position of the symmetry center of the rectangular measured plate, the position and area of the four vertices, that is, the posture of the tested plate, and the controller is determined according to the measured The attitude control of the tablet moves to the grab point of the corresponding circular test panel.
具体的,矩形被测平板的一边与第一方向或第二方向平行,点A2与点B2的连线即为矩形被测平板的长(或宽),计算点A2和点B2在第一方向方向上的差值为d3,由于第一方向与第二方向垂直,C2与D2的连线即为被测平板的宽(或长),计算点C2和点D2在第二方向方向上的差值为d4,点A2和点B2的中点所在的与第一方向平行的线与点A2和点B2的中点所在的与第二方向平行的线的交点为矩形被测平板的对称中心;根据对称中心、矩形被测平板的长、宽和矩形边的方向 得到四个顶点的位置;根据矩形被测平板的长、宽得到矩形被测平板的面积为:Specifically, one side of the rectangular test panel is parallel to the first direction or the second direction, and the line connecting the point A 2 and the point B 2 is the length (or width) of the rectangular measured panel, and the point A 2 and the point B 2 are calculated. The difference in the direction of the first direction is d 3 , and since the first direction is perpendicular to the second direction, the line connecting C 2 and D 2 is the width (or length) of the panel to be tested, and the point C 2 and point D are calculated. 2 difference in the second direction is d 4, the midpoint of the second direction line parallel to the first direction and the point a 2 and point B is a midpoint point a 2 and point B 2 where 2 is located The intersection of the parallel lines is the symmetry center of the rectangular measured plate; the positions of the four vertices are obtained according to the symmetry center, the length, the width and the direction of the rectangular side of the rectangular measured plate; the rectangle is obtained according to the length and width of the rectangular measured plate The area of the measuring plate is:
Sr=|d3|×|d4|。S r =|d 3 |×|d 4 |.
S108、根据被测平板的姿态调整抓取组件的姿态和抓取位置,控制机器人沿第三方向抓取被测平板。S108. Adjust the posture of the grabbing component and the grab position according to the posture of the tested tablet, and control the robot to grab the measured panel in the third direction.
具体的,第三方向分别垂直于第一方向和第二方向。Specifically, the third direction is perpendicular to the first direction and the second direction, respectively.
具体的,通过调整抓取部在抓取组件上的位置以调抓取位置。Specifically, the position of the gripping portion is adjusted by adjusting the position of the gripping portion on the gripping assembly.
本发明通过检测机器人抓取部与被测平板之间的距离,实现自动调整机器人姿态;通过自动标记坐标,实现根据被测平板的面积自动调整抓取部在抓取组件所在平面上的位置,准确有效地抓取被测平板,节省大量时间和人工,提高工作效率。The invention automatically adjusts the posture of the robot by detecting the distance between the gripping portion of the robot and the flat plate to be tested; and automatically adjusts the position of the gripping portion on the plane of the gripping component according to the area of the tested flat plate by automatically marking the coordinates, Accurate and effective capture of the tested flat panel, saving a lot of time and labor, and improving work efficiency.
以上所述仅为本发明的实施方式,并非因此限制本发明的专利范围,凡是利用本发明说明书及附图内容所作的等效结构或等效流程变换,或直接或间接运用在其他相关的技术领域,均同理包括在本发明的专利保护范围内。 The above is only the embodiment of the present invention, and is not intended to limit the scope of the invention, and the equivalent structure or equivalent process transformations made by the description of the invention and the drawings are directly or indirectly applied to other related technologies. The fields are all included in the scope of patent protection of the present invention.

Claims (20)

  1. 一种机器人,其中,包括:控制器、驱动器、至少三个传感器以及安装于机器人的机械臂上的抓取组件;A robot, comprising: a controller, a driver, at least three sensors, and a gripping assembly mounted on a robot arm of the robot;
    所述抓取组件,用于抓取被测平板;The grasping component is configured to grab the tested tablet;
    所述至少三个传感器分散设置于所述抓取组件上或分散设置于与所述抓取组件具有相对位置关系的位置,用于检测各个传感器与被测平板间的距离;The at least three sensors are disposed on the grasping component or are disposed in a position in a relative position relationship with the grasping component for detecting a distance between each sensor and the measured panel;
    所述控制器与每个传感器及所述驱动器相连,用于接收所述每个传感器与所述被测平板间的距离,根据所述每个传感器与被测平板间的距离计算出被测平板的姿态,生成相应的控制信号并发送给所述驱动器;The controller is connected to each sensor and the driver, and is configured to receive a distance between each sensor and the measured panel, and calculate a measured tablet according to a distance between each sensor and the measured panel. Gesture, generating a corresponding control signal and transmitting to the driver;
    所述驱动器与所述抓取组件相连,用于响应所述控制信号而调整所述抓取组件的姿态,使得所述抓取组件的姿态满足预定条件。The driver is coupled to the gripping assembly for adjusting a posture of the gripping assembly in response to the control signal such that a posture of the gripping assembly satisfies a predetermined condition.
  2. 根据权利要求1所述的机器人,其中,所述驱动器响应所述控制信号而调整所述抓取组件的姿态,包括:The robot of claim 1, wherein the driver adjusts a posture of the gripping component in response to the control signal, comprising:
    调整所述抓取组件的姿态,使所述至少三个传感器中的第一传感器和第二传感器之间的连线平行于第一方向;Adjusting a posture of the gripping assembly such that a line between the first sensor and the second sensor of the at least three sensors is parallel to the first direction;
    调整所述抓取组件的姿态,使所述抓取组件绕与所述第一方向垂直的第二方向转动,直到所述第一传感器、所述第二传感器分别与被测平板之间的距离相等或差值小于第一阈值;Adjusting a posture of the gripping assembly to rotate the gripping assembly in a second direction perpendicular to the first direction until a distance between the first sensor and the second sensor and the panel to be tested Equal or difference is less than the first threshold;
    调整所述抓取组件的姿态,使所述抓取组件绕所述第一方向转动,直到所述第一传感器、所述第三传感器分别与所述被测平板之间的距离相等或差值小于第一阈值。Adjusting the posture of the gripping assembly to rotate the gripping assembly about the first direction until the distance between the first sensor and the third sensor and the measured panel are equal or different Less than the first threshold.
  3. 根据权利要求2所述的机器人,其中,The robot according to claim 2, wherein
    在所述驱动器响应所述控制信号而调整所述抓取组件的姿态之前,所述驱动器还用于调整所述抓取组件的姿态,以使得至少一个所述传感器检测到与所述被测平板的距离达到第二阈值,从而使所述被测平板位于所述机器人的检测 范围。The driver is further configured to adjust a posture of the gripping component before the driver adjusts a posture of the gripping component in response to the control signal, so that at least one of the sensors detects the tablet to be tested The distance reaches a second threshold, so that the tested tablet is located in the detection of the robot range.
  4. 根据权利要求1所述的机器人,其中,The robot according to claim 1, wherein
    所述被测平板为圆形时,所述控制器还用于在控制所述机器人沿第一方向的正向运动时,标记所述第一传感器到所述被测平板之间的距离发生突变时的点为A1;在控制所述机器人沿第一方向的负向运动时,标记所述第一传感器到所述被测平板之间的距离发生突变时的点为B1;所述控制器还用于在控制所述机器人沿垂直于所述第一方向的第二方向的正向运动时,标记所述第一传感器到所述被测平板之间的距离发生突变时的点为C1;在控制所述机器人沿第二方向的负向运动时,标记所述第一传感器到所述被测平板之间的距离发生突变时的点为D1,利用所述点A1、B1、C1和D1的坐标来计算得出所述被测平板的姿态。When the measured slab is circular, the controller is further configured to mark a sudden change in the distance between the first sensor and the tested slab when controlling the forward movement of the robot in the first direction The point at the time is A 1 ; when controlling the negative movement of the robot in the first direction, the point at which the distance between the first sensor and the measured plate is abruptly changed is B 1 ; The device is further configured to, when controlling the forward movement of the robot in a second direction perpendicular to the first direction, mark a point when the distance between the first sensor and the tested plate is abruptly changed to C 1; in a second direction to control the robot movement negative, marking the first sensor to a point when the measured distance between the plates D 1 is mutated, with the point a 1, B The coordinates of 1 , C 1 and D 1 are used to calculate the attitude of the plate under test.
  5. 根据权利要求4所述的机器人,其中,The robot according to claim 4, wherein
    所述点A1与点C1重合。The point A 1 coincides with the point C 1.
  6. 根据权利要求1所述的机器人,其中,The robot according to claim 1, wherein
    所述被测平板为矩形时,所述控制器还用于在控制所述机器人沿第一方向的正向运动时,标记所述第一传感器到所述被测平板之间的距离发生突变时的点为A2;在控制所述机器人沿第一方向的负向运动时,标记所述第一传感器到所述被测平板之间的距离发生突变时的点为B2;所述控制器还用于在控制所述机器人沿第二方向的正向运动时,标记所述第一传感器到所述被测平板之间的距离发生突变时的点为C2;在控制所述机器人沿第二方向的负向运动时,标记所述第一传感器到所述被测平板之间的距离发生突变时的点为D2,所述点A2、B2、C2和D2分别位于所述矩形的四个边上,利用所述点A2、B2、C2和D2的坐标来计算得出所述被测平板的姿态。When the measured flat plate is rectangular, the controller is further configured to mark a sudden change in the distance between the first sensor and the tested flat plate when controlling the forward movement of the robot in the first direction The point is A 2 ; when controlling the negative movement of the robot in the first direction, the point at which the distance between the first sensor and the measured plate is abruptly changed is B 2 ; And when used to control the forward movement of the robot in the second direction, the point at which the distance between the first sensor and the measured plate is abruptly changed is C 2 ; In the negative direction movement in the two directions, the point at which the distance between the first sensor and the measured plate is abruptly changed is D 2 , and the points A 2 , B 2 , C 2 and D 2 are respectively located On the four sides of the rectangle, the coordinates of the points A 2 , B 2 , C 2 and D 2 are used to calculate the attitude of the plate under test.
  7. 根据权利要求6所述的机器人,其中,The robot according to claim 6, wherein
    所述被测平板的一边与所述第一方向或第二方向平行,所述第一方向与所述第二方向垂直。One side of the measured flat plate is parallel to the first direction or the second direction, and the first direction is perpendicular to the second direction.
  8. 根据权利要求1所述的机器人,其中, The robot according to claim 1, wherein
    所述抓取组件上设置有至少一个抓取部;The grabbing assembly is provided with at least one gripping portion;
    所述预定条件是所述抓取组件上每个抓取部与所述被测平板间的距离相等或差值小于第一阈值。The predetermined condition is that the distance between each of the gripping portions on the gripping component and the measured panel is equal or the difference is less than a first threshold.
  9. 根据权利要求1-8任一项所述的机器人,其中,A robot according to any one of claims 1 to 8, wherein
    所述控制器还用于根据所述被测平板的姿态调整所述抓取组件的姿态和抓取位置,控制所述机器人沿第三方向抓取所述被测平板,所述第三方向分别垂直于所述第一方向和第二方向。The controller is further configured to adjust a posture and a grab position of the gripping component according to the posture of the measured tablet, and control the robot to grasp the measured panel in a third direction, where the third direction is respectively Vertical to the first direction and the second direction.
  10. 根据权利要求8所述的机器人,其中,The robot according to claim 8, wherein
    所述抓取部为吸盘,所述抓取组件上设置有至少两个吸盘,所述至少两个吸盘活动设置在所述抓取组件上。The gripping portion is a suction cup, and the gripping assembly is provided with at least two suction cups, and the at least two suction cups are disposed on the gripping assembly.
  11. 一种调整机器人姿态的方法,应用于机器人的控制器中,其中,所述机器人还包括驱动器、至少三个传感器以及安装于机器人的机械臂上的抓取组件,所述至少三个传感器分散设置于所述抓取组件上或分散设置于与所述抓取组件具有相对位置关系的位置,所述方法包括:A method for adjusting a posture of a robot is applied to a controller of a robot, wherein the robot further includes a driver, at least three sensors, and a gripping assembly mounted on a robot arm of the robot, the at least three sensors being dispersedly disposed And at a position on the grasping component or dispersedly disposed in a relative position relationship with the grasping component, the method includes:
    利用所述至少三个传感器检测各个传感器与被测平板间的距离;Detecting a distance between each sensor and the measured panel by using the at least three sensors;
    根据所述每个传感器与被测平板间的距离计算出被测平板的姿态,生成相应的控制信号并发送给驱动器,以使得所述驱动器响应所述控制信号而调整所述抓取组件的姿态,使得所述抓取组件的姿态满足预定条件。Calculating a posture of the tested panel according to a distance between each sensor and the measured panel, generating a corresponding control signal and transmitting the signal to the driver, so that the driver adjusts the posture of the grabbing component in response to the control signal The posture of the gripping assembly is made to satisfy a predetermined condition.
  12. 根据权利要求11所述的方法,其中,The method of claim 11 wherein
    使所述驱动器响应所述控制信号而调整所述抓取组件的姿态,包括:Having the driver adjust the posture of the grabbing component in response to the control signal, including:
    调整所述抓取组件的姿态,使所述至少三个所述传感器中的第一传感器和第二传感器之间的连线平行于第一方向;Adjusting a posture of the gripping assembly such that a line between the first sensor and the second sensor of the at least three of the sensors is parallel to the first direction;
    调整所述抓取组件的姿态,使所述抓取组件绕与所述第一方向垂直的第二方向转动,直到所述第一传感器、所述第二传感器分别与被测平板之间的距离相等或差值小于第一阈值;Adjusting a posture of the gripping assembly to rotate the gripping assembly in a second direction perpendicular to the first direction until a distance between the first sensor and the second sensor and the panel to be tested Equal or difference is less than the first threshold;
    调整所述抓取组件的姿态,使所述抓取组件绕所述第一方向转动,直到所 述第一传感器、所述第三传感器分别与所述被测平板之间的距离相等或差值小于第一阈值。Adjusting the posture of the gripping assembly to rotate the gripping assembly about the first direction until The distance between the first sensor and the third sensor and the measured panel is equal or the difference is less than the first threshold.
  13. 根据权利要求12所述的方法,其中,The method of claim 12, wherein
    在使所述驱动器响应所述控制信号而调整所述抓取组件的姿态之前,还使所述驱动器调整所述抓取组件的姿态,以使得至少一个所述传感器检测到与所述被测平板的距离达到第二阈值,从而使所述被测平板位于所述机器人的检测范围。And causing the driver to adjust a posture of the gripping component before causing the driver to adjust a posture of the gripping component in response to the control signal, so that at least one of the sensors detects the tablet to be tested The distance reaches a second threshold such that the plate under test is within the detection range of the robot.
  14. 根据权利要求13所述的方法,其中,The method of claim 13 wherein
    所述被测平板为圆形时,所述方法还包括:控制所述机器人沿第一方向的正向运动,标记所述第一传感器到所述被测平板之间的距离发生突变时的点为A1;控制所述机器人沿第一方向的负向运动,标记所述第一传感器到所述被测平板之间的距离发生突变时的点为B1;控制所述机器人沿垂直于所述第一方向的第二方向的正向运动,标记所述第一传感器到所述被测平板之间的距离发生突变时的点为C1;控制所述机器人沿第二方向的负向运动,标记所述第一传感器到所述被测平板之间的距离发生突变时的点为D1,利用所述点A1、B1、C1和D1的坐标来计算得出所述被测平板的姿态。When the measured flat plate is circular, the method further includes: controlling a forward movement of the robot in the first direction, and marking a point when the distance between the first sensor and the tested flat plate is abruptly changed. is a 1; controlling the robot in a first direction, the negative direction, marking the first sensor to a point when the measured distance between the plates is mutated B 1; controlling the robot in a direction perpendicular to the a forward movement in a second direction of the first direction, a point at which a sudden change in the distance between the first sensor and the plate to be tested is C 1 ; controlling the negative movement of the robot in the second direction a point at which a sudden change in the distance between the first sensor and the measured plate is D 1 , and the coordinates of the points A 1 , B 1 , C 1 and D 1 are used to calculate the Measure the posture of the tablet.
  15. 根据权利要求14所述的方法,其中,The method of claim 14 wherein
    所述点A1与点C1点重合。The point A 1 coincides with the point C 1 point.
  16. 根据权利要求11所述的方法,其中,The method of claim 11 wherein
    所述被测平板为矩形时,所述方法还包括:控制所述机器人沿第一方向的正向运动,标记所述第一传感器到所述被测平板之间的距离发生突变时的点为A2;控制所述机器人沿第一方向的负向运动,标记所述第一传感器到所述被测平板之间的距离发生突变时的点为B2;控制所述机器人沿第二方向的正向运动,标记所述第一传感器到所述被测平板之间的距离发生突变时的点为C2;控制所述机器人沿第二方向的负向运动,标记所述第一传感器到所述被测平板之间的距离发生突变时的点为D2,所述点A2、B2、C2和D2分别位于所述矩形的四个边 上,利用所述点A2、B2、C2和D2的坐标来计算得出所述被测平板的姿态。When the measured flat plate is rectangular, the method further includes: controlling a forward movement of the robot in a first direction, and marking a point at which a distance between the first sensor and the tested flat plate is abrupt a 2; the negative control movements of the robot in a first direction, the first mark sensor to a point when the measured distance between the plates is mutated B 2; controlling the robot in a second direction a forward motion, a point at which a sudden change in a distance between the first sensor and the measured plate is C 2 ; controlling a negative movement of the robot in a second direction, marking the first sensor to the The point at which the distance between the measured plates is abrupt is D 2 , and the points A 2 , B 2 , C 2 and D 2 are respectively located on the four sides of the rectangle, using the points A 2 , B 2. The coordinates of C 2 and D 2 are used to calculate the attitude of the plate under test.
  17. 根据权利要求16所述的方法,其中,The method of claim 16 wherein
    所述被测平板的一边与所述第一方向或第二方向平行,所述第一方向与所述第二方向垂直。One side of the measured flat plate is parallel to the first direction or the second direction, and the first direction is perpendicular to the second direction.
  18. 根据权利要求11所述的方法,其中,The method of claim 11 wherein
    所述抓取组件上设置有至少一个抓取部;The grabbing assembly is provided with at least one gripping portion;
    所述预定条件是所述抓取组件上每个抓取部与所述被测平板间的距离相等或差值小于第一阈值。The predetermined condition is that the distance between each of the gripping portions on the gripping component and the measured panel is equal or the difference is less than a first threshold.
  19. 根据权利要求11-18任一项所述的方法,其中,A method according to any one of claims 11-18, wherein
    在根据所述被测平板的姿态调整抓取组件的姿态和抓取位置后,所述方法还包括:控制所述机器人沿第三方向抓取所述被测平板,所述第三方向分别垂直于所述第一方向和第二方向。After adjusting the posture and the grasping position of the gripping assembly according to the posture of the measured tablet, the method further includes: controlling the robot to grasp the measured panel in a third direction, wherein the third direction is vertical In the first direction and the second direction.
  20. 根据权利要求18所述的方法,其中,The method of claim 18, wherein
    所述抓取部为吸盘,所述抓取组件上设置有至少两个吸盘,所述至少两个吸盘活动设置在所述抓取组件上。 The gripping portion is a suction cup, and the gripping assembly is provided with at least two suction cups, and the at least two suction cups are disposed on the gripping assembly.
PCT/CN2017/086362 2017-05-27 2017-05-27 Robot and method for adjusting robot posture WO2018218438A1 (en)

Priority Applications (2)

Application Number Priority Date Filing Date Title
CN201780030217.9A CN109311604B (en) 2017-05-27 2017-05-27 Robot and method for adjusting posture of robot
PCT/CN2017/086362 WO2018218438A1 (en) 2017-05-27 2017-05-27 Robot and method for adjusting robot posture

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
PCT/CN2017/086362 WO2018218438A1 (en) 2017-05-27 2017-05-27 Robot and method for adjusting robot posture

Publications (1)

Publication Number Publication Date
WO2018218438A1 true WO2018218438A1 (en) 2018-12-06

Family

ID=64454116

Family Applications (1)

Application Number Title Priority Date Filing Date
PCT/CN2017/086362 WO2018218438A1 (en) 2017-05-27 2017-05-27 Robot and method for adjusting robot posture

Country Status (2)

Country Link
CN (1) CN109311604B (en)
WO (1) WO2018218438A1 (en)

Families Citing this family (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN114061580B (en) * 2020-05-22 2023-12-29 梅卡曼德(北京)机器人科技有限公司 Robot grabbing method and device based on symmetry degree, electronic equipment and medium
CN114059777A (en) * 2020-08-06 2022-02-18 广东博智林机器人有限公司 Wallboard grabbing equipment and control method thereof
CN116040457B (en) * 2023-04-03 2023-06-09 四川沱江起重机有限公司 Crane rotary grabbing system and method
CN117400334A (en) * 2023-11-13 2024-01-16 山东大学 Posture adjustment method for glass fiber composite material automobile leaf spring cutting robot

Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH0582941U (en) * 1992-04-15 1993-11-09 セントラル硝子株式会社 Glass plate transfer device
JPH10338346A (en) * 1997-06-03 1998-12-22 Daihen Corp Position detecting device for liquid crystal glass board
EP1201612A2 (en) * 2000-10-24 2002-05-02 BOTTERO S.p.A. System for parting and handling sheets of glass
DE10155596A1 (en) * 2001-11-13 2003-07-17 Grenzebach Maschb Gmbh Device for stacking plates transported along a plate conveyor comprises a robot with a robot arm, a suction frame, and an arrangement of sensors identifying the position and orientation of each plate
CN203650529U (en) * 2013-09-18 2014-06-18 北京京东方光电科技有限公司 Manipulator
CN205187347U (en) * 2015-12-01 2016-04-27 杭州鸿福科技有限公司 Glass carries tongs
CN106395383A (en) * 2016-11-30 2017-02-15 中建材凯盛机器人(上海)有限公司 Glass stacking device and control method thereof

Family Cites Families (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN101712157B (en) * 2009-10-30 2011-06-15 北京航空航天大学 Welding robot and device for adjusting posture of welding gun of welding robot
CN104723360A (en) * 2014-11-08 2015-06-24 青岛科技大学 Robot posture adjustment device
JP2019504567A (en) * 2016-02-04 2019-02-14 ホアウェイ・テクノロジーズ・カンパニー・リミテッド Data transmission method and apparatus, and related device
CN107253180B (en) * 2017-01-22 2023-06-16 梅卡曼德(北京)机器人科技有限公司 Object posture adjusting device and method based on industrial robot

Patent Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH0582941U (en) * 1992-04-15 1993-11-09 セントラル硝子株式会社 Glass plate transfer device
JPH10338346A (en) * 1997-06-03 1998-12-22 Daihen Corp Position detecting device for liquid crystal glass board
EP1201612A2 (en) * 2000-10-24 2002-05-02 BOTTERO S.p.A. System for parting and handling sheets of glass
DE10155596A1 (en) * 2001-11-13 2003-07-17 Grenzebach Maschb Gmbh Device for stacking plates transported along a plate conveyor comprises a robot with a robot arm, a suction frame, and an arrangement of sensors identifying the position and orientation of each plate
CN203650529U (en) * 2013-09-18 2014-06-18 北京京东方光电科技有限公司 Manipulator
CN205187347U (en) * 2015-12-01 2016-04-27 杭州鸿福科技有限公司 Glass carries tongs
CN106395383A (en) * 2016-11-30 2017-02-15 中建材凯盛机器人(上海)有限公司 Glass stacking device and control method thereof

Also Published As

Publication number Publication date
CN109311604B (en) 2021-01-08
CN109311604A (en) 2019-02-05

Similar Documents

Publication Publication Date Title
WO2018218438A1 (en) Robot and method for adjusting robot posture
US9002516B2 (en) Calibration method for tool center point of a robot manipulator
US9399293B2 (en) Method and system for calculating weight and center of gravity of object lifted by robot
US9519736B2 (en) Data generation device for vision sensor and detection simulation system
CN107009358B (en) Single-camera-based robot disordered grabbing device and method
CN111300481A (en) Robot grabbing pose correction method based on vision and laser sensor
CN109514549A (en) A kind of online quick calibrating method of TCP and device of achievable six degree of freedom
CN108818586B (en) Object gravity center detection method suitable for automatic grabbing by manipulator
CN102768006B (en) Method for automatically measuring and adjusting large-curvature curve part in normal direction
CN111409067B (en) Automatic calibration system and calibration method for robot user coordinate system
CN106346486A (en) Six-axis cooperated robot multi-loop control system and control method thereof
CN110480642A (en) Industrial robot and its method for utilizing vision calibration user coordinate system
CN105514010A (en) Method for safely transferring silicon chips
CN109916346B (en) Workpiece flatness detection device and method based on vision system
TWI659813B (en) Monitoring system and monitoring method for machine arm
US20220203549A1 (en) Suction pad and deformation measuring device
CN105609453A (en) Semiconductor wafer transmission device
CN102847661A (en) Intelligent high-speed contactless high-accuracy glue spraying method
CN208246822U (en) A kind of 3D vision positioning robot
CN110238848B (en) Method for calculating gravity vector under robot coordinate system
US11638998B2 (en) Transfer system and transfer control method
CN111421545A (en) Liquid crystal display robot carrying system and carrying method thereof
CN110500999A (en) A kind of relative position measurement method of view-based access control model device
CN108020135A (en) A kind of plane quadrilateral size automatic measuring method
CN115533893A (en) Robot TCP calibration method using floatable standard sphere

Legal Events

Date Code Title Description
121 Ep: the epo has been informed by wipo that ep was designated in this application

Ref document number: 17911419

Country of ref document: EP

Kind code of ref document: A1

NENP Non-entry into the national phase

Ref country code: DE

122 Ep: pct application non-entry in european phase

Ref document number: 17911419

Country of ref document: EP

Kind code of ref document: A1