CN105329642B - 基板位置偏移检测及校正方法和基板搬运***的控制方法 - Google Patents
基板位置偏移检测及校正方法和基板搬运***的控制方法 Download PDFInfo
- Publication number
- CN105329642B CN105329642B CN201510761073.7A CN201510761073A CN105329642B CN 105329642 B CN105329642 B CN 105329642B CN 201510761073 A CN201510761073 A CN 201510761073A CN 105329642 B CN105329642 B CN 105329642B
- Authority
- CN
- China
- Prior art keywords
- substrate
- proximity sensor
- distance
- noncontacting proximity
- end effector
- 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
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B65—CONVEYING; PACKING; STORING; HANDLING THIN OR FILAMENTARY MATERIAL
- B65G—TRANSPORT OR STORAGE DEVICES, e.g. CONVEYORS FOR LOADING OR TIPPING, SHOP CONVEYOR SYSTEMS OR PNEUMATIC TUBE CONVEYORS
- B65G43/00—Control devices, e.g. for safety, warning or fault-correcting
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B65—CONVEYING; PACKING; STORING; HANDLING THIN OR FILAMENTARY MATERIAL
- B65G—TRANSPORT OR STORAGE DEVICES, e.g. CONVEYORS FOR LOADING OR TIPPING, SHOP CONVEYOR SYSTEMS OR PNEUMATIC TUBE CONVEYORS
- B65G47/00—Article or material-handling devices associated with conveyors; Methods employing such devices
- B65G47/22—Devices influencing the relative position or the attitude of articles during transit by conveyors
-
- 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/67703—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 between different workstations
Landscapes
- Engineering & Computer Science (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)
- Container, Conveyance, Adherence, Positioning, Of Wafer (AREA)
- Manipulator (AREA)
Abstract
本发明公开了一种基板位置偏移检测及校正方法和基板搬运***的控制方法,用以提高搬运效率,上述检测及校正方法包括当基板搬运***内的末端执行器按照预设的第一移动指令向待搬运基板移动且未与待搬运基板接触时,第一非接触式传感器和第二非接触式传感器实时采集待搬运基板的第一边缘的信息,并判断第一非接触式传感器和第二非接触式传感器是否同时采集到第一边缘的信息,若非同时,根据两个非接触式传感器分别检测到第一边缘后反馈的信号的时间差计算得到第一边缘与两个非接触式传感器连线之间的夹角值,并根据夹角值控制机器人本体绕其轴线旋转。另外上述检测及校正方法还包括根据第三非接触式传感器检测的结果控制末端执行器移动量。
Description
技术领域
本发明涉及显示装置制备技术领域,特别是涉及一种基板位置偏移检测及校正方法和基板搬运***的控制方法。
背景技术
在基板类产品,如玻璃、液晶面板、半导体晶圆等的生产过程中,基板通常被放置在用于生产设备操作的容器中,按照不同生产工序的要求,基板会在不同的生产设备之间进行转运,这种转运工作通常是由搬运***来完成的。
在生产和运输过程中,因为设备振动或操作不当等原因,基板在容器中可能会出现不同程度的位置偏移,这样采用搬运***将基板从容器内移出时,基板在搬运***的末端执行器上的位置会发生偏移,如果不及时校正,会造成产品质量不良甚至基板或设备损坏等严重后果。
但是,现有技术中的检测和校正方法中,无法实现实时检测并校正,需要将基板拾取后才能判断其是否有偏移,若有偏移,需要调整末端执行器的移动量,重新抓取基板,校正过程较麻烦,大大降低了搬运效率和生产效率。
发明内容
本发明的目的是提供基板位置偏移检测及校正方法和基板搬运***的控制方法,用以提高搬运效率和生产效率。
为达到上述目的,本发明提供了如下技术方案:
本发明提供了一种基板位置偏移检测及校正方法,包括:
当基板搬运***内的末端执行器按照预设的第一移动指令向待搬运基板移动且未与待搬运基板接触时,第一非接触式传感器和第二非接触式传感器实时采集待搬运基板的第一边缘的信息,其中:第一非接触式传感器和第二非接触式传感器与机器人本体之间的距离相等,所述第一非接触式传感器和所述第二非接触式传感器之间具有设定距离;
当第一非接触式传感器和第二非接触式传感器均检测到待搬运基板的第一边缘的信息时,控制所述末端执行器停止运动,并判断所述第一非接触式传感器和第二非接触式传感器是否同时采集到第一边缘的信息,若所述第一非接触式传感器和第二非接触式传感器非同时采集到第一边缘的信息时,根据所述第一非接触式传感器和所述第二非接触式传感器分别检测到所述第一边缘后反馈的信号的时间差、以及预设的末端执行器的移动速度、所述第一非接触式传感器和所述第二非接触式传感器之间的设定距离,得到所述待搬运基板的第一边缘与所述第一非接触式传感器和第二非接触式传感器的连线之间的夹角值,并根据所述夹角值控制所述基板搬运***的机器人本体绕其轴线旋转。
本发明提供的基板位置偏移检测及校正方法,在搬运基板前就可以预先检测到基板是否有偏移,并可以在搬运过程中校正偏移量,具体的:当基板搬运***内的末端执行器按照预设的第一移动指令向待搬运基板移动且未与待搬运基板接触时,第一非接触式传感器和第二非接触式传感器实时采集待搬运基板的第一边缘的信息;当第一非接触式传感器和第二非接触式传感器均检测到待搬运基板的第一边缘的信息时,控制所述末端执行器停止运动,并判断第一非接触式传感器和第二非接触式传感器是否同时采集到第一边缘的信息,若第一非接触式传感器和第二非接触式传感器非同时采集到第一边缘的信息时,则根据第一非接触式传感器和第二非接触式传感器分别检测到第一边缘后反馈的信号的时间差、以及预设的末端执行器的移动速度、第一非接触式传感器和第二非接触式传感器之间的设定距离,得到待搬运基板的第一边缘与第一非接触式传感器和第二非接触式传感器的连线之间的夹角值,并根据夹角值控制基板搬运***的机器人本体绕其轴线旋转。
可见,本发明提供的基板位置偏移检测及校正方法,可以实时检测和校正基板的位置,提高基板的搬运效率和生产效率。
在一些可选的实施方式中,上述基板位置偏移检测及校正方法还包括:
当所述夹角值大于预设的角度参考值时,产生告警信号和/或控制所述基板搬运***停止工作。避免旋转末端执行器时,末端执行器与装基板的容器发生碰撞。
在一些可选的实施方式中,上述基板位置偏移检测及校正方法还包括:
根据所述夹角值控制所述基板搬运***的机器人本体绕其轴线旋转后,控制所述末端执行器继续向待搬运基板移动,当第一非接触式传感器和第二非接触式传感器同时检测到待搬运基板的第一边缘的信息时,控制所述末端执行器再次停止运动,并拾取所述待搬运基板,且控制所述机器人本体带动其上的待搬运基板绕其轴线旋转至初始角度。
在一些可选的实施方式中,上述基板位置偏移检测及校正方法还包括:
当第一距离大于第二距离时,根据所述第一距离和所述第二距离的差值调整预设的第二移动指令,并根据调整后的第二移动指令控制所述末端执行器带动其上的待搬运基板向所述机器人本体移动;
当第一距离小于第二距离时,根据所述第一距离和所述第二距离的差值调整预设的第二移动指令,并根据调整后的第二移动指令控制所述末端执行器带动其上的待搬运基板向所述机器人本体移动,或根据所述第一距离和第二距离的差值控制所述末端执行器移动至预设停止位置,并根据预设的第二移动指令控制所述末端执行器带动其上的待搬运基板向所述机器人本体移动,其中:所述第一距离为所述机器人本体带动其上的待搬运基板绕其轴线旋转至初始角度后、所述末端执行器的实际停止位置与所述机器人本体之间的距离,所述第二距离为所述末端执行器的预设停止位置与所述机器人本体之间的距离,所述预设停止位置为末端执行器按照所述预设的第一移动指令移动后的停止位置。
在一些可选的实施方式中,上述基板位置偏移检测及校正方法还包括:
若所述第一非接触式传感器和第二非接触式传感器为同时采集到第一边缘的信息时,拾取所述待搬运基板。
在一些可选的实施方式中,上述基板位置偏移检测及校正方法还包括:
当第三距离大于第二距离时,根据所述第三距离和所述第二距离的差值调整预设的第二移动指令,并根据调整后的第二移动指令控制所述末端执行器带动其上的待搬运基板向所述机器人本体移动;
当第三距离小于第二距离时,根据所述第三距离和所述第二距离的差值调整预设的第二移动指令,并根据调整后的第二移动指令控制所述末端执行器带动其上的待搬运基板向所述机器人本体移动,或根据所述第三距离和第二距离的差值控制所述末端执行器移动至预设停止位置,并根据预设的第二移动指令控制所述末端执行器带动其上的待搬运基板向所述机器人本体移动,其中:所述第三距离为所述第一非接触传感器和所述第二非接触传感器同时采集到第一边缘的信息时、末端执行器的实际停止位置与所述机器人本体之间的距离,所述第二距离为所述末端执行器的预设停止位置与所述机器人本体之间的距离,所述预设停止位置为末端执行器按照所述预设的第一移动指令移动后的停止位置。
在一些可选的实施方式中,上述基板位置偏移检测及校正方法还包括:
当所述末端执行器带动其上的待搬运基板向所述机器人本体移动时,位于所述机器人本体上的第三非接触式传感器检测所述待搬运基板的第二边缘与所述第三非接触式传感器的中点之间的第四距离信息,其中:所述第一边缘和所述第二边缘垂直设置;
根据所述第四距离信息调整预先设定的、用于控制所述末端执行器沿水平轴的延伸方向移动的距离的第三移动指令。使得搬运***可以将基板搬运到设定的位置处。
在一些可选的实施方式中,所述根据所述第一非接触式传感器和所述第二非接触式传感器反馈的信号的时间差、以及预设的末端执行器的移动速度、所述第一非接触式传感器和所述第二非接触式传感器之间的设定距离,得到所述待搬运基板的第一边缘与所述第一非接触式传感器和第二非接触式传感器的连线之间的夹角值具体包括:
根据公式a=arctan(v×T/L),得到所述夹角值,其中:a为夹角,v为所述预设的末端执行器的移动速度,T为所述时间差,L为所述第一非接触式传感器和第二非接触式传感器之间的设定距离。
本发明还提供了一种基板搬运***的控制方法,包括:上述任一项所述的基板位置偏移检测及校正方法,可以提高搬运效率和生产效率。
附图说明
图1为本发明实施例提供的基板位置偏移检测及校正方法的流程图;
图2a~2d为基板的偏移示意图;
图3为本发明实施例提供的基板位置偏移检测及校正方法的另一种流程图;
图4为本发明实施例提供的基板位置偏移检测及校正装置的结构示意图。
附图标记:
1-待搬运基板 11-第一边缘
12-第二边缘 21-第一非接触式传感器
22-第二非接触式传感器 23-第三非接触式传感器
3-连线 4-水平轴
5-机器人本体 6-末端执行器
7-控制器 8-报警装置
9-预设位置线
具体实施方式
下面将结合本发明实施例中的附图,对本发明实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例仅仅是本发明一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都属于本发明专利保护的范围。
需要说明的是:下述提到的预设的第一移动指令、第二移动指令和第三移动指令为:操作人员在基板被移动前,输送给基板搬运***的控制指令,其中预先设定的第一移动指令用于控制末端执行器向待搬运基板移动的距离,预先设定的第二移动指令用于控制末端执行器带动其上的待搬运基板向机器人本体移动的距离,预先设定的第三移动指令用于控制末端执行器沿水平轴的延伸方向移动的距离。
如图1和图2a~2d所示,其中:图1为本发明实施例提供的基板位置偏移检测及校正方法的流程图,图2a~2d为基板的偏移示意图;
本发明提供了一种基板位置偏移检测及校正方法,包括:
步骤S101:当基板搬运***内的末端执行器6按照预设的第一移动指令向待搬运基板1移动且未与待搬运基板1接触时,第一非接触式传感器21和第二非接触式传感器22实时采集待搬运基板1的第一边缘11的信息,其中:第一非接触式传感器21和第二非接触式传感器22的与机器人本体5之间的距离相等,第一非接触式传感器21和第二非接触式传感器22之间具有设定距离L;
步骤S102:当第一非接触式传感器21和第二非接触式传感器22均检测到待搬运基板1的第一边缘11的信息时,控制末端执行器6停止运动,并判断第一非接触式传感器21和第二非接触式传感器22是否同时采集到第一边缘11的信息,一种情况下:若第一非接触式传感器21和第二非接触式传感器22非同时采集到第一边缘11的信息时,根据两个非接触式传感器(第一非接触式传感器21和第二非接触式传感器22)分别检测到第一边缘11后反馈的信号的时间差、以及预设的末端执行器的移动速度、第一非接触式传感器21和第二非接触式传感器22之间的设定距离L,计算得到待搬运基板1的第一边缘11与两个非接触式传感器(第一非接触式传感器21和第二非接触式传感器22)的连线3之间的夹角值,并根据夹角值控制机器人本体绕其轴线旋转。上述夹角如图2a中的角a。
本发明提供的基板位置偏移检测及校正方法,在搬运基板前就可以预先检测到待搬运基板1是否有偏移,并可以在搬运过程中校正偏移量,具体的:当基板搬运***内的末端执行器按照预设的第一移动指令向待搬运基板1移动且未与待搬运基板1接触时,第一非接触式传感器21和第二非接触式传感器22实时采集待搬运基板1的第一边缘11的信息;当第一非接触式传感器21和第二非接触式传感器22均检测到待搬运基板1的第一边缘11的信息时,控制末端执行器6停止运动,并判断第一非接触式传感器21和第二非接触式传感器22是否同时采集到第一边缘11的信息,若第一非接触式传感器21和第二非接触式传感器22非同时采集到第一边缘11的信息时,根据第一非接触式传感器21和第二非接触式传感器22分别检测到第一边缘11后反馈的信号的时间差、以及预设的末端执行器的移动速度、第一非接触式传感器21和第二非接触式传感器22之间的设定距离L,得到待搬运基板1的第一边缘11与第一非接触式传感器21和第二非接触式传感器22的连线3之间的夹角值a,并根据夹角值a控制机器人本体5绕其轴线旋转a角度。
可见,本发明提供的基板位置偏移检测及校正方法,可以实时检测和校正基板的位置,提高基板的搬运效率和生产效率。
另外,本发明提供的基板位置偏移检测及校正方法,可以提高搬运精度和效率。
进一步的,上述基板位置偏移检测及校正方法还包括:
当夹角值大于预设的角度参考值时,产生告警信号和/或控制基板搬运***停止工作。避免末端执行器旋转时,末端执行器与装基板的容器发生碰撞。
更进一步的,上述基板位置偏移检测及校正方法还包括:
根据夹角值控制基板搬运***的机器人本体绕其轴线旋转后,控制末端执行器6继续向待搬运基板1移动,当第一非接触式传感器21和第二非接触式传感器22同时检测到待搬运基板的第一边缘的信息时,控制末端执行器6再次停止运动,并拾取待搬运基板1,且控制机器人本体带动其上的待搬运基板1绕其轴线旋转至初始角度。
上述基板位置偏移检测及校正方法还包括:
当第一距离大于第二距离时,根据第一距离和第二距离的差值调整预设的第二移动指令,并根据调整后的第二移动指令控制末端执行器6带动其上的待搬运基板1向机器人本体5移动;
当第一距离小于第二距离时,根据第一距离和第二距离的差值调整预设的第二移动指令,并根据调整后的第二移动指令控制末端执行器6带动其上的待搬运基板1向机器人本体5移动,或根据第一距离和第二距离的差值控制末端执行器6移动至预设停止位置,并根据预设的第二移动指令控制末端执行器6带动其上的待搬运基板1向机器人本体5移动;
需要说明的是:其中:第一距离为机器人本体带动其上的待搬运基板绕其轴线旋转至初始角度后、末端执行器的实际停止位置与机器人本体之间的距离,第二距离为末端执行器按照的预设停止位置与机器人本体之间的距离,预设停止位置为末端执行器按照预设的第一移动指令移动后的停止位置。
另一种情况下,当基板搬运***内的末端执行器6向待搬运基板1移动且未与待搬运基板1接触时,第一非接触式传感器21和第二非接触式传感器22实时采集待搬运基板1的第一边缘11的信息,其中:第一非接触式传感器21和第二非接触式传感器22的与机器人本体5之间的距离相等,第一非接触式传感器21和第二非接触式传感器22之间具有设定距离L;
当第一非接触式传感器21和第二非接触式传感器22均检测到待搬运基板1的第一边缘11的信息时,控制末端执行器6停止运动,并判断第一非接触式传感器21和第二非接触式传感器22是否同时采集到第一边缘11的信息,若所述第一非接触式传感器21和第二非接触式传感器22为同时采集到第一边缘的信息时,拾取所述待搬运基板。
进一步的,如图2b和图2c所示,上述基板位置偏移检测及校正方法还包括:
需要说明的是:其中:第三距离为第一非接触传感器和第二非接触传感器同时采集到第一边缘的信息时、末端执行器6的实际停止位置与机器人本体之间的距离,第二距离为末端执行器的预设停止位置与机器人本体之间的距离,预设停止位置为末端执行器按照预设的第一移动指令移动后的停止位置;
如图2b,待搬运基板1的第一边缘11与预设位置线9之间具有距离H1,其中H1产生的原因是:末端执行器在按照预设的第一指令开始移动到拾取待搬运基板过程中,末端执行器先按照预设的第一指令移动至预设停止位置(即末端执行器移动至预设停止位置),此时第一非接触式传感器21和第二非接触传感器22均未采集到待搬运基板1的第一边缘11的信息;为此末端执行器6将继续向待搬运基板1的方向移动,直至第一非接触传感器21和第二非接触传感器22均采集到第一边缘11的信息时,末端执行器6将停止运动(即末端执行器移动至实际停止位置),并拾取待搬运基板1,因此末端执行器的实际停止位置与预设停止位置之间将产生差值,即为H1(H1是由于第三距离大于第二距离产生的),本发明提供的基板位置偏移检测及校正方法中,将根据H1(第三距离和第二距离的差值)调整预设的第二移动指令,并根据调整后的第二移动指令控制末端执行器6带动其上的待搬运基板1向机器人本体移动;
如图2c中,待搬运基板1的第一边缘11与预设位置线9之间具有距离H2,其中H2产生的原因是:末端执行器在按照预设的第一指令开始移动到拾取待搬运基板过程中,第一非接触式传感器21和第二非接触传感器22均采集到待搬运基板1的第一边缘11的信息,此时末端执行器6将停止运动(即末端执行器移动至实际停止位置),并拾取待搬运基板1,而在末端执行器停止时,末端执行器6还未按照预设的第一移动指令移动完成(即末端执行器还未移动到预设停止位置时,末端执行器已停止运动),因此末端执行器的实际停止位置与预设停止位置之间将产生差值,即为H2(H2是由于第三距离小于第二距离产生的),本发明提供的基板位置偏移检测及校正方法中,将根据H2(第三距离和第二距离)的差值调整预设的第二移动指令,并根据调整后的第二移动指令控制末端执行器带动其上的待搬运基板向机器人本体移动,或根据H2(第三距离和第二距离)的差值控制末端执行器移动至预设停止位置,并根据预设的第二移动指令控制末端执行器带动其上的待搬运基板向机器人本体移动。
上述任一情况下,如图2d所示,当待搬运基板1存在如图2d所示的偏移量w时,更进一步的,上述基板位置偏移检测及校正方法还包括:
当末端执行器带动其上的待搬运基板向机器人本体移动时,位于机器人本体上的第三非接触式传感器检测待搬运基板的第二边缘12与第三非接触式传感器23的中点之间的第四距离信息(w),第三非接触式传感器23的中点在末端执行器6上的投影位于待搬运基板1的预设停止区域(即标准位置)的第二边缘12上,其中:第一边缘11和第二边缘12垂直设置;
根据第四距离信息调整预先设定的、用于控制末端执行器沿水平轴的延伸方向移动的距离的第三移动指令。根据第三非接触式传感器检测的结果,控制末端执行器沿水平轴的延伸方向移动的量,使得搬运***可以将基板搬运到设定的位置处。
上述控制末端执行器沿水平轴的延伸方向移动具体的:可以通过控制用于驱动末端执行器移动的第一驱动装置,以实现末端执行器的移动,也可以通过控制驱动机器人本体移动的第二驱动装置,以实现通过机器人本体移动进而带动末端执行器的移动。
上述步骤S102中:根据第一非接触式传感器和第二非接触式传感器反馈的信号的时间差、以及预设的末端执行器的移动速度、第一非接触式传感器和第二非接触式传感器之间的设定距离,得到待搬运基板的第一边缘与第一非接触式传感器和第二非接触式传感器的连线3之间的夹角值具体包括:
根据公式a=arctan(v×T/L),得到夹角值,其中:a为夹角,v为预设的末端执行器的移动速度,T为时间差,L为第一非接触式传感器和第二非接触式传感器之间的设定距离。
如图3所示,图3为本发明实施例提供的基板位置偏移检测及校正方法另一种流程图。本发明提供的基板位置偏移检测及校正方法,具体的:
本发明提供的基板位置偏移检测及校正方法,具体的:
步骤A:
步骤SA401:基板搬运工作开始;
步骤SA402:机器人本体移动至预定位置,末端执行器按照预设的第一移动指令向待搬运基板移动;
步骤SA403:当基板搬运***内的末端执行器按照预设的第一移动指令向待搬运基板移动且未与待搬运基板接触时,第一非接触式传感器和第二非接触式传感器实时采集待搬运基板的第一边缘的信息,当第一非接触式传感器和第二非接触式传感器均检测到待搬运基板的第一边缘的信息时,控制器控制末端执行器停止运动;
步骤SA404:控制器判断第一非接触式传感器和第二非接触式传感器是否同时采集到第一边缘的信息;若不同时,则执行步骤SA405,若同时则执行SA411;
步骤SA405:控制器根据第一非接触式传感器和第二非接触式传感器反馈的信号的时间差,以及预设的末端执行器的移动速度、第一非接触式传感器和第二非接触式传感器之间的设定距离,得到待搬运基板的第一边缘与第一非接触式传感器和第二非接触式传感器的连线3之间的夹角值a;
步骤SA406:判断旋转偏移程度是否在干涉允许范围之内,控制器将夹角a与预先设定的角度参考值θ0进行比较,如果实际偏移角度a>θ0,则说明基板的偏移程度超出了干涉允许的范围,执行步骤SA407,如果偏移角度a<θ0,则执行步骤SA408;
步骤SA407:控制器终止本次基板搬运动作,并发出报警信号,等待操作人员排查故障;
步骤SA408:根据夹角值a控制基板搬运***的机器人本体绕其轴线旋转,控制末端执行器继续向待搬运基板移动,当第一非接触式传感器和第二非接触式传感器同时检测到待搬运基板的第一边缘的信息时,控制末端执行器再次停止运动,并拾取待搬运基板,且控制机器人本体带动其上的待搬运基板绕其自身轴旋转补偿角度-a,回到初始角度;
步骤SA409:机器人的控制器判断基板是否存在沿末端执行器的伸缩方向的移动偏移,如果存在该偏移,则执行步骤SA410,如果不存在该偏移,则执行步骤SB;
步骤SA410:根据第一距离和第二距离的差值调整预设的第二移动指令,之后执行步骤SB;
步骤SA411:拾取待搬运基板;
步骤SA412:机器人的控制器判断基板是否存在沿末端执行器的伸缩方向的移动偏移,如果存在该偏移,则执行步骤SA413,如果不存在该偏移,则执行步骤SB;
步骤SA413:根据第三距离和第二距离的差值调整预设的第二移动指令,之后执行步骤SB;
步骤SB:
步骤SB401:第三非接触式传感器装置检测待搬运基板的第二边缘12,检测第二边缘12与第三非接触式传感器的中点之间的第四距离信息w,并将信号传回至控制器。
步骤SB402:根据第四距离判断待搬运基板是否存在沿水平轴延伸方向的移动偏移,如果存在该偏移,执行步骤SB403,如果不存在偏移,执行步骤SB404;
步骤SB403:调整末端执行器沿水平轴的延伸方向移动的距离的第三移动指令;
步骤SB404:机器人本体移动到放置基板的待放置区域;
步骤SB405:机器人末端执行器放置基板;
步骤SB406:基板搬运结束。
至此,整个基板搬运过程结束,搬运机器人在取放基板的过程中,完成了对基板位置偏移的检测和校正。
本发明还提供了一种基板搬运***的控制方法,包括:上述任一项所述的基板位置偏移检测及校正方法,可以提高搬运效率和生产效率。
基于同一发明构思,本发明还提供了一种基板位置偏移检测及校正装置,如图4所示,图4为本发明实施例提供的基板位置偏移检测及校正装置的结构示意图;本发明提供的基板位置偏移检测及校正装置,包括:
设置于末端执行器6上的第一非接触式传感器21和第二非接触式传感器22,当基板搬运***内的末端执行器6按照预设的第一移动指令向待搬运基板1移动且未与待搬运基板1接触时,第一非接触式传感器21和第二非接触式传感器22用于实时采集待搬运基板1的第一边缘11的信息,其中:第一非接触式传感器21和第二非接触式传感器22与机器人本体5之间的距离相等,第一非接触式传感器21和第二非接触式传感器22之间具有设定距离L;
控制器7,用于当第一非接触式传感器21和第二非接触式传感器22均检测到待搬运基板1的第一边缘11的信息时,控制末端执行器6停止运动,并判断第一非接触式传感器21和第二非接触式传感器22是否同时采集到第一边缘11的信息,一种情况下:若第一非接触式传感器21和第二非接触式传感器22非同时采集到第一边缘11的信息时,根据第一非接触式传感器21和第二非接触式传感器22分别检测到第一边缘11后反馈的信号的时间差、以及预设的末端执行器的移动速度、第一非接触式传感器21和第二非接触式传感器22之间的设定距离L,得到待搬运基板1的第一边缘11与第一非接触式传感器21和第二非接触式传感器22的连线3之间的夹角值,并根据夹角值控制机器人本体绕其轴线旋转。上述夹角如图2a中的角a。
本发明提供的基板位置偏移检测及校正装置,在搬运基板前就可以预先检测到待搬运基板1是否有偏移,并可以在搬运过程中校正偏移量,具体的:当基板搬运***内的末端执行器按照预设的第一移动指令向待搬运基板1移动且未与待搬运基板1接触时,第一非接触式传感器21和第二非接触式传感器22实时采集待搬运基板1的第一边缘11的信息;当第一非接触式传感器21和第二非接触式传感器22均检测到待搬运基板1的第一边缘11的信息时,控制末端执行器6停止运动,并判断第一非接触式传感器21和第二非接触式传感器22是否同时采集到第一边缘11的信息,若第一非接触式传感器21和第二非接触式传感器22非同时采集到第一边缘11的信息时,根据第一非接触式传感器21和第二非接触式传感器22分别检测到第一边缘11后反馈的信号的时间差、以及预设的末端执行器的移动速度、第一非接触式传感器21和第二非接触式传感器22之间的设定距离L,得到待搬运基板1的第一边缘11与第一非接触式传感器21和第二非接触式传感器22的连线3之间的夹角值,并根据夹角值控制机器人本体5绕其轴线旋转。
可见,本发明提供的基板位置偏移检测及校正装置,可以实时检测和校正基板的位置,提高基板的搬运效率和生产效率。
另外,本发明提供的基板位置偏移检测及校正装置,可以提高搬运精度和效率。
进一步的,上述基板搬运***还包括:报警装置8,
控制器7还用于当夹角值大于零且大于预先设定的角度参考值时,输出告警信号和/或控制搬运***停止工作;
报警装置8根据告警信号产生告警。避免末端执行器6旋转时,末端执行器6与装基板的容器发生碰撞。
进一步的,控制器7还用于:
当第一距离大于第二距离时,根据第一距离和第二距离的差值调整预设的第二移动指令,并根据调整后的第二移动指令控制末端执行器6带动其上的待搬运基板1向机器人本体5移动;
当第一距离小于第二距离时,根据第一距离和第二距离的差值调整预设的第二移动指令,并根据调整后的第二移动指令控制末端执行器6带动其上的待搬运基板1向机器人本体5移动,或根据第一距离和第二距离的差值控制末端执行器6移动至预设停止位置,并根据预设的第二移动指令控制末端执行器6带动其上的待搬运基板1向机器人本体5移动;
需要说明的是:其中:第一距离为机器人本体带动其上的待搬运基板绕其轴线旋转至初始角度后、末端执行器的实际停止位置与机器人本体之间的距离,第二距离为末端执行器的预设停止位置与机器人本体之间的距离,预设停止位置为末端执行器按照预设的第一移动指令移动后的停止位置。
另一种情况下,控制器7还用于:若第一非接触式传感器21和第二非接触式传感器22为同时采集到第一边缘的信息时,拾取所述待搬运基板。
进一步的,如图2b和2c所示,上述控制器还用于:
需要说明的是:其中:第三距离为第一非接触传感器和第二非接触传感器同时采集到第一边缘的信息时、末端执行器6的实际停止位置与机器人本体之间的距离,第二距离为末端执行器的预设停止位置与机器人本体之间的距离,预设停止位置为末端执行器按照预设的第一移动指令移动后的停止位置;
如图2b,待搬运基板1的第一边缘11与预设位置线9之间具有距离H1,其中H1产生的原因是:末端执行器在按照预设的第一指令开始移动到拾取待搬运基板过程中,末端执行器先按照预设的第一指令移动至预设停止位置(即末端执行器移动至预设停止位置),此时第一非接触式传感器21和第二非接触传感器22均未采集到待搬运基板1的第一边缘11的信息;为此末端执行器6将继续向待搬运基板1的方向移动,直至第一非接触传感器21和第二非接触传感器22均采集到第一边缘11的信息时,末端执行器6将停止运动(即末端执行器移动至实际停止位置),并拾取待搬运基板1,因此末端执行器的实际停止位置与预设停止位置之间将产生差值,即为H1(H1是由于第三距离大于第二距离产生的),本发明提供的基板位置偏移检测及校正方法中,将根据H1(第三距离和第二距离的差值)调整预设的第二移动指令,并根据调整后的第二移动指令控制末端执行器6带动其上的待搬运基板1向机器人本体移动;
如图2c中,待搬运基板1的第一边缘11与预设位置线9之间具有距离H2,其中H2产生的原因是:末端执行器在按照预设的第一指令开始移动到拾取待搬运基板过程中,第一非接触式传感器21和第二非接触传感器22均采集到待搬运基板1的第一边缘11的信息,此时末端执行器6将停止运动(即末端执行器移动至实际停止位置),并拾取待搬运基板1,而在末端执行器停止时,末端执行器6还未按照预设的第一移动指令移动完成(即末端执行器还未移动到预设停止位置时,末端执行器已停止运动),因此末端执行器的实际停止位置与预设停止位置之间将产生差值,即为H2(H2是由于第三距离小于第二距离产生的),本发明提供的基板位置偏移检测及校正方法中,将根据H2(第三距离和第二距离)的差值调整预设的第二移动指令,并根据调整后的第二移动指令控制末端执行器带动其上的待搬运基板向机器人本体移动,或根据H2(第三距离和第二距离)的差值控制末端执行器移动至预设停止位置,并根据预设的第二移动指令控制末端执行器带动其上的待搬运基板向机器人本体移动。
如图2d所示,当待搬运基板1存在如图2c所示的偏移量w时,上述基板搬运***还包括:
设置于机器人本体5上的第三非接触式传感器23,当末端执行器6带动其上的待搬运基板向机器人本体5移动时,第三非接触式传感器检测待搬运基板的第二边缘12与机器人本体5的中点之间的第四距离信息(w),第三非接触式传感器23的中点在末端执行器6上的投影位于待搬运基板1的预设停止区域(即标准位置)的第一边缘上,其中:第一边缘和第二边缘垂直设置;
控制器7还用于根据第四距离信息调整预先设定的、用于控制末端执行器6沿水平轴4的延伸方向移动的距离的第三移动指令。
可选的,上述第一非接触式传感器21和第二非接触式传感器22均为光电开关传感器。
可选的,第三非接触式传感器23为激光测长传感器。
综上,控制器将根据是否有角度的偏移,执行不同的后续控制步骤,即根据两种情况执行不同功能。
本发明还提供了一种基板搬运***,包括:水平轴4,位于水平轴4上、且可沿水平轴4延伸方向移动的机器人本体5,与机器人本体5连接、用于拾取待搬运基板的末端执行器6,末端执行器6可伸缩,机器人本体5可旋转、且其旋转轴的延伸方向垂直于末端执行器6伸缩方向以及水平轴4的延伸方向;还包括上述任一项所述的基板位置偏移检测及校正装置,由于上述基板位置偏移检测及校正装置,可以实时检测和校正基板的位置,提高基板的搬运效率和生产效率。故本发明提供的基板搬运***具有较好的搬运效率。
显然,本领域的技术人员可以对本发明进行各种改动和变型而不脱离本发明的精神和范围。这样,倘若本发明的这些修改和变型属于本发明权利要求及其等同技术的范围之内,则本发明也意图包含这些改动和变型在内。
Claims (9)
1.一种基板位置偏移检测及校正方法,其特征在于,包括:
当基板搬运***内的末端执行器按照预设的第一移动指令向待搬运基板移动且未与待搬运基板接触时,第一非接触式传感器和第二非接触式传感器实时采集待搬运基板的第一边缘的信息,其中:第一非接触式传感器和第二非接触式传感器与机器人本体之间的距离相等,所述第一非接触式传感器和所述第二非接触式传感器之间具有设定距离;
当第一非接触式传感器和第二非接触式传感器均检测到待搬运基板的第一边缘的信息时,控制所述末端执行器停止运动,并判断所述第一非接触式传感器和第二非接触式传感器是否同时采集到第一边缘的信息,若所述第一非接触式传感器和第二非接触式传感器非同时采集到第一边缘的信息时,根据所述第一非接触式传感器和所述第二非接触式传感器分别检测到所述第一边缘后反馈的信号的时间差、以及预设的末端执行器的移动速度、所述第一非接触式传感器和所述第二非接触式传感器之间的设定距离,得到所述待搬运基板的第一边缘与所述第一非接触式传感器和第二非接触式传感器的连线之间的夹角值,并根据所述夹角值控制所述基板搬运***的机器人本体绕其轴线旋转。
2.如权利要求1所述的基板位置偏移检测及校正方法,其特征在于,当所述夹角值不等于零时,上述基板位置偏移检测及校正方法还包括:
当所述夹角值大于预设的角度参考值时,产生告警信号和/或控制所述基板搬运***停止工作。
3.如权利要求1所述的基板位置偏移检测及校正方法,其特征在于,还包括:
根据所述夹角值控制所述基板搬运***的机器人本体绕其轴线旋转后,控制所述末端执行器继续向待搬运基板移动,当第一非接触式传感器和第二非接触式传感器同时检测到待搬运基板的第一边缘的信息时,控制所述末端执行器再次停止运动,并拾取所述待搬运基板,且控制所述机器人本体带动其上的待搬运基板绕其轴线旋转至初始角度。
4.如权利要求3所述的基板位置偏移检测及校正方法,其特征在于,还包括:
当第一距离大于第二距离时,根据所述第一距离和所述第二距离的差值调整预设的第二移动指令,并根据调整后的第二移动指令控制所述末端执行器带动其上的待搬运基板向所述机器人本体移动;
当第一距离小于第二距离时,根据所述第一距离和所述第二距离的差值调整预设的第二移动指令,并根据调整后的第二移动指令控制所述末端执行器带动其上的待搬运基板向所述机器人本体移动,或根据所述第一距离和第二距离的差值控制所述末端执行器移动至预设停止位置,并根据预设的第二移动指令控制所述末端执行器带动其上的待搬运基板向所述机器人本体移动,其中:所述第一距离为所述机器人本体带动其上的待搬运基板绕其轴线旋转至初始角度后、所述末端执行器的实际停止位置与所述机器人本体之间的距离,所述第二距离为所述末端执行器的预设停止位置与所述机器人本体之间的距离,所述预设停止位置为末端执行器按照所述预设的第一移动指令移动后的停止位置。
5.如权利要求1所述的基板位置偏移检测及校正方法,其特征在于,还包括:
若所述第一非接触式传感器和第二非接触式传感器为同时采集到第一边缘的信息时,拾取所述待搬运基板。
6.如权利要求5所述的基板位置偏移检测及校正方法,其特征在于,还包括:
当第三距离大于第二距离时,根据所述第三距离和所述第二距离的差值调整预设的第二移动指令,并根据调整后的第二移动指令控制所述末端执行器带动其上的待搬运基板向所述机器人本体移动;
当第三距离小于第二距离时,根据所述第三距离和所述第二距离的差值调整预设的第二移动指令,并根据调整后的第二移动指令控制所述末端执行器带动其上的待搬运基板向所述机器人本体移动,或根据所述第三距离和第二距离的差值控制所述末端执行器移动至预设停止位置,并根据预设的第二移动指令控制所述末端执行器带动其上的待搬运基板向所述机器人本体移动,其中:所述第三距离为所述第一非接触传感器和所述第二非接触传感器同时采集到第一边缘的信息时、末端执行器的实际停止位置与所述机器人本体之间的距离,所述第二距离为所述末端执行器的预设停止位置与所述机器人本体之间的距离,所述预设停止位置为末端执行器按照所述预设的第一移动指令移动后的停止位置。
7.如权利要求4或6所述的基板位置偏移检测及校正方法,其特征在于,还包括:
当所述末端执行器带动其上的待搬运基板向所述机器人本体移动时,位于所述机器人本体上的第三非接触式传感器检测所述待搬运基板的第二边缘与所述第三非接触式传感器的中点之间的第四距离信息,其中:所述第一边缘和所述第二边缘垂直设置;
根据所述第四距离信息调整预先设定的、用于控制所述末端执行器沿水平轴的延伸方向移动的距离的第三移动指令。
8.如权利要求1所述的基板位置偏移检测及校正方法,其特征在于,所述根据所述第一非接触式传感器和所述第二非接触式传感器反馈的信号的时间差、以及预设的末端执行器的移动速度、所述第一非接触式传感器和所述第二非接触式传感器之间的设定距离,得到所述待搬运基板的第一边缘与所述第一非接触式传感器和第二非接触式传感器的连线之间的夹角值具体包括:
根据公式a=arctan(v×T/L),得到所述夹角值,其中:a为夹角,v为所述预设的末端执行器的移动速度,T为所述时间差,L为所述第一非接触式传感器和第二非接触式传感器之间的设定距离。
9.一种基板搬运***的控制方法,其特征在于,包括:如权利要求1~8任一项所述的基板位置偏移检测及校正方法。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201510761073.7A CN105329642B (zh) | 2015-11-09 | 2015-11-09 | 基板位置偏移检测及校正方法和基板搬运***的控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201510761073.7A CN105329642B (zh) | 2015-11-09 | 2015-11-09 | 基板位置偏移检测及校正方法和基板搬运***的控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN105329642A CN105329642A (zh) | 2016-02-17 |
CN105329642B true CN105329642B (zh) | 2017-11-21 |
Family
ID=55280466
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201510761073.7A Active CN105329642B (zh) | 2015-11-09 | 2015-11-09 | 基板位置偏移检测及校正方法和基板搬运***的控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN105329642B (zh) |
Families Citing this family (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US10544022B2 (en) * | 2016-10-13 | 2020-01-28 | The Raymond Corporation | Handle position sensing systems and methods for a material handling vehicle |
CN111843225A (zh) * | 2020-06-16 | 2020-10-30 | 大族激光科技产业集团股份有限公司 | 一种自动化生产线及激光打标生产线 |
CN115112013B (zh) * | 2021-05-07 | 2023-03-28 | 沈阳新松机器人自动化股份有限公司 | 一种基于传感器的fpd机械手动态玻璃纠偏方法 |
Family Cites Families (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP3393955B2 (ja) * | 1995-04-18 | 2003-04-07 | 株式会社ダイヘン | 薄板状ワーク搬送用ハンド |
JPH11254374A (ja) * | 1998-03-10 | 1999-09-21 | Toray Ind Inc | 基板搬送用ハンドおよび基板の搬送方法並びにカラーフィルターの製造装置および製造方法 |
JP3955499B2 (ja) * | 2001-08-07 | 2007-08-08 | 日本電産サンキョー株式会社 | ハンドの位置合わせ方法およびその装置 |
JP2005187198A (ja) * | 2003-12-26 | 2005-07-14 | Nippon Oil Corp | 炭素繊維強化金属複合材料製搬送用部材 |
CN203339131U (zh) * | 2013-08-01 | 2013-12-11 | 北京京东方光电科技有限公司 | 一种基板搬运装置 |
-
2015
- 2015-11-09 CN CN201510761073.7A patent/CN105329642B/zh active Active
Also Published As
Publication number | Publication date |
---|---|
CN105329642A (zh) | 2016-02-17 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN105417066B (zh) | 基板位置偏移检测及校正装置和基板搬运*** | |
US9782896B2 (en) | Robot system and control method for robot system | |
US8456124B2 (en) | Parallel mechanism | |
CN101909778B (zh) | 用于调整板形零件位置的装置和方法 | |
CN104944154B (zh) | 手套转移、码沓机械手***及手套转移、码沓方法 | |
CN105329642B (zh) | 基板位置偏移检测及校正方法和基板搬运***的控制方法 | |
CN107529670A (zh) | 基板处理装置和方法 | |
US9433994B2 (en) | Centering device for plate-shaped workpiece | |
TWI623395B (zh) | Substrate transfer robot and substrate transfer method | |
JP2009090406A (ja) | ロボットのターゲット位置検出装置 | |
CN103824791A (zh) | 基板搬运机器人和基板搬运方法 | |
CN101631732B (zh) | 用于从托盘上卸下和输送物流台车的方法和装置 | |
TW200942383A (en) | Transfer robot diagnosis system | |
EP2711143A2 (en) | Robot system and article manufacturing method | |
KR20230085202A (ko) | 얼라이너 장치 및 얼라인먼트 방법 | |
CN103904008B (zh) | 一种半导体设备的机械臂的动态传感器结构 | |
CN206813979U (zh) | 薄型板件传送装置 | |
CN113573996B (zh) | 机器人手、机器人以及机器人*** | |
JP5529920B2 (ja) | ロボットのターゲット位置検出装置、半導体装置およびターゲット位置検出方法 | |
JPWO2016035837A1 (ja) | 搬送装置及び真空装置 | |
US20230224450A1 (en) | Imaging device for acquiring three-dimensional information of workpiece surface and two-dimensional image of workpiece | |
JP6552386B2 (ja) | 部品実装機、部品実装方法 | |
CN210680029U (zh) | 锡膏印刷固化设备 | |
KR101455516B1 (ko) | 소재 이송 장치 및 이를 갖는 소재 성형 설비 | |
JP6164863B2 (ja) | 電子部品実装システム及び電子部品実装システムの基板搬送方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant | ||
CP01 | Change in the name or title of a patent holder | ||
CP01 | Change in the name or title of a patent holder |
Address after: 230013 Southwest District of Hefei City, Anhui Province Patentee after: Hefei xinyihua Intelligent Machine Co.,Ltd. Address before: 230013 Southwest District of Hefei City, Anhui Province Patentee before: HEFEI SINEVA INTELLIGENT MACHINE Co.,Ltd. |