CN112384334B - 用于检测和校正机器人有效载荷位置的***和方法 - Google Patents
用于检测和校正机器人有效载荷位置的***和方法 Download PDFInfo
- Publication number
- CN112384334B CN112384334B CN201980044704.XA CN201980044704A CN112384334B CN 112384334 B CN112384334 B CN 112384334B CN 201980044704 A CN201980044704 A CN 201980044704A CN 112384334 B CN112384334 B CN 112384334B
- Authority
- CN
- China
- Prior art keywords
- payload
- end effector
- points
- location
- edge
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Active
Links
- 238000000034 method Methods 0.000 title claims abstract description 29
- 230000033001 locomotion Effects 0.000 claims abstract description 37
- 239000012636 effector Substances 0.000 claims description 90
- 238000004590 computer program Methods 0.000 claims description 8
- 238000003708 edge detection Methods 0.000 claims description 7
- 230000003287 optical effect Effects 0.000 claims description 6
- 238000005259 measurement Methods 0.000 claims description 2
- 239000000463 material Substances 0.000 description 17
- 230000014509 gene expression Effects 0.000 description 9
- 239000011159 matrix material Substances 0.000 description 9
- 238000003860 storage Methods 0.000 description 5
- 238000005457 optimization Methods 0.000 description 4
- 238000000354 decomposition reaction Methods 0.000 description 3
- 238000010586 diagram Methods 0.000 description 3
- 230000008569 process Effects 0.000 description 3
- 238000004422 calculation algorithm Methods 0.000 description 2
- 238000001514 detection method Methods 0.000 description 2
- 230000006870 function Effects 0.000 description 2
- 238000012986 modification Methods 0.000 description 2
- 230000004048 modification Effects 0.000 description 2
- 239000004065 semiconductor Substances 0.000 description 2
- 238000006467 substitution reaction Methods 0.000 description 2
- 230000009466 transformation Effects 0.000 description 2
- 230000009471 action Effects 0.000 description 1
- 238000004364 calculation method Methods 0.000 description 1
- 230000008859 change Effects 0.000 description 1
- 238000010276 construction Methods 0.000 description 1
- 230000001419 dependent effect Effects 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 230000018109 developmental process Effects 0.000 description 1
- 238000004519 manufacturing process Methods 0.000 description 1
- 239000013307 optical fiber Substances 0.000 description 1
- 239000002245 particle Substances 0.000 description 1
- 230000000644 propagated effect Effects 0.000 description 1
- 239000000758 substrate Substances 0.000 description 1
- 238000000844 transformation Methods 0.000 description 1
- 235000012431 wafers Nutrition 0.000 description 1
- 210000000707 wrist Anatomy 0.000 description 1
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1628—Programme controls characterised by the control loop
- B25J9/1653—Programme controls characterised by the control loop parameters identification, estimation, stiffness, accuracy, error analysis
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1694—Programme controls characterised by use of sensors other than normal servo-feedback from position, speed or acceleration sensors, perception control, multi-sensor controlled systems, sensor fusion
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1656—Programme controls characterised by programming, planning systems for manipulators
- B25J9/1664—Programme controls characterised by programming, planning systems for manipulators characterised by motion, path, trajectory planning
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1679—Programme controls characterised by the tasks executed
- B25J9/1692—Calibration of manipulator
-
- H—ELECTRICITY
- H01—ELECTRIC ELEMENTS
- H01L—SEMICONDUCTOR DEVICES NOT COVERED BY CLASS H10
- H01L21/00—Processes or apparatus adapted for the manufacture or treatment of semiconductor or solid state devices or of parts thereof
- H01L21/67—Apparatus specially adapted for handling semiconductor or electric solid state devices during manufacture or treatment thereof; Apparatus specially adapted for handling wafers during manufacture or treatment of semiconductor or electric solid state devices or components ; Apparatus not specifically provided for elsewhere
- H01L21/67005—Apparatus not specifically provided for elsewhere
- H01L21/67242—Apparatus for monitoring, sorting or marking
- H01L21/67259—Position monitoring, e.g. misposition detection or presence detection
-
- H—ELECTRICITY
- H01—ELECTRIC ELEMENTS
- H01L—SEMICONDUCTOR DEVICES NOT COVERED BY CLASS H10
- H01L21/00—Processes or apparatus adapted for the manufacture or treatment of semiconductor or solid state devices or of parts thereof
- H01L21/67—Apparatus specially adapted for handling semiconductor or electric solid state devices during manufacture or treatment thereof; Apparatus specially adapted for handling wafers during manufacture or treatment of semiconductor or electric solid state devices or components ; Apparatus not specifically provided for elsewhere
- H01L21/677—Apparatus specially adapted for handling semiconductor or electric solid state devices during manufacture or treatment thereof; Apparatus specially adapted for handling wafers during manufacture or treatment of semiconductor or electric solid state devices or components ; Apparatus not specifically provided for elsewhere for conveying, e.g. between different workstations
- H01L21/67739—Apparatus specially adapted for handling semiconductor or electric solid state devices during manufacture or treatment thereof; Apparatus specially adapted for handling wafers during manufacture or treatment of semiconductor or electric solid state devices or components ; Apparatus not specifically provided for elsewhere for conveying, e.g. between different workstations into and out of processing chamber
- H01L21/67748—Apparatus specially adapted for handling semiconductor or electric solid state devices during manufacture or treatment thereof; Apparatus specially adapted for handling wafers during manufacture or treatment of semiconductor or electric solid state devices or components ; Apparatus not specifically provided for elsewhere for conveying, e.g. between different workstations into and out of processing chamber horizontal transfer of a single workpiece
-
- H—ELECTRICITY
- H01—ELECTRIC ELEMENTS
- H01L—SEMICONDUCTOR DEVICES NOT COVERED BY CLASS H10
- H01L21/00—Processes or apparatus adapted for the manufacture or treatment of semiconductor or solid state devices or of parts thereof
- H01L21/67—Apparatus specially adapted for handling semiconductor or electric solid state devices during manufacture or treatment thereof; Apparatus specially adapted for handling wafers during manufacture or treatment of semiconductor or electric solid state devices or components ; Apparatus not specifically provided for elsewhere
- H01L21/68—Apparatus specially adapted for handling semiconductor or electric solid state devices during manufacture or treatment thereof; Apparatus specially adapted for handling wafers during manufacture or treatment of semiconductor or electric solid state devices or components ; Apparatus not specifically provided for elsewhere for positioning, orientation or alignment
- H01L21/681—Apparatus specially adapted for handling semiconductor or electric solid state devices during manufacture or treatment thereof; Apparatus specially adapted for handling wafers during manufacture or treatment of semiconductor or electric solid state devices or components ; Apparatus not specifically provided for elsewhere for positioning, orientation or alignment using optical controlling means
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B2219/00—Program-control systems
- G05B2219/30—Nc systems
- G05B2219/37—Measurements
- G05B2219/37286—Photoelectric sensor with reflection, emits and receives modulated light
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B2219/00—Program-control systems
- G05B2219/30—Nc systems
- G05B2219/37—Measurements
- G05B2219/37359—Contour, to sense corners, edges of surface
Landscapes
- Engineering & Computer Science (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Physics & Mathematics (AREA)
- Condensed Matter Physics & Semiconductors (AREA)
- General Physics & Mathematics (AREA)
- Manufacturing & Machinery (AREA)
- Computer Hardware Design (AREA)
- Microelectronics & Electronic Packaging (AREA)
- Power Engineering (AREA)
- Manipulator (AREA)
- Numerical Control (AREA)
Abstract
本文中公开了一种方法。该方法包括使有效载荷移动通过接近至少一个传感器的运动路径。检测有效载荷的边缘,以使得至少两个边缘上的至少三个点被检测到。当至少一个传感器检测到有效载荷的至少一个边缘时,捕获位置。
Description
技术领域
示例性和非限制性实施例大体上涉及一种用于确定多边形有效载荷在机器人末端执行器上的位置的***和方法,并且如果被配置成这样,则该***和方法利用该位置将有效载荷递送到指定地点。
先前发展的简要描述
针对半导体、LCD和LED产品的现有制造工艺通常利用自动化群集工具来处理呈各种类型的衬底的形式的材料。
在图1中示意性地描绘了示例群集工具10的俯视图。工具10可以由真空腔室12组成,该真空腔室具有被附接到腔室12的圆周的多个站14,诸如加载锁定件和处理模块。材料处置机器人16可以被定位于腔室中,以使材料循环通过工具10,例如从(多个)加载锁定件循环通过(多个)处理模块并且返回到(多个)加载锁定件。
材料通常放置在被集成到机器人16的末端执行器18中的焊盘集合上,并且仅通过摩擦力被固持在适当的位置。主动夹持器(是许多机器人应用中的常见解决方案)由于存在颗粒污染材料的风险而可能无法在真空群集工具10中被使用,这些颗粒由接近于材料的移动组件和与夹持动作相关联的滑动运动而引起群集。
在没有夹持器的情况下,当机器人拾取材料时,材料未在末端执行器18上机械对准,并且材料最终可能从其在机器人末端执行器上的理想标称地点移位(未对准)。为了理解材料在末端执行器上的位置是否可接受,并且如果可能的话,当机器人递送材料时校正材料的未对准,需要一种用于确定材料在机器人末端执行器上的位置、并视需要利用该位置将材料递送到指定地点的解决方案。
发明内容
以下发明内容仅旨在是示例性的。本发明内容不旨在限制权利要求书的范围。
根据一个方面,一种示例方法包括使有效载荷移动通过运动路径,该运动路径接近至少一个传感器。检测有效载荷的边缘,以使得至少两个边缘上的至少三个点被检测到。当至少一个传感器检测到有效载荷的至少一个边缘时,捕获位置。
根据另一示例,在装置中提供了示例实施例,该装置包括末端执行器、至少一个传感器和控制器。末端执行器被配置成移动有效载荷。至少一个传感器被配置成检测有效载荷的边缘。控制器包括至少一个处理器和非暂时性的至少一个存储器,该非暂时性的至少一个存储器包括计算机程序代码,至少一个存储器和计算机程序代码被配置成与至少一个处理器一起使装置执行:使有效载荷移动通过运动路径,该运动路径接近至少一个传感器;检测有效载荷的边缘,以使得至少两个边缘上的至少三个点被检测到;以及当至少一个传感器检测到有效载荷的至少一个边缘时,捕获位置。
根据另一示例,在非暂时性程序存储设备中提供了示例实施例,该非暂时性程序存储设备能够由机器读取、有形地实施可由机器执行的用于执行包括以下操作的操作的指令的程序:使有效载荷移动通过运动路径,该运动路径接近至少一个传感器;检测有效载荷的边缘,以使得至少两个边缘上的至少三个点被检测到;以及当至少一个传感器检测到有效载荷的至少一个边缘时,捕获位置。
附图说明
结合随附图式,在以下描述中解释了前述方面和其他特征,其中:
图1是群集工具的俯视图;
图2是并入了本发明的特征的群集工具的俯视图;
图3a至图3h示出了图2的群集工具的机器人的各种运动路径;
图4是示例性运动路径的图示;
图5是在有效载荷的周边上的不同点的图示;
图6是与针对有效载荷和末端执行器的优化问题相对应的图示;
图7和8图示了有效载荷和末端执行器的取向;以及
图9是图示示例方法的图。
具体实施方式
在说明书和/或附图中可以找到的以下缩写/符号定义如下:
cF、cB-方程中被用于表示有效载荷的矩形的前侧/后侧的常量
cL、cR-方程中被用于表示有效载荷的矩形的左侧/后侧的常量
Hi-豪斯霍尔德反射镜矩阵
m-针对所有边缘的数据点的数目
mF、mB-针对前/后边缘的数据点的数目
mL、mR-针对左/右边缘的数据点的数目
n1、n2-定义垂直于表示有效载荷的矩形的线的向量
radj,φadj-机器人末端执行器的调整后的目的地位置的极坐标
rEE,φEE-机器人坐标系中捕获的末端执行器位置的极坐标
rsen,φsen-机器人坐标系中的传感器地点的极坐标
rstn,φstn-机器人坐标系中的机器人站的极坐标
vi-以末端执行器坐标系表达的触发时传感器地点的向量
W、L-矩形有效载荷的宽度和长度(参见图6)
xB,yB-末端执行器坐标系中的后边缘数据点的坐标
Xp,yp-末端执行器坐标系中的有效载荷的偏移
xF,yF-末端执行器坐标系中的前边缘数据点的坐标
xi,yi-末端执行器坐标系中的向量vi的坐标
xL,yL-末端执行器坐标系中的左边缘数据点的坐标
xR,yR-末端执行器坐标系中的右边缘数据点的坐标
θp-末端执行器坐标系中的有效载荷的取向
ξEE,ηEE-机器人坐标系中捕获的末端执行器位置的笛卡尔坐标
ξsen,ηsen-机器人坐标系中的传感器地点的笛卡尔坐标
根据本发明的***和方法的各种实施例旨在解决上文要求。与现有技术的方法相反,本发明解决了这些要求,而没有附加的机械复杂性并且对工具产量的影响最小。尽管将参考附图中所示出的示例实施例来描述特征,但是应当理解,特征可以以实施例的许多替代形式来实施。另外,可以使用任何适合的大小、形状或类型的元件或材料。
在一个示例实施例中,本发明包括具有真空腔室12的群集工具100,该真空腔室具有被附接到腔室12的圆周的多个站14。具有末端执行器18的材料处置机器人16被定位于腔室中,以使材料循环通过工具100。群集工具100还包括一个或多个传感器20,该一个或多个传感器被定位于一个或多个站14附近、并且被配置成使得:当机器人从位于腔室12中的缩回位置延伸到位于站14中的延伸位置时,传感器20可以检测由机器人16携带的有效载荷22的边缘,如图2中示意性地描绘。在图2的特定示例中,示出了每个站14的两个传感器20。传感器14可以是例如光学贯穿光束传感器、光学反射传感器或能够检测有效载荷22的边缘的任何其他适合的传感器。
根据本发明的各种示例性实施例的一个特征,可以仔细地计划机器人16在缩回位置与延伸位置之间的运动路径,以使得可以通过传感器20检测到有效载荷的多个边缘。参考图3a至图3h,在图3a的缩回位置与图3h的延伸位置之间的运动路径可以是例如锯齿形,并且可以选择该形状,以使得传感器20可以检测有效载荷22的前缘24、右边缘26、左边缘28和后缘30。
例如,仍然参考图3a至图3h,可以选择从图3a的缩回位置到图3h的延伸位置的运动路径32的形状,以使得:当有效载荷22进入传感器20时,传感器20可以检测有效载荷的前缘24,如图3b中所示出;当有效载荷离开右传感器时,传感器20可以检测有效载荷的右边缘26,如图3c中所描绘;当有效载荷进入右传感器时,传感器20可以再次检测有效载荷的右边缘26,如图3d中所描绘;当有效载荷离开左传感器时,传感器20可以检测有效载荷22的左边缘28,如图3e中所描绘;当有效载荷进入左传感器时,传感器20可以再次检测有效载荷的左边缘28,如图3f中所描绘;并且当有效载荷离开传感器时,传感器20可以检测有效载荷的后缘30,如图3g中所描绘。
作为示例,通过在图3a的缩回位置与图3h的延伸位置之间设置四个经过点(viapoint),并且通过直线段连接缩回位置、经过点和延伸位置,可以获得运动路径32的期望形状,这些直线段可以被混合成单个平滑的运动路径。这种示例运动路径32的构造在图4中图示。直线段的混合可以例如通过以下方式来实现:将沿直线段的运动分解成笛卡尔坐标系中的两个正交分量,并且然后在时间上将一个分段的最后部分与下一分段的初始部分重叠并叠加。为了使从缩回位置到延伸位置的运动的持续时间最小化,因此使对产量(每小时由群集工具处理的晶片数量)的影响最小化,所生成的平滑且不间断的运动是至关重要的。
当传感器20中的任一个传感器检测到有效载荷22的边缘中的任一个边缘(检测或触发事件)时,机器人16的控制器34可以捕获机器人的末端执行器的位置,即坐标。例如通过捕获机器人的关节的位置、并且使用与机器人相关联的运动方程将机器人的关节的位置转换成末端执行器的位置,可以实现上述的情况。
在上文步骤中所获得的信息可以被用于在有效载荷的周边上构造几个点,每个点对应于一个边缘检测事件。以图3a至图3h的配置为例,可以确定有效载荷的周边上的八个不同点,如图5中所示出。在图5中,根据由图3a至图3h的图表示的边缘检测事件,对有效载荷的周边上的点进行标记。例如,图5中的点(c)对应于由图3c表示的边缘检测事件。
例如,可以例如依据被附接到机器人的末端执行器的坐标系中的两个坐标来表达有效载荷的周边上的点的地点。然后,有效载荷的周边上的点的坐标可以被用于估计有效载荷在机器人末端执行器上的位置。接下来提供用于估计有效载荷在机器人末端执行器上的位置的示例方法。
有效载荷的周边上的与边缘检测事件相对应的点可以表示如下:
vi=(xi,yi),i=1,2,...m (1a)
其中
ξi=(xsen,i-xEE,i)cos(ai)-(ysen,i-yEE,i)sin(ai),i=1,2,...,m (1b)
ηi=(xsen,i-xEE,i)sin(ai)+(ysen,i-yEE,i)cos(ai),i=1,2,...,m (1c)
在方程(1b)中,ξEE,i和ηEE,i是:当传感器检测到有效载荷的边缘时,机器人坐标系中的机器人的末端执行器的笛卡尔坐标,αEE,i是:当传感器检测到有效载荷的边缘时,机器人坐标系中的机器人的末端执行器的取向,并且ξsen,i和ηsen,i是与检测事件相关联的传感器的笛卡尔坐标,也以机器人坐标系表达。如果使用极坐标系,则可以使用以下转换从极坐标中获得方程(1b)和(1c)所需的笛卡尔坐标:
ξEE,i=rEE,isin(φEE,i),ηEE,i=rEE,icos(φEE,i),i=1,2,...,m (1d)
ξsen,i=rsen,isin(φsen,i),ηsen=rsen,icos(φsen,i),i=1,2,...,m (1e)
其中当传感器检测到有效载荷的边缘时,rEE,i和φEE,i是机器人坐标系中的机器人的末端执行器的极坐标,并且rEE,i和φEE,i是与检测事件相关联的传感器的极坐标,也以机器人坐标系表达。
如果机器人的末端执行器被机械地约束为指向径向方向,诸如在图3a至图3h的示例中,则末端执行器的取向是机器人的末端执行器的笛卡尔坐标的函数:
ai=atan(xEE,i/yEE,i) (1f)
或者,利用极坐标系,针对方程(1b)和(1c)的末端执行器的取向可以简单地获得:
ai=φEE,i (1g)
要求解的问题的一般形式可以陈述如下:将长度L和宽度W的矩形(参见图6和7)拟合到由vi(i=1、2、...、m)定义的点集合,这些点在有效载荷的边缘处被捕获。确定矩形的位置偏移xp,yp和旋转偏移θp(参见图8)。作为示例,可以使用以下方法得出解:
·确定数据点(即末端执行器的被捕获的位置)所对应的矩形的边缘(前、后、左或右)。注意,前边缘和后边缘等效于文本中早前介绍的前缘和后缘。
·用公式表示优化问题,其中目标是使数据点到对应边缘的距离最小化。
·将优化设计为最小二乘问题。
·执行豪斯霍尔德算法(householder algorithm)以获得最小二乘问题的QR分解版本。
·一次求解线性方程的结果集(通过回代变量)。
为了找到最适合数据点集合的矩形,必须确定数据点对应的边缘。作为示例,机器人可以具有基于机器人的运动和最大可能的偏移而预定义的该信息。使用该信息,可以将初始数据点转换成以下表达式:
接下来,需要构造用于优化问题的成本函数。定义表示有效载荷的矩形的线(边)的一般方程可以被写成:
前/后边缘和左/右边缘受矩形的大小约束(换句话说,前边缘与后边缘之间的距离等于W,并且左边缘与前边缘之间的距离等于L,如图6中所示出)。该约束可以由以下表达式描述:
使用方程(2)至(4),可以通过以下表达式来描述数据点与对应边缘之间的平方的距离的和:
利用方程(5)中所描述的约束,方程(6)和(7)的表达式可以被重写成:
对法向向量的幅度约束可以被添加以使解唯一。约束可以由以下表达式定义:
组合方程(6)至(10),优化问题可以以以下的公式来表示:
方程(11)的表达式可以以矩阵形式写出:
或:
方程(13)表示受约束的最小二乘问题,可以使用各种方法来对齐进行求解。作为示例,可以通过豪斯霍尔德变换通过对矩阵A执行QR分解,从而对该问题进行求解。
为了解释通过豪斯霍尔德变换的QR分解,可以将变量A、和b概括如下:
QR分解将矩阵A分解成两个矩阵Q和R。Q是具有正交列的矩阵,并且R是具有非零对角线的上三角矩阵。因此,问题可以被转换成以下方程(18)的格式。
Q·R·zopt=b (16)
Q-1·Q·R·zopt=Q-1·b (17)
让我们介绍矩阵并使它的元素与矩阵A相同:
针对i=1到n,执行以下步骤:
针对下一迭代重写/>的值 (23)
因此,获得以下矩阵:
H1,H2,...,Hn (24)
(24)的矩阵可以被用于通过以下表达式来计算R和
可以将使用方程(25)和(26)计算的值代入方程(18)中,然后可以将其写成以下扩展形式:
,针对四个未知数n1、n2、cL和cB,可以通过回代求解方程(27):
最后,在末端执行器坐标系中被表达的有效载荷的偏移可以被计算为:
θc=atan(-n1,n2) (34)
其中xc和yc是有效载荷上的参考点(例如有效载荷的中心)的坐标,并且θc是有效载荷的取向,均以末端执行器坐标系被表达。
所得信息可以被用于检测机器人末端执行器上的有效载荷的不可接受的(例如过度的)未对准,并且因此例如通过中止机器人运动来做出反应。通过在递送有效载荷时调整机器人末端执行器的位置,所得信息还可以被用于补偿有效载荷在机器人末端执行器上的未对准,以使得有效载荷不论如何未对准均被适当地递送到指定地点。
作为示例,如果机器人可以控制末端执行器的取向,则可以通过根据以下表达式调整机器人末端执行器的目的地位置,从而完全补偿有效载荷在机器人末端执行器上的未对准:
xadj=,yadj=,θadj=-θc (35)
其中xadj、yadj是笛卡尔坐标,并且θadj是机器人末端执行器在调整后的目的地位置中的取向,并且xstn和ystn是机器人站的笛卡尔坐标,均以机器人坐标系被表达。机器人末端执行器的调整后的目的地位置可以如下依据极坐标获得:
radj=,φadj=,θadj=-θc (36)
其中radj、φadj是极坐标,并且θadj是机器人末端执行器在调整后的目的地位置中的取向,并且rstn和φstn是机器人站的极坐标,均以机器人坐标系被表达。
如果机器人不能控制末端执行器的取向,例如,因为末端执行器受到机械约束以径向指向,则可以根据以下表达式通过调整机器人末端执行器的目的地位置,从而仅部分补偿有效载荷在机器人末端执行器上的未对准:
xadj=,yadj= (37)
其中xadj和yadj是在机器人坐标系中的机器人末端执行器的调整后的目的地位置的笛卡尔坐标,并且xstn和ystn是机器人坐标系中的机器人站的笛卡尔坐标。机器人末端执行器的调整后的目的地位置可以如下依据极坐标获得:
其中radj和φadj是在机器人坐标系中的机器人末端执行器的调整后的目的地位置的极坐标,并且rstn和φstn是机器人坐标系中的机器人站的极坐标。
综上所述,用于确定多边形有效载荷在机器人末端执行器上的位置和在如此被配置的情况下用于利用该位置将有效载荷递送到指定地点的方法可以包括以下步骤:
·机器人使有效载荷移动通过一个或多个传感器,该一个或多个传感器被配置成检测有效载荷的边缘。
·运动方向至少改变边缘检测事件之间的一些边缘检测事件,以使得至少两个不平行的边缘上的至少三个点被检测到。
·当任何传感器检测到有效载荷的任何边缘时,机器人控制器都会捕获(直接或间接使用可用的位置测量值)末端执行器的位置。
·机器人控制器将捕获的末端执行器位置转换成末端执行器坐标系中的有效载荷的周边上的点。
·机器人控制器估计末端执行器坐标系中的有效载荷上的参考点的地点。
·如果被配置成这样,则控制器会估计末端执行器坐标系中的有效载荷的取向。
·如果被配置成这样,则控制器会调整机器人的目的地位置(例如延伸的)位置,以将有效载荷递送到指定地点(不论有效载荷如何未对准)。
·如果被配置成这样,则控制器会调整末端执行器在机器人的目的地(例如延伸的)位置中的取向,从而以指定的取向来递送有效载荷。
应当注意,尽管基于选择的示例实施例描述了本发明,但是本发明可以在各种备选实施例中被实践。特别地,应注意以下情况:
·尽管上文示例讨论了矩形有效载荷,但是有效载荷可以具有任何多边形的形状。
·尽管上文示例每个站利用一对传感器,但可以使用一个、三个或任何适合数量的传感器。
·尽管上文示例讨论了在延伸移动期间对有效载荷地点进行估计,但是估计可以在缩回移动或任何其他移动期间被执行。
·尽管上文示例示出了基于四个经过点(方向改变)的运动路径,但是可以利用任何适合数量的经过点,包括单个经过点。
·尽管上文文本呈现了使用经过点作为用于产生运动路径的示例方法,但是可以使用用于产生运动路径的任何适合的方法。
·尽管示例计算确定了有效载荷在末端执行器上的位置,并且然后使用该信息来调整延伸位置,以将有效载荷递送到指定地点,但是可以直接确定调整后的延伸位置。
·尽管上文示例示出了机器人,其中末端执行器被约束为径向指向,但机器人可能具有铰接的末端执行器(主动控制腕关节)。
·如果机器人具有铰接的末端执行器,则末端执行器可以以平行于到站的直接路径的取向被保持,以使有效载荷旋转最小化。
·备选地,如果机器人具有铰接的末端执行器,则末端执行器可能会在运动期间旋转,以获得对有效载荷在末端执行器上的地点的最佳估计。
·尽管上文示例讨论了带有单臂和单个末端执行器的机器人,但机器人可能具有多个臂和多个末端执行器。
图9中示出了示例方法200,其包括使得有效载荷移动通过接近至少一个传感器的运动路径(参见框202);检测有效载荷的边缘,以使得至少两个边缘上的至少三个点被检测到(参见框204);并且当至少一个传感器检测到有效载荷的至少一个边缘时,捕获位置(参见框206)。
示例装置可以包括:末端执行器,被配置成移动有效载荷;至少一个传感器,被配置成检测有效载荷的边缘;以及控制器34,包括至少一个处理器36和包括计算机程序代码的至少一个非暂时性存储器38,至少一个存储器和计算机程序代码被配置成与至少一个处理器一起使装置执行以下操作:使有效载荷移动通过接近至少一个传感器的运动路径;检测有效载荷的边缘,以使得至少两个边缘上的至少三个点被检测到;以及当至少一个传感器检测到有效载荷的至少一个边缘时,捕获位置。
可以在非暂时性程序存储设备(诸如图2中所示出的存储器38)中提供示例,该非暂时性程序存储设备例如可由机器读取、有形地实施了可由机器执行的用于执行包括以下的操作的指令的程序:使有效载荷移动通过接近至少一个传感器的运动路径;检测有效载荷的边缘,以使得至少两个边缘上的至少三个点被检测到;以及当至少一个传感器检测到有效载荷的至少一个边缘时,捕获位置。
可以利用一个或多个计算机可读介质的任何组合作为存储器。计算机可读介质可以是计算机可读信号介质或计算机可读存储介质。非暂时性计算机可读存储介质不包括传播信号,并且可以是例如(但不限于)电子的、磁性的、光学的、电磁的、红外的、或半导体***、装置或设备、或前述的任何适合的组合。计算机可读存储介质的更具体的示例(非穷尽性的列表)可以包括以下:具有一根或多根电线的电气连接、便携式计算机磁盘、硬盘、随机存取存储器(RAM)、只读存储器(ROM)、可擦可编程只读存储器(EPROM或闪速存储器)、光纤、便携式光盘只读存储器(CD-ROM)、光学存储设备、磁性存储设备或前述的任何适合的组合。
应该理解,前述描述仅是说明性的。本领域的技术人员可以设计出各种备选和修改。例如,各种从属权利要求中记载的特征可以以(多个)任何适合的组合彼此被组合。另外,可以将来自上文所描述的不同实施例的特征选择性地组合成新的实施例。因此,描述旨在涵盖落入所附权利要求书的范围内的所有这种备选、修改和变化。
Claims (20)
1.一种用于检测和校正机器人有效载荷位置的方法,包括:
使所述有效载荷移动通过运动路径,所述运动路径接近至少一个传感器;
检测所述有效载荷的边缘,以使得至少两个边缘上的至少三个点被检测到;
使用所检测的至少三个点来确定所述有效载荷的位置;以及
当所述至少一个传感器检测到所述有效载荷的至少一个边缘时,捕获承载所述有效载荷的末端执行器的位置;
其中使用所检测的至少三个点来确定所述有效载荷的位置包括:将矩形的边缘拟合到所述至少三个点,确定所述矩形的位置偏移和旋转偏移,以及使用所述位置偏移和所述旋转偏移来捕获所述末端执行器的调整后的目的地位置。
2.根据权利要求1所述的方法,其中所述至少三个点位于至少两个不平行的边缘上。
3.根据权利要求1所述的方法,其中所述至少一个传感器被配置成:当运动方向在边缘检测事件之间改变时,检测所述有效载荷的所述边缘。
4.根据权利要求1所述的方法,其中所述捕获还包括:当所述至少一个传感器检测到所述有效载荷的所述至少一个边缘时,直接或间接地使用可用的位置测量值,捕获所述位置。
5.根据权利要求1所述的方法,还包括:将捕获的末端执行器位置转换成在末端执行器坐标系中的所述有效载荷的周边上的点。
6.根据权利要求5所述的方法,还包括:估计所述末端执行器坐标系中的所述有效载荷上的参考点的地点。
7.根据权利要求5所述的方法,还包括:估计所述有效载荷在所述末端执行器坐标系中的取向。
8.根据权利要求7所述的方法,还包括:调整机器人的目的地位置,以将所述有效载荷递送到指定地点。
9.根据权利要求8所述的方法,还包括:调整所述末端执行器在所述机器人的所述目的地位置中的所述取向,从而以指定的取向来递送所述有效载荷。
10.一种用于检测和校正机器人有效载荷位置的装置,包括:
末端执行器,被配置成移动所述有效载荷;
至少一个传感器,被配置成检测所述有效载荷的边缘;以及
控制器,包括至少一个处理器以及包括计算机程序代码的非暂时性的至少一个存储器,所述至少一个存储器和所述计算机程序代码被配置成与所述至少一个处理器一起使所述装置执行以下操作:
使所述有效载荷移动通过运动路径,所述运动路径接近所述至少一个传感器;
检测所述有效载荷的所述边缘,以使得至少两个边缘上的至少三个点被检测到;
使用所检测的至少三个点来确定所述有效载荷的位置;以及
当所述至少一个传感器检测到所述有效载荷的至少一个边缘时,捕获承载所述有效载荷的末端执行器的位置;
其中使得所述装置使用所检测的至少三个点来确定所述有效载荷的位置包括:将矩形的边缘拟合到所述至少三个点,确定所述矩形的位置偏移和旋转偏移,以及使用所述位置偏移和所述旋转偏移来捕获所述末端执行器的调整后的目的地位置。
11.根据权利要求10所述的装置,其中所述装置是真空腔室,所述真空腔室包括多个站,所述多个站被附接到所述真空腔室的周边。
12.根据权利要求11所述的装置,其中所述装置每个站包括两个传感器。
13.根据权利要求10所述的装置,其中所述至少一个传感器包括光学贯穿光束传感器或光学反射传感器。
14.根据权利要求10所述的装置,其中所述至少一个存储器和所述计算机程序代码被配置成与所述至少一个处理器一起使所述装置:将所捕获的末端执行器位置转换成在末端执行器坐标系中的所述有效载荷的周边上的点。
15.根据权利要求14所述的装置,其中所述至少一个存储器和所述计算机程序代码被配置成与所述至少一个处理器一起使所述装置:估计在所述末端执行器坐标系中的所述有效载荷上的参考点的地点。
16.一种非暂时性程序存储设备,能够由机器读取、有形地实施指令的程序,所述指令的程序能够由所述机器执行,以用于执行包括以下操作的操作:
使有效载荷移动通过运动路径,所述运动路径接近至少一个传感器;
检测所述有效载荷的边缘,以使得至少两个边缘上的至少三个点被检测到;
使用所检测的至少三个点来确定所述有效载荷的位置;以及
当所述至少一个传感器检测到所述有效载荷的至少一个边缘时,捕获承载所述有效载荷的末端执行器的位置;
其中使用所检测的至少三个点来确定所述有效载荷的位置包括:将矩形的边缘拟合到所述至少三个点,确定所述矩形的位置偏移和旋转偏移,以及使用所述位置偏移和所述旋转偏移来捕获所述末端执行器的调整后的目的地位置。
17.根据权利要求16所述的非暂时性程序存储设备,还包括能够由所述机器执行以用于执行以下操作的指令的程序,所述操作包括:将所捕获的末端执行器位置转换成在末端执行器坐标系中的所述有效载荷的周边上的点。
18.根据权利要求17所述的非暂时性程序存储设备,还包括能够由所述机器执行以用于执行以下操作的指令的程序,所述操作包括:估计在所述末端执行器坐标系中的所述有效载荷上的参考点的地点。
19.根据权利要求17所述的非暂时性程序存储设备,还包括能够由所述机器执行以用于执行以下操作的指令的程序,所述操作包括:估计所述有效载荷在所述末端执行器坐标系中的取向。
20.根据权利要求19所述的非暂时性程序存储设备,还包括能够由所述机器执行以用于执行以下操作的指令的程序,所述操作包括:调整机器人的目的地位置,以将所述有效载荷递送到指定地点。
Applications Claiming Priority (3)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
US201862693673P | 2018-07-03 | 2018-07-03 | |
US62/693,673 | 2018-07-03 | ||
PCT/US2019/039723 WO2020009919A1 (en) | 2018-07-03 | 2019-06-28 | System and method for detection and correction of robot payload position |
Publications (2)
Publication Number | Publication Date |
---|---|
CN112384334A CN112384334A (zh) | 2021-02-19 |
CN112384334B true CN112384334B (zh) | 2024-05-28 |
Family
ID=69059817
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201980044704.XA Active CN112384334B (zh) | 2018-07-03 | 2019-06-28 | 用于检测和校正机器人有效载荷位置的***和方法 |
Country Status (5)
Country | Link |
---|---|
US (1) | US11633854B2 (zh) |
JP (1) | JP7455800B2 (zh) |
KR (1) | KR20210027455A (zh) |
CN (1) | CN112384334B (zh) |
WO (1) | WO2020009919A1 (zh) |
Families Citing this family (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US11523145B2 (en) * | 2021-01-04 | 2022-12-06 | Western Digital Technologies, Inc. | Data storage device and method for real-time data locking in surveillance storage |
DE102022119202A1 (de) | 2022-08-01 | 2024-02-01 | Schaeffler Technologies AG & Co. KG | Verfahren und System zur Koordination kollaborativer Roboter mit Nutzlast-/Ladungs-/Prioritätsbewusstsein sowie kollaborativer Roboter |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101681863A (zh) * | 2007-02-28 | 2010-03-24 | 株式会社爱发科 | 基板传送装置 |
CN103917337A (zh) * | 2011-09-16 | 2014-07-09 | 柿子技术公司 | 低多变性机器人 |
CN104828553A (zh) * | 2010-12-15 | 2015-08-12 | 西姆伯蒂克有限责任公司 | 机器人有效载荷调整和感测 |
CN107107336A (zh) * | 2014-11-18 | 2017-08-29 | 柿子技术公司 | 具有末端执行器位置估计的机器人自适应放置*** |
Family Cites Families (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US6195619B1 (en) * | 1999-07-28 | 2001-02-27 | Brooks Automation, Inc. | System for aligning rectangular wafers |
US6629053B1 (en) * | 1999-11-22 | 2003-09-30 | Lam Research Corporation | Method and apparatus for determining substrate offset using optimization techniques |
JP2003264214A (ja) * | 2002-03-07 | 2003-09-19 | Hitachi High-Technologies Corp | 真空処理装置及び真空処理方法 |
US7572092B2 (en) * | 2002-10-07 | 2009-08-11 | Brooks Automation, Inc. | Substrate alignment system |
US8634633B2 (en) * | 2003-11-10 | 2014-01-21 | Brooks Automation, Inc. | Wafer center finding with kalman filter |
US9187244B2 (en) | 2010-12-15 | 2015-11-17 | Symbotic, LLC | BOT payload alignment and sensing |
US9196518B1 (en) | 2013-03-15 | 2015-11-24 | Persimmon Technologies, Corp. | Adaptive placement system and method |
WO2014197537A1 (en) * | 2013-06-05 | 2014-12-11 | Persimmon Technologies, Corp. | Robot and adaptive placement system and method |
JP6574715B2 (ja) * | 2016-02-01 | 2019-09-11 | 東京エレクトロン株式会社 | 基板搬送方法及び基板処理システム |
-
2019
- 2019-06-28 US US16/455,909 patent/US11633854B2/en active Active
- 2019-06-28 JP JP2021500129A patent/JP7455800B2/ja active Active
- 2019-06-28 CN CN201980044704.XA patent/CN112384334B/zh active Active
- 2019-06-28 KR KR1020217003375A patent/KR20210027455A/ko unknown
- 2019-06-28 WO PCT/US2019/039723 patent/WO2020009919A1/en active Application Filing
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101681863A (zh) * | 2007-02-28 | 2010-03-24 | 株式会社爱发科 | 基板传送装置 |
CN104828553A (zh) * | 2010-12-15 | 2015-08-12 | 西姆伯蒂克有限责任公司 | 机器人有效载荷调整和感测 |
CN103917337A (zh) * | 2011-09-16 | 2014-07-09 | 柿子技术公司 | 低多变性机器人 |
CN107107336A (zh) * | 2014-11-18 | 2017-08-29 | 柿子技术公司 | 具有末端执行器位置估计的机器人自适应放置*** |
Also Published As
Publication number | Publication date |
---|---|
JP7455800B2 (ja) | 2024-03-26 |
CN112384334A (zh) | 2021-02-19 |
US11633854B2 (en) | 2023-04-25 |
US20200009727A1 (en) | 2020-01-09 |
WO2020009919A1 (en) | 2020-01-09 |
KR20210027455A (ko) | 2021-03-10 |
JP2021530366A (ja) | 2021-11-11 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US11241796B2 (en) | Robot system and method for controlling robot system | |
US20150258688A1 (en) | Robot system, calibration method in robot system, and position correcting method in robot system | |
US6856863B1 (en) | Method and apparatus for automatic calibration of robots | |
US9330951B2 (en) | Robot and adaptive placement system and method | |
US9102063B2 (en) | Robot apparatus | |
US8459922B2 (en) | Manipulator auto-teach and position correction system | |
CN112384334B (zh) | 用于检测和校正机器人有效载荷位置的***和方法 | |
US10020216B1 (en) | Robot diagnosing method | |
JP2017035754A (ja) | 視覚センサおよび複数のロボットを備えるロボットシステム | |
CN110621447B (zh) | 机器人传送器校准方法、机器人***以及控制*** | |
EP3157715A1 (en) | Method for calibrating a robot and a robot system | |
JP2010162635A (ja) | 自走式ロボットの位置および姿勢の補正方法 | |
WO2016125752A1 (ja) | 基板搬送ロボットおよび基板搬送方法 | |
US20170326733A1 (en) | Sensor based auto-calibration wafer | |
CN114952898A (zh) | 机器人***、设备制造装置、设备制造方法、教学位置调整方法及计算机可读取记录介质 | |
JPH1158273A (ja) | 移動ロボット装置 | |
US11161239B2 (en) | Work robot system and work robot | |
CN113560942B (zh) | 机床的工件取放控制装置及其控制方法 | |
CN110153993B (zh) | 工业用机器人的修正值计算方法 | |
JPH11231933A (ja) | 移動体の停止位置ズレ量検出装置及び無人搬送車 | |
KR102341754B1 (ko) | 로봇의 진단 방법 | |
TW202221439A (zh) | 機器人系統及滑動判定方法 | |
CN117813182A (zh) | 机器人控制设备、机器人控制***和机器人控制方法 | |
CN117769483A (zh) | 机器人控制设备、机器人控制***以及机器人控制方法 | |
JPH0635530A (ja) | 位置補正演算装置 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |