CN114518727B - Discharge control system and discharging control method - Google Patents
Discharge control system and discharging control method Download PDFInfo
- Publication number
- CN114518727B CN114518727B CN202011292484.3A CN202011292484A CN114518727B CN 114518727 B CN114518727 B CN 114518727B CN 202011292484 A CN202011292484 A CN 202011292484A CN 114518727 B CN114518727 B CN 114518727B
- Authority
- CN
- China
- Prior art keywords
- module
- discharging
- control
- discharging mechanism
- estimated
- 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
-
- 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
- G05B19/00—Programme-control systems
- G05B19/02—Programme-control systems electric
- G05B19/418—Total factory control, i.e. centrally controlling a plurality of machines, e.g. direct or distributed numerical control [DNC], flexible manufacturing systems [FMS], integrated manufacturing systems [IMS] or computer integrated manufacturing [CIM]
- G05B19/41865—Total factory control, i.e. centrally controlling a plurality of machines, e.g. direct or distributed numerical control [DNC], flexible manufacturing systems [FMS], integrated manufacturing systems [IMS] or computer integrated manufacturing [CIM] characterised by job scheduling, process planning, material flow
-
- 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/32—Operator till task planning
- G05B2219/32252—Scheduling production, machining, job shop
-
- Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
- Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
- Y02P—CLIMATE CHANGE MITIGATION TECHNOLOGIES IN THE PRODUCTION OR PROCESSING OF GOODS
- Y02P90/00—Enabling technologies with a potential contribution to greenhouse gas [GHG] emissions mitigation
- Y02P90/02—Total factory control, e.g. smart factories, flexible manufacturing systems [FMS] or integrated manufacturing systems [IMS]
Landscapes
- Engineering & Computer Science (AREA)
- General Engineering & Computer Science (AREA)
- Manufacturing & Machinery (AREA)
- Quality & Reliability (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Manipulator (AREA)
Abstract
本发明提供一种出料控制系统及其出料控制方法。出料控制系统具有作业模块、调整模块、电脑视觉模块、高度测量模块及控制模块。作业模块的出料机构供应材料,调整模块于多个自由度中移动该出料机构,电脑视觉模块的正向摄影机与侧向摄影机持续拍摄涵盖出料机构、调整模块及作业位置的影像,高度测量模块测量调整模块与作业位置之间的估测高度,控制模块控制估测高度来符合预设高度,持续依据影像计算出料机构的估测姿态与估测位置,并控制出料机构的移动以使出料机构所输出的材料被供应至作业位置。本发明可实现出料自动化,并精确地供应材料至作业位置。
The invention provides a discharging control system and a discharging control method. The discharging control system has an operation module, an adjustment module, a computer vision module, a height measurement module and a control module. The discharging mechanism of the operation module supplies materials, and the adjustment module moves the discharging mechanism in multiple degrees of freedom. The front camera and side camera of the computer vision module continuously capture images covering the discharging mechanism, the adjustment module and the working position, and the height is measured. The module measures and adjusts the estimated height between the module and the working position. The control module controls the estimated height to match the preset height, continuously calculates the estimated posture and estimated position of the discharging mechanism based on the image, and controls the movement of the discharging mechanism to The material output by the discharging mechanism is supplied to the working position. The invention can realize discharging automation and accurately supply materials to the working position.
Description
技术领域Technical field
本发明涉及一种控制系统与控制方法,特别涉及一种出料控制系统及出料控制方法。The invention relates to a control system and a control method, in particular to a discharging control system and a discharging control method.
背景技术Background technique
于现有的出料控制技术中,出料机构通常是固定式机构,仅能提供材料至固定位置。In existing discharging control technology, the discharging mechanism is usually a fixed mechanism that can only provide materials to a fixed position.
对此,于目前的加工流程中,都是由作业人员以人工方式来将加工物的加工部位对准前述固定位置,而使材料可被添加至加工部位。In this regard, in the current processing flow, the operator manually aligns the processing part of the workpiece with the aforementioned fixed position so that material can be added to the processing part.
然而,前述方式不仅耗费大量人力与时间,其材料供应的精确度是完全取决于作业人员的技术熟练度,无法提供稳定且高精确度的材料供应。However, the aforementioned method not only consumes a lot of manpower and time, but also the accuracy of material supply completely depends on the technical proficiency of the operators, and cannot provide stable and high-precision material supply.
因此,现有出料控制技术存在上述问题亟待更有效的方案被提出。Therefore, the existing discharging control technology has the above problems and more effective solutions are urgently needed.
发明内容Contents of the invention
本发明的主要目的在于提供一种控制系统及其控制方法,可自动将出料机构对准物件的作业位置。The main purpose of the present invention is to provide a control system and a control method thereof that can automatically align the discharging mechanism with the working position of the object.
本发明提供一种出料控制系统,用以供应材料至一作业位置。出料控制系统包括一作业模块、一调整模块、一电脑视觉模块、一高度测量模块及一控制模块。该作业模块包括一出料机构,该出料机构用以供应该材料;该调整模块连接该出料机构,并用以于多个自由度中移动该出料机构,该调整模块包括至少一马达装置与分别对应不同自由度的多个移动机构,该至少一马达装置用以提供动力来使该多个移动机构分别于对应的自由度中移动该出料机构;该电脑视觉模块包括一正向摄影机与一侧向摄影机,该正向摄影机设置于该出料机构与该调整模块上方,并用以持续拍摄涵盖该出料机构、该调整模块及该作业位置的一正向影像,该侧向摄影机设置于该出料机构与该调整模块侧方,并用以持续拍摄涵盖该出料机构、该调整模块及该作业位置的一侧向影像;该高度测量模块用以测量该调整模块与该作业位置之间的一估测高度;该控制模块电性连接该出料机构、该调整模块、该电脑视觉模块及该高度测量模块,该控制模块被配置为控制该调整模块移动该作业模块以使该估测高度符合一预设高度,持续依据该正向影像与该侧向影像计算该出料机构的估测姿态与估测位置,依据该出料机构的该估测姿态与该估测位置控制该调整模块来移动该出料机构而改变该估测姿态与该估测位置以使该出料机构所输出的该材料被供应至该作业位置。The invention provides a discharging control system for supplying materials to a working position. The discharging control system includes an operation module, an adjustment module, a computer vision module, a height measurement module and a control module. The operation module includes a discharging mechanism, which is used to supply the material; the adjustment module is connected to the discharging mechanism and is used to move the discharging mechanism in multiple degrees of freedom. The adjustment module includes at least one motor device and Corresponding to a plurality of moving mechanisms with different degrees of freedom, the at least one motor device is used to provide power to make the plurality of moving mechanisms move the discharging mechanism in corresponding degrees of freedom respectively; the computer vision module includes a forward camera and a A lateral camera, the forward camera is arranged above the discharging mechanism and the adjustment module, and is used to continuously shoot a forward image covering the discharging mechanism, the adjustment module and the working position. The lateral camera is disposed above the discharging mechanism and the adjustment module. The side of the discharging mechanism and the adjustment module is used to continuously shoot a lateral image covering the discharging mechanism, the adjustment module and the working position; the height measurement module is used to measure the distance between the adjusting module and the working position. An estimated height; the control module is electrically connected to the discharging mechanism, the adjustment module, the computer vision module and the height measurement module, and the control module is configured to control the adjustment module to move the operation module so that the estimated height Consistent with a preset height, continue to calculate the estimated posture and estimated position of the discharging mechanism based on the forward image and the lateral image, and control the adjustment module based on the estimated posture and estimated position of the discharging mechanism To move the discharging mechanism and change the estimated attitude and the estimated position so that the material output by the discharging mechanism is supplied to the working position.
本发明还提供一种出料控制方法,用于一出料控制系统,该出料控制系统包括一作业模块、一调整模块、一电脑视觉模块、一高度测量模块及一控制模块,该出料控制方法包括以下步骤:a)于该控制模块控制该高度测量模块测量该调整模块与一作业位置之间的一估测高度;b)基于该估测高度调整该作业模块至一预设高度;c)持续控制该电脑视觉模块的一正向摄影机由该出料机构与该调整模块的上方拍摄涵盖该作业模块的一出料机构、该调整模块及该作业位置的一正向影像,并控制该电脑视觉模块的一侧向摄影机由该出料机构与该调整模块的侧方拍摄涵盖该出料机构、该调整模块及该作业位置的一侧向影像;d)持续依据该正向影像与该侧向影像计算该出料机构的估测姿态与估测位置;及,e)依据该出料机构的该估测姿态与该估测位置控制该调整模块的至少一马达装置提供动力至多个移动机构来分别于各该移动机构所对应的自由度中移动该出料机构而改变该出料机构的该估测姿态与该估测位置以使该出料机构所输出的该材料被供应至该作业位置。The invention also provides a discharging control method for a discharging control system. The discharging control system includes an operation module, an adjustment module, a computer vision module, a height measurement module and a control module. The control method includes the following steps: a) controlling the height measurement module in the control module to measure an estimated height between the adjustment module and an operating position; b) adjusting the operating module to a preset height based on the estimated height; c) Continuously control a forward camera of the computer vision module to capture a forward image covering the discharging mechanism, the adjustment module and the operating position of the operation module from above the discharging mechanism and the adjustment module, and control The lateral camera of the computer vision module captures a lateral image covering the discharging mechanism, the adjustment module and the working position from the side of the discharging mechanism and the adjustment module; d) continue to rely on the forward image and The side image calculates the estimated posture and estimated position of the discharging mechanism; and, e) controls at least one motor device of the adjustment module to provide power to a plurality of The moving mechanism moves the discharging mechanism in the degrees of freedom corresponding to each moving mechanism to change the estimated posture and the estimated position of the discharging mechanism so that the material output by the discharging mechanism is supplied to the Job location.
本发明可实现出料自动化,并精确地供应材料至作业位置。The invention can realize discharging automation and accurately supply materials to the working position.
附图说明Description of drawings
图1为本发明的第一实施例的出料控制系统的架构图。Figure 1 is an architectural diagram of a discharging control system according to the first embodiment of the present invention.
图2为本发明的第二实施例的出料控制系统的架构图。Figure 2 is an architectural diagram of the discharging control system according to the second embodiment of the present invention.
图3为本发明的第三实施例的调整模块的架构图。Figure 3 is an architectural diagram of an adjustment module according to the third embodiment of the present invention.
图4为本发明的第四实施例的控制模块的架构图。Figure 4 is an architectural diagram of a control module according to the fourth embodiment of the present invention.
图5为本发明的第一实施例的出料控制方法的流程图。Figure 5 is a flow chart of the discharging control method according to the first embodiment of the present invention.
图6为本发明的第二实施例的出料控制方法的流程图。Figure 6 is a flow chart of the discharging control method according to the second embodiment of the present invention.
图7为本发明的一例子的出料控制系统的部分外观示意图。FIG. 7 is a partial appearance diagram of a discharging control system according to an example of the present invention.
图8为本发明的一例子的正向影像的外观示意图。FIG. 8 is a schematic diagram of the appearance of a forward image according to an example of the present invention.
图9为本发明的一例子的第一侧向影像的外观示意图。FIG. 9 is a schematic view of the appearance of the first side image according to an example of the present invention.
图10为本发明的一例子的第二侧向影像的外观示意图。FIG. 10 is a schematic view of the appearance of a second side image according to an example of the present invention.
其中,附图标记说明如下:Among them, the reference symbols are explained as follows:
1:出料控制系统1: Discharging control system
10:控制模块10: Control module
11:作业模块11: Job module
110:出料机构110: Discharging mechanism
12:调整模块12: Adjustment module
120:马达装置120: Motor device
121:移动机构121:Mobile mechanism
13:电脑视觉模块13: Computer vision module
130:正向摄影机130: Forward camera
131:侧向摄影机131: Side camera
14:高度测量模块14: Height measurement module
2:出料控制系统2: Discharge control system
20:控制主机20: Control host
200:控制模块200: Control module
201:存储模块201: Storage module
202:人机接口202: Human-computer interface
203:通信模块203: Communication module
21:自动化设备21: Automation equipment
210:作业模块210: Job module
211:调整模块211: Adjust module
212:电脑视觉模块212: Computer Vision Module
213:高度测量模块213: Height measurement module
214:材料加工模块214: Material processing module
215:激光215: Laser
300:出料机构300: Discharging mechanism
301:供料机构301: Feeding mechanism
310-312:马达装置310-312: Motor device
313:水平移动机构313: Horizontal moving mechanism
314:仰角移动机构314: Elevation moving mechanism
315:垂直移动机构315: Vertical moving mechanism
320:第一侧向摄影机320: First side camera
321:第二侧向摄影机321: Second side camera
322:正向摄影机322: Forward camera
323:非可见光摄影机323: Non-visible light camera
40:调整模块40: Adjustment module
400:马达装置400: Motor device
401:离合切换模块401: Clutch switching module
402-403:移动机构402-403: Mobile mechanism
50:控制模块50: Control module
501:高度取得模块501: Height acquisition module
502:影像取得模块502: Image acquisition module
503:视觉估测模块503: Visual estimation module
504:前置处理模块504: Pre-processing module
505:分析影像模块505: Analyze image module
506:出料控制模块506: Discharge control module
507:移动控制模块507:Mobile control module
508:加工控制模块508: Processing control module
509:错误检测模块509: Error detection module
60:印刷电路板60: Printed circuit board
61:焊盘61: Pad
62:元件引脚62: Component pin
63:水平旋转连接件63: Horizontal rotating connector
64:传动件64: Transmission parts
65:材料65: Material
S10-S16:第一出料控制步骤S10-S16: The first discharging control step
S200-S210:第二出料控制步骤S200-S210: second discharging control step
S30-S31:计算步骤S30-S31: Calculation steps
S40-S41:移动步骤S40-S41: Moving steps
具体实施方式Detailed ways
兹就本发明的一较佳实施例,配合附图,详细说明如后。A preferred embodiment of the present invention is described in detail below with reference to the accompanying drawings.
本发明主要是提供一种出料控制系统及其出料控制方法,可自动测量加工物件的作业位置与出料机构之间的姿态差距及/或位置差距,并精确地调整出料机构的姿态及/或位置来准确地将材料供应作业位置,而不需要人工操作。The present invention mainly provides a discharging control system and a discharging control method, which can automatically measure the posture gap and/or position gap between the working position of the processed object and the discharging mechanism, and accurately adjust the posture of the discharging mechanism. and/or location to accurately supply materials to job locations without the need for manual operations.
请同时参阅图1与图5。图1为本发明的第一实施例的出料控制系统的架构图,图5为本发明的第一实施例的出料控制方法的流程图。本发明各实施例的出料控制方法可由任一实施例的出料控制系统来加以实现。Please see Figure 1 and Figure 5 together. FIG. 1 is an architecture diagram of a discharging control system according to the first embodiment of the present invention, and FIG. 5 is a flow chart of a discharging control method according to the first embodiment of the present invention. The discharging control method of each embodiment of the present invention can be implemented by the discharging control system of any embodiment.
如图1所示,于本实施例中,出料控制系统1包括作业模块11、调整模块12、电脑视觉模块13、高度测量模块14及电性连接前述模块的控制模块10。As shown in Figure 1, in this embodiment, the discharging control system 1 includes an operation module 11, an adjustment module 12, a computer vision module 13, a height measurement module 14 and a control module 10 electrically connected to the above modules.
作业模块11可包括出料机构110。出料机构110用以供应加工作业所需使用的材料(如粘着剂、焊接材、列印材等等)至其吐料口所朝向的出料位置。The operation module 11 may include a discharging mechanism 110 . The discharging mechanism 110 is used to supply materials required for processing operations (such as adhesives, welding materials, printing materials, etc.) to the discharging position toward which the discharging port faces.
调整模块12于机构上连接出料机构110,并用以于多个自由度中移动出料机构110,从而使出料机构110的吐料口朝向指定的位置。具体而言,调整模块12可包括一或多个马达装置120(图1是以多个马达装置120为例)与分别对应不同自由度的多个移动机构121(各移动机构121可为各式连接件与传动件的任意组合)。马达装置120是用以提供动力来使所连接的移动机构121于对应的自由度中移动出料机构。The adjustment module 12 is mechanically connected to the discharging mechanism 110 and is used to move the discharging mechanism 110 in multiple degrees of freedom, so that the discharge opening of the discharging mechanism 110 faces a designated position. Specifically, the adjustment module 12 may include one or more motor devices 120 (Figure 1 takes multiple motor devices 120 as an example) and multiple moving mechanisms 121 corresponding to different degrees of freedom (each moving mechanism 121 may be of various types). Any combination of connecting parts and transmission parts). The motor device 120 is used to provide power to move the connected moving mechanism 121 to move the discharging mechanism in a corresponding degree of freedom.
于一实施例中,马达装置120为步进马达,并设置有马达编码器,马达编码器可感测马达装置120目前的位址信号(如旋转角度),并提供给控制模块10,从而供控制模块10知悉移动机构121与出料机构110的目前位置。或者,马达装置120可依据控制模块10的马达控制信号(可包括指定位址)转动直到位址信号符合马达控制信号,从而实现精准动力输出控制,并可精准地移动移动机构121来调整出料机构110的位置。In one embodiment, the motor device 120 is a stepper motor and is provided with a motor encoder. The motor encoder can sense the current address signal (such as the rotation angle) of the motor device 120 and provide it to the control module 10, thereby providing The control module 10 knows the current positions of the moving mechanism 121 and the discharging mechanism 110 . Alternatively, the motor device 120 can rotate according to the motor control signal of the control module 10 (which may include a specified address) until the address signal matches the motor control signal, thereby achieving precise power output control and accurately moving the moving mechanism 121 to adjust the discharging. Establishment 110 location.
电脑视觉模块13主要是提供电脑视觉分析所需的影像资料给控制模块10,以供控制模块10执行电脑视觉分析(如分析出料机构110于现实空间中的姿态与位置)。具体而言,电脑视觉模块13可包括一或多个正向摄影机130与一或多个侧向摄影机131。正向摄影机130与侧向摄影机131可为相同类型(如可见光摄影机)或相似(如采用不同焦距的镜头或不同尺寸的感光元件)的摄影机,其命名的差异主要是用来区别其设置位置。The computer vision module 13 mainly provides image data required for computer vision analysis to the control module 10 so that the control module 10 can perform computer vision analysis (such as analyzing the posture and position of the discharging mechanism 110 in real space). Specifically, the computer vision module 13 may include one or more front cameras 130 and one or more side cameras 131 . The front camera 130 and the side camera 131 may be cameras of the same type (such as a visible light camera) or similar cameras (such as using lenses with different focal lengths or photosensitive elements of different sizes). The difference in their names is mainly used to distinguish their installation locations.
更进一步地,正向摄影机130是设置于出料机构110与调整模块12上方,并用以持续拍摄正向影像。侧向摄影机131设置于出料机构110与调整模块12侧方,并用以持续拍摄侧向影像。Furthermore, the forward camera 130 is disposed above the discharging mechanism 110 and the adjustment module 12 and is used to continuously capture forward images. The side camera 131 is disposed on the side of the discharging mechanism 110 and the adjustment module 12 and is used to continuously capture side images.
于一实施例中,前述正向影像的视野是涵盖出料机构110、调整模块12及物件的作业位置。前述侧向影像的视野是涵盖出料机构110、调整模块12及作业位置。In one embodiment, the field of view of the front image covers the working position of the discharging mechanism 110, the adjustment module 12 and the object. The field of view of the aforementioned side image covers the discharging mechanism 110, the adjustment module 12 and the working position.
请一并参阅图8与图9,图8为本发明的一例子的正向影像的外观示意图,图9为本发明的一例子的第一侧向影像的外观示意图。Please refer to FIGS. 8 and 9 together. FIG. 8 is a schematic view of the appearance of a front image according to an example of the present invention, and FIG. 9 is a schematic view of the appearance of a first side image according to an example of the present invention.
如图8所示的正向影像,其视角是由上而下垂直拍摄,且其视野是涵盖出料机构110的吐料口及物件的作业位置(如电路板中央的元件焊接点)。As shown in FIG. 8 , the perspective of the front image is taken vertically from top to bottom, and its field of view covers the discharge port of the discharging mechanism 110 and the working position of the object (such as the component soldering point in the center of the circuit board).
如图9所示的侧向影像,其视角是出料机构110的左侧朝作业位置斜向拍摄,且其视野是涵盖出料机构110的吐料口及物件的作业位置。As shown in FIG. 9 , the side image is taken obliquely from the left side of the discharging mechanism 110 towards the working position, and its field of view covers the discharge opening of the discharging mechanism 110 and the working position of the object.
复请参阅图1,高度测量模块14用以测量调整模块12与作业位置之间的估测高度。于一实施例中,高度测量模块14可以为激光测距仪、超声波测距仪、电磁测距仪或其他测距装置。Referring again to FIG. 1 , the height measurement module 14 is used to measure the estimated height between the adjustment module 12 and the working position. In one embodiment, the height measurement module 14 may be a laser range finder, an ultrasonic range finder, an electromagnetic range finder or other distance measuring devices.
控制模块10用来控制出料控制系统1的各模块。具体而言,请同时参阅图1与图5,控制模块10是被配置来控制高度测量模块14测量前述的估测高度(步骤S10),并基于估测高度控制调整模块12移动作业模块11的出料机构110,以使调整模块12与作业位置之间的高度差符合预设高度(步骤S11)。The control module 10 is used to control each module of the discharging control system 1 . Specifically, please refer to FIG. 1 and FIG. 5 at the same time. The control module 10 is configured to control the height measurement module 14 to measure the aforementioned estimated height (step S10 ), and control the adjustment module 12 to move the operation module 11 based on the estimated height. The discharging mechanism 110 is configured to make the height difference between the adjustment module 12 and the working position comply with the preset height (step S11).
此外,控制模块10是被配置来控制正向摄影机130与侧向摄影机131拍摄正向影像与侧向影像(步骤S12),并依据所拍摄的正向影像与侧向影像计算出料机构110的估测姿态与估测位置(步骤S13)。前述估测姿态与估测位置可以空间坐标系(如笛卡尔坐标系)或机器人坐标系(如坐标是记录有各马达装置120的位址)来加以表示。In addition, the control module 10 is configured to control the front camera 130 and the side camera 131 to capture the front image and the side image (step S12), and calculate the discharge mechanism 110 based on the captured front image and side image. Estimated posture and estimated position (step S13). The aforementioned estimated posture and estimated position can be represented by a spatial coordinate system (such as a Cartesian coordinate system) or a robot coordinate system (such as coordinates recording the addresses of each motor device 120).
值得一提的是,依据多张不同视角的影像来确认物体的姿态或坐标位置是电脑视觉技术领域中的现有技术,其细节与可能实施方式于此不加以赘述。本发明主要是将不同领域的电脑视觉技术转用至自动出料控制。It is worth mentioning that confirming the posture or coordinate position of an object based on multiple images from different viewing angles is an existing technology in the field of computer vision technology, and its details and possible implementations will not be described here. The present invention mainly transfers computer vision technology from different fields to automatic discharging control.
接着,控制模块10还被配置来依据所算出的出料机构110的估测姿态与估测位置判断出料机构110的吐料口是否对准物件的作业位置(步骤S14)。Next, the control module 10 is further configured to determine whether the discharge port of the discharging mechanism 110 is aligned with the working position of the object based on the calculated estimated posture and estimated position of the discharging mechanism 110 (step S14).
若判定吐料口未对准物件的作业位置(如估测姿态与估测位置不符合预设姿态或预设位置),则控制模块10控制该调整模块12的至少一马达装置120提供动力至所连接的移动机构121来于指定的自由度中移动出料机构110,以改变出料机构110的估测姿态与估测位置(步骤S15)。接着,控制模块10再次执行步骤S12以再次基于电脑视觉判断吐料口是否对准物件的作业位置。If it is determined that the discharge port is not aligned with the working position of the object (for example, the estimated posture and the estimated position do not match the preset posture or the preset position), the control module 10 controls at least one motor device 120 of the adjustment module 12 to provide power to The connected moving mechanism 121 moves the discharging mechanism 110 in a specified degree of freedom to change the estimated posture and estimated position of the discharging mechanism 110 (step S15). Then, the control module 10 executes step S12 again to determine whether the discharge port is aligned with the working position of the object based on computer vision.
若于步骤S14中,判定吐料口已对准物件的作业位置,则控制模块10控制作业模块11开始执行出料操作,以使出料机构110输出材料至作业位置(步骤S16)。If in step S14, it is determined that the material discharging port has been aligned with the working position of the object, then the control module 10 controls the working module 11 to start performing the discharging operation, so that the discharging mechanism 110 outputs the material to the working position (step S16).
借此,本发明可实现自动将出料机构的吐料口对准作业位置,而可省却人工操作。并且,本发明通过马达编码器与高度测量模块14的设置,还可精确地供应材料至作业位置。Thereby, the present invention can automatically align the discharging opening of the discharging mechanism to the working position, thereby eliminating manual operation. Moreover, through the arrangement of the motor encoder and the height measurement module 14, the present invention can also accurately supply materials to the working position.
请同时参阅图1、图2与图4,图2为本发明的第二实施例的出料控制系统的架构图,图4为本发明的第四实施例的控制模块的架构图。Please refer to FIG. 1 , FIG. 2 and FIG. 4 at the same time. FIG. 2 is an architectural diagram of the discharging control system according to the second embodiment of the present invention, and FIG. 4 is an architectural diagram of the control module according to the fourth embodiment of the present invention.
图4的实施例中是提出一种控制模块50,其包括了以下用以实现不同功能的模块501-509。并且,图1所示的控制模块10与图2所示的控制模块200都可以替换为前述的控制模块50,来实现模块化的控制(后续以图2的架构结合图4来进行说明)。The embodiment of Figure 4 proposes a control module 50, which includes the following modules 501-509 for implementing different functions. Moreover, both the control module 10 shown in FIG. 1 and the control module 200 shown in FIG. 2 can be replaced by the aforementioned control module 50 to achieve modular control (the architecture of FIG. 2 will be used in conjunction with FIG. 4 for explanation later).
1.高度取得模块501:被配置来控制高度测量模块213进行测量,并取得测量距离(即估测高度)。1. Height acquisition module 501: configured to control the height measurement module 213 to perform measurements and obtain the measurement distance (ie, estimated height).
2.影像取得模块502:被配置来控制电脑视觉模块212的各摄影机320-323进行拍摄,并取得所拍摄的影像资料。2. Image acquisition module 502: configured to control each camera 320-323 of the computer vision module 212 to shoot and acquire the captured image data.
3.视觉估测模块503:被配置来依据所拍摄的影像资料执行电脑视觉分析,以获得出料机构300的估测姿态与估测位置。3. Visual estimation module 503: configured to perform computer vision analysis based on the captured image data to obtain the estimated posture and estimated position of the discharging mechanism 300.
于一实施例中,视觉估测模块503可包括前置处理模块504与分析影像模块505。In one embodiment, the visual estimation module 503 may include a pre-processing module 504 and an image analysis module 505.
前置处理模块504被配置来执行前置影像处理,以去除影像干扰及/或强化影像特征。于一实施例中,前置影像处理可包括灰阶化处理、去除背景干扰处理、特征辨识处理、锐化处理、二值化处理、轮廓辨识处理及/或其他去除干扰、影像萃取、影像强化处理。The pre-processing module 504 is configured to perform pre-image processing to remove image interference and/or enhance image features. In one embodiment, pre-image processing may include grayscale processing, background interference removal processing, feature recognition processing, sharpening processing, binarization processing, contour recognition processing and/or other interference removal, image extraction, and image enhancement. deal with.
分析影像模块505被配置来对经过前置影像处理后的影像资料执行分析影像处理,以计算出料机构300的估测姿态与估测位置。于一实施例中,分析影像处理可包括辨识作业点处理、分析姿态处理、分析位置处理、分析材料供应处理及/或其他物件辨识与分析处理。The analyzing image module 505 is configured to perform analyzing image processing on the image data after pre-image processing to calculate the estimated posture and estimated position of the discharging mechanism 300 . In one embodiment, the analysis image processing may include recognition operation point processing, analysis posture processing, analysis position processing, analysis material supply processing, and/or other object recognition and analysis processing.
4.出料控制模块506:被配置来控制出料机构300开始/停止吐料。于一实施例中,出料控制模块506是被配置为于吐料口对准作业位置时控制出料机构300开始吐料,并于停止条件(如预设时间经过、吐料量达预设体积或经由电脑视觉判断吐料完成等等)满足时控制出料机构300停止吐料。4. Discharging control module 506: configured to control the discharging mechanism 300 to start/stop discharging materials. In one embodiment, the discharging control module 506 is configured to control the discharging mechanism 300 to start discharging materials when the discharging port is aligned with the working position, and to control the discharging mechanism 300 to start discharging materials when the stop conditions (such as the preset time has passed and the discharging amount reaches the preset amount). When the volume is satisfied or the completion of discharging is determined by computer vision, etc.), the discharging mechanism 300 is controlled to stop discharging.
5.移动控制模块507:被配置来控制调整模块211的各马达装置310-312运转,以改变移动机构313-315的位置与姿态并实现出料机构300的移动。5. Movement control module 507: configured to control the operation of each motor device 310-312 of the adjustment module 211 to change the position and attitude of the moving mechanism 313-315 and realize the movement of the discharging mechanism 300.
于一实施例中,若调整模块包括离合切换模块(如图3所示的离合切换模块401),移动控制模块507可进一步被配置来控制离合切换模块401的切换。In one embodiment, if the adjustment module includes a clutch switching module (such as the clutch switching module 401 shown in FIG. 3 ), the movement control module 507 may be further configured to control the switching of the clutch switching module 401 .
6.加工控制模块508:被配置来控制材料加工模块214朝向作业位置,并对提供至作业位置的材料进行加工,以改变材料状态或性质(如硬化、流体化、变质等等)。6. Processing control module 508: configured to control the material processing module 214 toward the working position and process the material provided to the working position to change the material state or properties (such as hardening, fluidization, deterioration, etc.).
7.错误检测模块509:被配置来检测加工过程中的错误,并于检测到错误时发出通知。7. Error detection module 509: configured to detect errors during processing and send a notification when an error is detected.
值得一提的是,前述各模块501-509是彼此连接(可为电性连接或信息连接),并可为硬件模块(如电子电路模块、集成电路模块、SoC等等)、软件模块或软硬件模块混搭,在此并不加以限定。It is worth mentioning that the aforementioned modules 501-509 are connected to each other (can be electrical connection or information connection), and can be hardware modules (such as electronic circuit modules, integrated circuit modules, SoC, etc.), software modules or software modules. Mixing and matching of hardware modules is not limited here.
值得一提的是,当前述各模块501-509为软件模块(如固件、作业系统或应用程序)时,存储装置(如图2所示的存储模块201)可包括非暂态电脑可读取记录媒体,前述非暂态电脑可读取记录媒体存储有电脑程序,前述电脑程序记录有电脑可执行的程序码,当控制模块50执行前述程序码后,可实现前述模块501-509的控制功能。It is worth mentioning that when each of the aforementioned modules 501-509 is a software module (such as firmware, operating system or application program), the storage device (storage module 201 as shown in Figure 2) may include non-transitory computer-readable Recording media. The aforementioned non-transitory computer-readable recording medium stores computer programs. The aforementioned computer programs record computer-executable program codes. When the control module 50 executes the aforementioned program codes, the control functions of the aforementioned modules 501-509 can be realized. .
请同时参阅图2与图6,图6为本发明的第二实施例的出料控制方法的流程图。于图2的实施例中,出料控制系统2包括控制主机20与自动化设备21(如自动化机台、工业机器人或机械手臂等等)。控制主机20与自动化设备21之间可通过实体电缆或电脑网路连接,而可进行数据传输。Please refer to FIG. 2 and FIG. 6 at the same time. FIG. 6 is a flow chart of the discharging control method according to the second embodiment of the present invention. In the embodiment of FIG. 2 , the discharging control system 2 includes a control host 20 and automation equipment 21 (such as automated machines, industrial robots or robotic arms, etc.). The control host 20 and the automation equipment 21 can be connected through physical cables or computer networks for data transmission.
于一实施例中,控制主机20是与自动化设备21设置在同一厂房,而可对自动化设备21进行近端控制。In one embodiment, the control host 20 is located in the same factory building as the automation equipment 21 and can perform local control on the automation equipment 21 .
于一实施例中,控制主机20是与自动化设备21设置在不同地点,而可通过电脑网路对自动化设备21进行远端遥控。In one embodiment, the control host 20 and the automation equipment 21 are installed in different locations, and the automation equipment 21 can be remotely controlled through a computer network.
于本实施例中,作业模块210除了出料机构300,还包括供料机构301。供料机构301用以接受控制主机20的控制来输入材料,并提供材料至出料机构300。In this embodiment, in addition to the discharging mechanism 300, the operation module 210 also includes a feeding mechanism 301. The feeding mechanism 301 is used to accept the control of the control host 20 to input materials, and provide the materials to the discharging mechanism 300 .
调整模块211包括多个马达装置310-312,各马达装置310-312分别连接不同的移动机构313-315,并用以提供动力至所连接的该组移动机构313-315,以控制所连接移动机构313-315于所对应的自由度上移动出料机构300。The adjustment module 211 includes a plurality of motor devices 310-312. Each motor device 310-312 is connected to a different moving mechanism 313-315 respectively, and is used to provide power to the connected group of moving mechanisms 313-315 to control the connected moving mechanism. 313-315 move the discharging mechanism 300 on the corresponding degrees of freedom.
于一实施例中,马达装置310-312的数量不少于移动机构313-315的数量。In one embodiment, the number of motor devices 310-312 is no less than the number of moving mechanisms 313-315.
于一实施例中,马达装置310-312的数量等于移动机构313-315的数量。如马达装置310连接用以于水平方向旋转的水平移动机构313,马达装置311连接用以调整出料机构300的仰角的仰角移动机构314,马达装置312连接用以于垂直方向升降的垂直移动机构315,但不以此限定。In one embodiment, the number of motor devices 310-312 is equal to the number of moving mechanisms 313-315. For example, the motor device 310 is connected to the horizontal moving mechanism 313 for rotating in the horizontal direction, the motor device 311 is connected to the elevation moving mechanism 314 for adjusting the elevation angle of the discharging mechanism 300, and the motor device 312 is connected to the vertical moving mechanism for lifting in the vertical direction. 315, but not limited to this.
请参阅图3,为本发明的第三实施例的调整模块的架构图。本实施例的调整模块40还包括电性连接前述控制模块的离合切换模块401。离合切换模块401一端连接马达装置406,一端于多个移动机构402、403之间切换连接。马达装置400的数量少于移动机构402、403的数量。Please refer to FIG. 3 , which is an architectural diagram of an adjustment module according to a third embodiment of the present invention. The adjustment module 40 of this embodiment also includes a clutch switching module 401 electrically connected to the aforementioned control module. One end of the clutch switching module 401 is connected to the motor device 406, and the other end is switched between a plurality of moving mechanisms 402 and 403. The number of motor devices 400 is less than the number of moving mechanisms 402 and 403 .
于本实施例中,当欲控制移动机构402时,必须先控制离合切换模块401切换至连接移动机构402。借此,马达装置400的动力便可提供至移动机构402。In this embodiment, when you want to control the moving mechanism 402, you must first control the clutch switching module 401 to switch to connect the moving mechanism 402. Thereby, the power of the motor device 400 can be provided to the moving mechanism 402 .
当欲控制移动机构403时,则是控制离合切换模块401切换至连接移动机构403。借此,马达装置400的动力便可提供至移动机构403。When the moving mechanism 403 is to be controlled, the clutch switching module 401 is controlled to switch to connect the moving mechanism 403 . Thereby, the power of the motor device 400 can be provided to the moving mechanism 403 .
本发明通过离合切换模块401的设置,可有效减少马达装置的数量,进而降低系统成本,并减轻电力消耗。Through the arrangement of the clutch switching module 401, the present invention can effectively reduce the number of motor devices, thereby reducing system costs and reducing power consumption.
值得一提的是,于多个传动机构之间进行离合(切换连接)为动力机械领域的现有技术,于此不再赘述。本发明主要是将不同领域的机械离合技术转用至自动出料控制。It is worth mentioning that clutching (switching connections) between multiple transmission mechanisms is an existing technology in the field of power machinery, and will not be described again here. The present invention mainly transfers mechanical clutch technology from different fields to automatic discharging control.
复请参阅图2与图6,电脑视觉模块212除了正向摄影机322,还可配置多台侧向摄影机,如第一侧向摄影机320与第二侧向摄影机321,以获得多个不同视角的侧向影像(如第一侧向影像与第二侧向影像)。Please refer to Figure 2 and Figure 6 again. In addition to the front camera 322, the computer vision module 212 can also be configured with multiple side cameras, such as the first side camera 320 and the second side camera 321, to obtain multiple different viewing angles. Lateral images (such as the first lateral image and the second lateral image).
于一实施例中,电脑视觉模块212可依需求配置不同类型的非可见光摄影机323,如深度摄影机、热感摄影机、X光摄影机、超声波摄影机等等。非可见光摄影机323可拍摄非可见光影像,如可用来测量深度的深度影像、可用来测量温度的热感影像、可呈现物件内部的X光造影、可用来测量距离或形状的超声波影像等等。In one embodiment, the computer vision module 212 can be configured with different types of non-visible light cameras 323 as required, such as depth cameras, thermal cameras, X-ray cameras, ultrasonic cameras, etc. The non-visible light camera 323 can capture non-visible light images, such as depth images that can be used to measure depth, thermal images that can be used to measure temperature, X-ray images that can show the inside of objects, ultrasound images that can be used to measure distances or shapes, etc.
除了如前所述的高度测量模块213,自动化设备21还包括了电性连接控制模块200的材料加工模块214。材料加工模块214用以对出料机构300所吐出的材料进行加工。In addition to the height measurement module 213 as mentioned above, the automation equipment 21 also includes a material processing module 214 electrically connected to the control module 200 . The material processing module 214 is used to process the material discharged by the discharging mechanism 300 .
于一实施例中,于材料被供应至作业位置后,控制模块200才会控制材料加工模块214对作业位置的材料进行加工,以改变材料的状态或性质。In one embodiment, after the material is supplied to the working position, the control module 200 controls the material processing module 214 to process the material at the working position to change the state or properties of the material.
举例来说,若出料机构300所输出的材料包括冷却固化材料((即热塑性材料,如锡条、ABS树脂或热熔胶等),则材料加工模块214可包括加热模块。加热模块可加热冷却固化材料至流体状以填满作业位置(如元件的焊接点或粘着点,或者3D列印机的指定列印区域)。For example, if the material output by the discharging mechanism 300 includes cooling and solidifying materials (i.e. thermoplastic materials, such as tin bars, ABS resin or hot melt glue, etc.), the material processing module 214 may include a heating module. The heating module may heat Cool and solidify the material to a fluid state to fill the working location (such as the welding or adhesive points of the component, or the designated printing area of the 3D printer).
于另一个例子中,若前述材料包括聚合固化材料(如AB胶中的本胶),则材料加工模块214可包括注入固化剂模块。注入固化剂模块用以注入固化剂(如AB胶中的固化剂)至前述材料所在位置,以使固化剂与聚合固化材料发生固化反应。In another example, if the aforementioned material includes a polymerized curing material (such as AB glue), the material processing module 214 may include a curing agent injection module. The curing agent injection module is used to inject the curing agent (such as the curing agent in AB glue) to the location of the aforementioned materials, so that the curing agent and the polymerized curing material undergo a curing reaction.
于另一个例子中,若前述材料包括挥发固化材料(如硅利康、快干胶等等),则材料加工模块214可包括产生气流模块。产生气流模块用以产生气流以提升挥发速度,并减少挥发固化材料固化所需时间。In another example, if the aforementioned materials include volatile curing materials (such as silicone, quick-drying glue, etc.), the material processing module 214 may include an airflow generating module. The airflow generating module is used to generate airflow to increase the volatilization speed and reduce the time required for curing the volatilized curing material.
于另一个例子中,若前述材料包括光固化材料(如光固化树脂)时,则材料加工模块214可包括光源模块(如紫外光源),光源模块可对作业位置进行照射,以固化作业位置上的光固化材料。In another example, if the aforementioned material includes a light-curing material (such as a light-curing resin), the material processing module 214 may include a light source module (such as an ultraviolet light source). The light source module may illuminate the working position to cure the material on the working position. of light-curing materials.
于本实施例中,控制主机20可包括存储模块201、人机接口202、通信模块203与电性连接上述模块的控制模块200。In this embodiment, the control host 20 may include a storage module 201, a human-machine interface 202, a communication module 203, and a control module 200 electrically connected to the above modules.
存储模块201用以存储资料,如前述预设高度、预设姿态、预设位置、预设时间、预设体积等等。The storage module 201 is used to store data, such as the aforementioned preset height, preset posture, preset position, preset time, preset volume, etc.
人机接口202,可包括输入装置(如键盘、按键组、麦克风、鼠标等等)与输出装置(如显示器、喇叭、印表机等等)的任意组合,用以与使用者进行互动,如供使用者输入控制指令,或提供通知给使用者。The human-machine interface 202 may include any combination of input devices (such as keyboards, key sets, microphones, mice, etc.) and output devices (such as monitors, speakers, printers, etc.) to interact with users, such as For users to enter control instructions or provide notifications to users.
通信模块203包括传输接口,用以连接自动化设备,以建立控制模块200与自动化设备之间的通信。The communication module 203 includes a transmission interface for connecting to automation equipment to establish communication between the control module 200 and the automation equipment.
控制模块200用以控制出料控制系统2的各模块。具体而言,请同时参阅图2、图4及图6,控制模块200通过高度取得模块501控制高度测量模块213测量估测高度(步骤S200),并基于估测高度控制调整模块211通过移动控制模块507控制对应的马达装置310-312旋转指定的角度,以移动出料机构300,并使基准点(如调整模块211所在位置或吐料口所在位置)与作业位置之间的高度差符合预设高度(步骤S201)。The control module 200 is used to control each module of the discharging control system 2 . Specifically, please refer to Figures 2, 4 and 6 at the same time. The control module 200 controls the height measurement module 213 to measure the estimated height through the height acquisition module 501 (step S200), and controls the adjustment module 211 through the movement control based on the estimated height. The module 507 controls the corresponding motor devices 310-312 to rotate at a specified angle to move the discharging mechanism 300 and make the height difference between the reference point (such as the position of the adjustment module 211 or the position of the discharging port) and the working position meet the preset Set the height (step S201).
此外,控制模块200还通过影像取得模块502控制电脑视觉模块212的各摄影机320-323进行拍摄(步骤S202),并通过视觉估测模块503依据所拍摄的影像计算出料机构300的估测姿态与估测位置(步骤S203)。In addition, the control module 200 also controls each camera 320-323 of the computer vision module 212 to take pictures through the image acquisition module 502 (step S202), and calculates the estimated posture of the discharging mechanism 300 based on the captured images through the visual estimation module 503. and estimated position (step S203).
于一实施例中,控制模块200先通过前置处理模块504对全部或部分影像(如仅选择可见光影像)执行前置处理以获得对应的特征影像(即去除干扰及/或强化特征的影像),如对正向影像与侧向影像执行前置影像处理以获得特征正向影像与特征侧向影像(步骤S30)In one embodiment, the control module 200 first performs pre-processing on all or part of the images (for example, only visible light images are selected) through the pre-processing module 504 to obtain corresponding feature images (that is, images that remove interference and/or enhance features). , such as performing pre-image processing on the front image and the lateral image to obtain the characteristic front image and the characteristic lateral image (step S30)
控制模块200接着通过分析影像模块505基于全部或部分特征影像(如仅选择可见光影像)与各摄影机320-323的设置位置执行分析影像处理以获得出料机构300的估测姿态与估测位置,如基于正向摄影机的设置位置、侧向摄影机的设置位置与预设高度对特征正向影像与特征侧向影像执行分析影像处理以获得出料机构300的估测姿态与估测位置(步骤S31)。The control module 200 then performs analytical image processing based on all or part of the characteristic images (for example, only visible light images are selected) and the setting positions of each camera 320-323 through the image analysis module 505 to obtain the estimated posture and estimated position of the discharging mechanism 300. For example, based on the installation position of the front camera, the installation position of the side camera and the preset height, perform analytical image processing on the characteristic front image and the characteristic side image to obtain the estimated posture and estimated position of the discharging mechanism 300 (step S31 ).
接着,控制模块200通过出料控制模块506依据所算出的出料机构300的估测姿态与估测位置判断出料机构300的吐料口是否对准物件的作业位置(步骤S204)。Next, the control module 200 uses the discharging control module 506 to determine whether the discharge port of the discharging mechanism 300 is aligned with the working position of the object based on the calculated estimated posture and estimated position of the discharging mechanism 300 (step S204).
若判定吐料口未对准物件的作业位置,则控制模块200通过移动控制模块507控制指定的马达装置310-312运转以改变出料机构300的姿态及/或位置(步骤S205)。If it is determined that the discharge port is not aligned with the working position of the object, the control module 200 controls the operation of the designated motor devices 310-312 through the movement control module 507 to change the attitude and/or position of the discharging mechanism 300 (step S205).
于一实施例中,控制模块200可通过移动控制模块507控制马达装置310运转以水平旋转出料机构300(步骤S40)。In one embodiment, the control module 200 can control the operation of the motor device 310 to horizontally rotate the discharging mechanism 300 through the movement control module 507 (step S40).
于一实施例中,控制模块200可通过移动控制模块507控制马达装置311运转以调整出料机构300的吐料口的仰角(步骤S41)。In one embodiment, the control module 200 can control the operation of the motor device 311 through the movement control module 507 to adjust the elevation angle of the discharge port of the discharging mechanism 300 (step S41).
于一实施例中,控制模块200可通过移动控制模块507控制马达装置312运转以垂直抬升出料机构300。In one embodiment, the control module 200 can control the operation of the motor device 312 through the movement control module 507 to vertically lift the discharging mechanism 300 .
接着,控制模块200再次执行步骤S204以再次基于电脑视觉判断吐料口是否对准物件的作业位置。Then, the control module 200 executes step S204 again to determine whether the discharge port is aligned with the working position of the object based on computer vision.
若于步骤S204中,判定吐料口已对准物件的作业位置,则控制模块200可通过出料控制模块506控制出料机构300执行出料操作(步骤S206)。If in step S204, it is determined that the discharging port has been aligned with the working position of the object, the control module 200 can control the discharging mechanism 300 to perform the discharging operation through the discharging control module 506 (step S206).
于一实施例中,于出料操作执行的同时或执行完成后,控制模块200可通过加工控制模块508控制材料加工模块214来对提供至作业位置的材料进行加工,以改变材料的状态或性质(如固化或硬化,步骤S207)。In one embodiment, while the discharging operation is being executed or after the execution is completed, the control module 200 can control the material processing module 214 through the processing control module 508 to process the material provided to the working position to change the state or properties of the material. (Such as curing or hardening, step S207).
由此,本发明可实现自动化出料与加工。Thus, the present invention can realize automated discharging and processing.
于一实施例中,于出料操作的同时,控制模块200可通过错误检测模块509基于电脑视觉模块212所拍摄的影像执行检测错误处理,以检测出料操作是否发生错误(步骤S208),如对正向影像与侧向影像执行分析,以判断是否正常出料、吐料口是否偏离作业位置等等。In one embodiment, during the discharging operation, the control module 200 can perform error detection processing based on the image captured by the computer vision module 212 through the error detection module 509 to detect whether an error occurs in the discharging operation (step S208), as shown in Analyze the forward and side images to determine whether the material is discharged normally, whether the discharge port deviates from the operating position, etc.
控制模块200可通过错误检测模块509判断是否检测到任一错误(步骤S209),并于检测到任一错误时,停止出料操作,并通过人机接口202输出错误通知(步骤S210)。The control module 200 can determine whether any error is detected through the error detection module 509 (step S209), and when any error is detected, stop the discharging operation and output an error notification through the human-machine interface 202 (step S210).
借此,本发明可避免加工时的错误(如未正常出料或吐料位置错误)而损坏物件或产生加工瑕疵。In this way, the present invention can avoid errors during processing (such as failure to discharge materials normally or discharging materials at the wrong position) that may cause damage to objects or cause processing defects.
请参阅图10,为本发明的一例子的第二侧向影像的外观示意图。如图10所示的侧向影像(第二侧向影像),其视角是出料机构110的右侧朝作业位置斜向拍摄(如第二侧向照相机321所拍摄),且其视野是涵盖出料机构300的吐料口及物件的作业位置。Please refer to FIG. 10 , which is a schematic view of the appearance of the second side image according to an example of the present invention. As shown in Figure 10, the side image (second side image) is shot obliquely from the right side of the discharging mechanism 110 toward the working position (as shot by the second side camera 321), and its field of view covers The discharge port of the discharging mechanism 300 and the working position of the object.
并且,控制模块200经由电脑视觉对第二侧向影像进行分析后可发现吐料口已偏离物件的作业位置(如印刷电路板的中心),这会使得材料无法正确提供至作业位置。于此情况下,控制模块200可控制出料机构300停止出料操作,并通过人机接口202发出偏离通知,以通知使用者进行人工修正、处理或记录。Moreover, after analyzing the second side image through computer vision, the control module 200 can find that the material discharge port has deviated from the working position of the object (such as the center of the printed circuit board), which will prevent the material from being correctly supplied to the working position. In this case, the control module 200 can control the discharging mechanism 300 to stop the discharging operation, and send a deviation notification through the human-machine interface 202 to notify the user to perform manual correction, processing or recording.
更进一步地,控制模块200还可于检测到错误后,自动重新调整出料机构300的位置来使吐料口对准作业位置,从而省却人工处理。Furthermore, after detecting an error, the control module 200 can automatically readjust the position of the discharging mechanism 300 to align the discharging port with the working position, thereby eliminating manual processing.
于一实施例中,前述出料操作是依序对多个作业位置提供材料,从而实现对多个点或整个区域的材料提供。In one embodiment, the aforementioned discharging operation is to provide materials to multiple working positions in sequence, thereby achieving material supply to multiple points or the entire area.
具体而言,以图2为例,控制模块200可被配置来规划经过多个作业位置的出料移动路径,此出料移动路径包括分别对应多个作业位置的多个马达位址码,如连接水平移动装置313的马达装置310的多个位址(下称水平码)、连接仰角移动装置314的马达装置311的多个位址(下称仰角码)及/或连接垂直移动装置315的马达装置312的多个位址(下称垂直码)。Specifically, taking FIG. 2 as an example, the control module 200 can be configured to plan a discharging movement path through multiple working positions. The discharging moving path includes multiple motor address codes respectively corresponding to multiple working positions, such as A plurality of addresses (hereinafter referred to as horizontal codes) of the motor device 310 connected to the horizontal moving device 313, a plurality of addresses (hereinafter referred to as elevation codes) of the motor device 311 connected to the elevation moving device 314, and/or a plurality of addresses connected to the vertical moving device 315 Multiple addresses of the motor device 312 (hereinafter referred to as vertical codes).
控制模块200更被配置为于执行出料操作时,依据移动路径的多组马达位址码来依序控制对应的马达装置310-312转动来移动连接的移动机构313-315,以于指定的自由度上移动出料机构300。The control module 200 is further configured to sequentially control the rotation of the corresponding motor devices 310-312 to move the connected moving mechanisms 313-315 according to the multiple sets of motor address codes of the moving path when performing the discharging operation, so as to move at the specified location. Move the discharging mechanism 300 with degrees of freedom.
举例来说,控制模块200可依据出料移动路径的多个水平码控制马达装置310推动水平移动机构313来依序水平移动出料机构300的吐料口至多个作业位置并供应材料至各作业位置。For example, the control module 200 can control the motor device 310 to push the horizontal movement mechanism 313 according to multiple horizontal codes of the discharging movement path to sequentially horizontally move the discharging port of the discharging mechanism 300 to multiple operating positions and supply materials to each operation. Location.
于另一例子中,控制模块200可依据出料移动路径的多个仰角码控制马达装置311推动仰角移动机构314来依序于抵达各作业位置时调整吐料口的仰角。In another example, the control module 200 can control the motor device 311 to push the elevation moving mechanism 314 according to multiple elevation codes of the discharging movement path to sequentially adjust the elevation angle of the discharge port when reaching each working position.
于另一例子中,控制模块200可依据出料移动路径的多个垂直码控制马达装置312推动垂直移动机构315来依序于抵达各作业位置时调整吐料口的高度。In another example, the control module 200 can control the motor device 312 to push the vertical movement mechanism 315 according to multiple vertical codes on the discharging movement path to sequentially adjust the height of the discharging opening when reaching each working position.
借此,本发明可实现多点供料或范围供料。Thereby, the present invention can realize multi-point feeding or range feeding.
请参阅,图7为本发明的一例子的出料控制系统的部分外观示意图,用以说明本发明的一种具体实施型态,但并非用限制本发明的保护范围。Please refer to FIG. 7 , which is a partial schematic diagram of the appearance of an example of the discharging control system of the present invention. It is used to illustrate a specific implementation mode of the present invention, but is not intended to limit the scope of protection of the present invention.
于本例子中,出料控制系统是用来对电路印刷版60的焊盘61与元件引脚62进行激光焊接。In this example, the discharging control system is used to laser weld the pads 61 and component pins 62 of the printed circuit board 60 .
水平移动机构313包括水平旋转连接件63与传动件64。马达装置310可通过传动件64(如传动皮带)带动水平旋转连接件63,而实现出料装置300的水平转动。The horizontal movement mechanism 313 includes a horizontal rotation connecting member 63 and a transmission member 64 . The motor device 310 can drive the horizontal rotation connecting member 63 through the transmission member 64 (such as a transmission belt) to realize the horizontal rotation of the discharging device 300.
马达装置311可通过仰角移动机构314调整出料装置300的仰角。The motor device 311 can adjust the elevation angle of the discharging device 300 through the elevation angle moving mechanism 314.
供料机构301(未示于图7)可输入材料(如锡条)至出料机构300,并且,当出料机构300的吐料口朝向作业位置(如焊盘61与元件引脚62之间的缝隙)时,可将材料提供制作业位置。The feeding mechanism 301 (not shown in FIG. 7 ) can input materials (such as tin bars) to the discharging mechanism 300 , and when the discharging port of the discharging mechanism 300 faces the working position (such as between the pad 61 and the component pin 62 When there is a gap between them), the material can be provided to the working position.
正向摄影机322设置在水平旋转连接件63以拍摄吐料口与作业位置的俯瞰影像(正向影像),第一侧向摄影机320设置在仰角移动机构314以拍摄吐料口与作业位置的侧视影像(侧向影像)。The front camera 322 is disposed on the horizontal rotating connector 63 to capture an overhead image (forward image) of the material discharging port and the working position. The first side camera 320 is disposed on the elevation moving mechanism 314 to capture the side view of the material discharging port and the working position. Visual image (lateral image).
高度测量模块213(如激光测距仪)设置于水平旋转连接件63上,而可来测量与焊盘61即或元件引脚62之间的估测高度。The height measurement module 213 (such as a laser range finder) is disposed on the horizontal rotating connector 63 to measure the estimated height with the bonding pad 61 or the component pin 62 .
材料加工模块214(如激光加热模块)设置在水平旋转连接件63中,用来发出强功率激光215以熔化材料65以进行焊接。The material processing module 214 (such as a laser heating module) is disposed in the horizontal rotating connector 63 and is used to emit a high-power laser 215 to melt the material 65 for welding.
于一实施例中,高度测量模块213与材料加工模块214可整合为同一模块,如于发出低功率激光215时进行高度测量,于发出高功率激光215时进行焊接,或者,直接设置两组不同用途的激光发射器。In one embodiment, the height measurement module 213 and the material processing module 214 can be integrated into the same module. For example, height measurement is performed when the low-power laser 215 is emitted, and welding is performed when the high-power laser 215 is emitted. Alternatively, two different sets of modules can be directly configured. laser transmitter.
以上所述仅为本发明的较佳具体实例,非因此即局限本发明的专利范围,故举凡运用本发明内容所为的等效变化,均同理皆包含于本发明的范围内,合予陈明。The above are only preferred specific examples of the present invention, which do not limit the patent scope of the present invention. Therefore, all equivalent changes made by applying the content of the present invention are equally included in the scope of the present invention. Chen Ming.
Claims (10)
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202011292484.3A CN114518727B (en) | 2020-11-18 | 2020-11-18 | Discharge control system and discharging control method |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202011292484.3A CN114518727B (en) | 2020-11-18 | 2020-11-18 | Discharge control system and discharging control method |
Publications (2)
Publication Number | Publication Date |
---|---|
CN114518727A CN114518727A (en) | 2022-05-20 |
CN114518727B true CN114518727B (en) | 2023-09-12 |
Family
ID=81594334
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202011292484.3A Active CN114518727B (en) | 2020-11-18 | 2020-11-18 | Discharge control system and discharging control method |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN114518727B (en) |
Citations (13)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2000167668A (en) * | 1998-12-02 | 2000-06-20 | Komatsu Ltd | Position deviation measurement instrument for welding robot |
CN1714943A (en) * | 2004-06-30 | 2006-01-04 | 优利讯国际贸易有限责任公司 | Apparatus and method for applying adhesive to substrate |
TW201212852A (en) * | 2010-09-21 | 2012-04-01 | Zong Jing Investment Inc | Facial cosmetic machine |
TWI373733B (en) * | 2008-07-11 | 2012-10-01 | Hon Hai Prec Ind Co Ltd | Image inspection and sorting machine |
CN102909548A (en) * | 2012-10-13 | 2013-02-06 | 桂林电子科技大学 | Automatic screw locking method and device |
CN103846192A (en) * | 2014-03-21 | 2014-06-11 | 武汉大学 | Autonomous-positioning type intelligent dispensing system |
CN104422699A (en) * | 2013-09-02 | 2015-03-18 | 上野精机株式会社 | Visual inspection apparatus |
KR101659890B1 (en) * | 2015-03-27 | 2016-09-26 | (주)대명티에스 | Vision system for mastic sealing and vision inspection method for mastic sealer |
CN108031577A (en) * | 2017-12-29 | 2018-05-15 | 福建海源自动化机械股份有限公司 | A kind of automatic glue spreading device and glue rifle automatic alignment method for composite material |
CN109612292A (en) * | 2019-01-15 | 2019-04-12 | 海安艾拉新材料有限公司 | Condensing plant is used in a kind of processing of new material |
CN109982951A (en) * | 2016-10-25 | 2019-07-05 | 瑞科硅公司 | Feeder |
TWI693555B (en) * | 2018-12-17 | 2020-05-11 | 台達電子工業股份有限公司 | Image positioning system based on upsampling and method thereof |
CN111530697A (en) * | 2020-04-01 | 2020-08-14 | 国机智能科技有限公司 | Accurate gluing system and method for three-dimensional curved surface workpiece |
Family Cites Families (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP5927212B2 (en) * | 2014-02-28 | 2016-06-01 | ファナック株式会社 | Welding torch detection device and welding robot system |
-
2020
- 2020-11-18 CN CN202011292484.3A patent/CN114518727B/en active Active
Patent Citations (13)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2000167668A (en) * | 1998-12-02 | 2000-06-20 | Komatsu Ltd | Position deviation measurement instrument for welding robot |
CN1714943A (en) * | 2004-06-30 | 2006-01-04 | 优利讯国际贸易有限责任公司 | Apparatus and method for applying adhesive to substrate |
TWI373733B (en) * | 2008-07-11 | 2012-10-01 | Hon Hai Prec Ind Co Ltd | Image inspection and sorting machine |
TW201212852A (en) * | 2010-09-21 | 2012-04-01 | Zong Jing Investment Inc | Facial cosmetic machine |
CN102909548A (en) * | 2012-10-13 | 2013-02-06 | 桂林电子科技大学 | Automatic screw locking method and device |
CN104422699A (en) * | 2013-09-02 | 2015-03-18 | 上野精机株式会社 | Visual inspection apparatus |
CN103846192A (en) * | 2014-03-21 | 2014-06-11 | 武汉大学 | Autonomous-positioning type intelligent dispensing system |
KR101659890B1 (en) * | 2015-03-27 | 2016-09-26 | (주)대명티에스 | Vision system for mastic sealing and vision inspection method for mastic sealer |
CN109982951A (en) * | 2016-10-25 | 2019-07-05 | 瑞科硅公司 | Feeder |
CN108031577A (en) * | 2017-12-29 | 2018-05-15 | 福建海源自动化机械股份有限公司 | A kind of automatic glue spreading device and glue rifle automatic alignment method for composite material |
TWI693555B (en) * | 2018-12-17 | 2020-05-11 | 台達電子工業股份有限公司 | Image positioning system based on upsampling and method thereof |
CN109612292A (en) * | 2019-01-15 | 2019-04-12 | 海安艾拉新材料有限公司 | Condensing plant is used in a kind of processing of new material |
CN111530697A (en) * | 2020-04-01 | 2020-08-14 | 国机智能科技有限公司 | Accurate gluing system and method for three-dimensional curved surface workpiece |
Also Published As
Publication number | Publication date |
---|---|
CN114518727A (en) | 2022-05-20 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
EP3173194B1 (en) | Manipulator system, image capturing system, transfer method of object, and carrier medium | |
US10308006B2 (en) | Method for calibrating a light of a three-dimensional object generating apparatus | |
CN103846606B (en) | Welding track based on machine vision corrects Special testing device and method | |
CN114248086B (en) | A flexible three-dimensional vision-guided robot alignment system and method | |
CN106003020A (en) | Robot, robot control device, and robotic system | |
JP2009269110A (en) | Assembly equipment | |
JP2016055389A (en) | Article conveyance system | |
CN110815201B (en) | The method of coordinate correction of robot arm | |
US20190149802A1 (en) | Robot and robot system | |
CN105359638A (en) | Part holding-state detection method and part mounting device | |
JP2012230041A (en) | Position detection method, position detector and robot system | |
CN111571308A (en) | On-machine detection device and method for cutter abrasion | |
CN113165188A (en) | Aligning device | |
CN114518727B (en) | Discharge control system and discharging control method | |
TWI812257B (en) | Electronic device assembly device and electronic device assembly method (2) | |
CN111993420A (en) | Fixed binocular vision 3D guide piece feeding system | |
TWI755935B (en) | Discharge control system and discharge control method thereof | |
JP6475165B2 (en) | Mounting device | |
JP5418490B2 (en) | POSITIONING CONTROL DEVICE AND POSITIONING DEVICE HAVING THE SAME | |
CN105704944A (en) | Circuit board transplantation double-sided automatic alignment device | |
TWM600667U (en) | Laser marking system | |
CN108711174B (en) | Approximate parallel vision positioning system for mechanical arm | |
CN205129209U (en) | Automatically, seek mark welding system based on robot welding | |
TWI589904B (en) | Probe card automatic detection and correction methods and devices | |
TW201425959A (en) | Electronic component operation unit having image capturing device and operation equipment using same |
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 |