CN115890636A - Tracking system control method and tracking system - Google Patents
Tracking system control method and tracking system Download PDFInfo
- Publication number
- CN115890636A CN115890636A CN202111166513.6A CN202111166513A CN115890636A CN 115890636 A CN115890636 A CN 115890636A CN 202111166513 A CN202111166513 A CN 202111166513A CN 115890636 A CN115890636 A CN 115890636A
- Authority
- CN
- China
- Prior art keywords
- workpiece
- tracking system
- work
- robot
- trajectory
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Pending
Links
- 238000000034 method Methods 0.000 title claims abstract description 38
- 239000000853 adhesive Substances 0.000 claims description 19
- 230000001070 adhesive effect Effects 0.000 claims description 19
- 238000011144 upstream manufacturing Methods 0.000 claims description 3
- 230000032258 transport Effects 0.000 claims 2
- 238000010586 diagram Methods 0.000 description 14
- 239000012636 effector Substances 0.000 description 9
- 238000000926 separation method Methods 0.000 description 9
- 238000003384 imaging method Methods 0.000 description 8
- 239000011248 coating agent Substances 0.000 description 7
- 238000000576 coating method Methods 0.000 description 7
- 230000001133 acceleration Effects 0.000 description 2
- 238000004364 calculation method Methods 0.000 description 2
- 238000001514 detection method Methods 0.000 description 2
- 230000006870 function Effects 0.000 description 2
- 230000003111 delayed effect Effects 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 238000004519 manufacturing process Methods 0.000 description 1
Images
Landscapes
- Manipulator (AREA)
Abstract
Description
技术领域technical field
本发明涉及跟踪系统的控制方法及跟踪系统。The invention relates to a control method of a tracking system and a tracking system.
背景技术Background technique
在专利文献1中记载了一种跟踪系统,具有输送工件的输送机、拍摄输送机上的工件并检测工件的位置的视觉传感器、以及基于视觉传感器的检测结果来拾取在输送机上输送的工件的机器人。
专利文献1:日本特开2019-141935号公报Patent Document 1: Japanese Patent Laid-Open No. 2019-141935
发明内容Contents of the invention
但是,在专利文献1的跟踪系统中,机器人仅在预定位置拾取在输送机上输送的工件,并没有设想到追随在输送机上输送的工件,即一边与工件一起移动一边对工件进行描绘轨迹的作业。However, in the tracking system of
本发明的跟踪系统的控制方法的特征在于,所述跟踪系统具有一边追随相对移动的工件一边对所述工件进行作业的机器人,对所述机器人相对于所述工件的作业轨迹基于所述机器人与所述工件的相对速度进行校正,所述作业轨迹是使所述相对速度为零而生成的。The tracking system control method according to the present invention is characterized in that the tracking system has a robot that performs work on the workpiece while following the relatively moving workpiece, and the operating trajectory of the robot relative to the workpiece is based on the relationship between the robot and the workpiece. The relative velocity of the workpiece is corrected, and the work trajectory is generated by making the relative velocity zero.
本发明的跟踪系统的特征在于,具有:机器人,一边追随相对移动的工件一边对所述工件进行作业;以及控制装置,对所述机器人相对于所述工件的作业轨迹基于所述机器人与所述工件的相对速度进行校正,所述作业轨迹是使所述相对速度为零而生成的。The tracking system of the present invention is characterized in that it includes: a robot that works on the workpiece while following the relatively moving workpiece; The relative speed of the workpiece is corrected, and the work trajectory is generated by making the relative speed zero.
附图说明Description of drawings
图1是示出第一实施方式的跟踪系统的整体结构图。FIG. 1 is an overall configuration diagram showing a tracking system according to a first embodiment.
图2是示出机器人的图。FIG. 2 is a diagram showing a robot.
图3是示出作业轨迹的一例的图。FIG. 3 is a diagram illustrating an example of a work trajectory.
图4是用于说明跟踪系统的控制方法的流程图。FIG. 4 is a flowchart for explaining a method of controlling the tracking system.
图5是示出二次校正作业轨迹的图。FIG. 5 is a diagram showing a secondary correction work trajectory.
图6是示出计算二次校正作业轨迹的方法的图。FIG. 6 is a diagram illustrating a method of calculating a secondary correction work trajectory.
图7是用于说明作业轨迹的起始点变更的图。FIG. 7 is a diagram for explaining the change of the starting point of the work trajectory.
图8是示出第二实施方式的跟踪系统的整体结构图。FIG. 8 is an overall configuration diagram showing a tracking system of a second embodiment.
附图标记说明Explanation of reference signs
100…跟踪系统;200…机器人;210…基座;220…机械臂;221…第一臂;222…第二臂;230…作业头;231…花键螺母;232…滚珠丝杠螺母;233…花键轴;240…末端执行器;271…第一驱动装置;272…第二驱动装置;273…第三驱动装置;274…第四驱动装置;290…移动机构;300…拍摄装置;400…控制装置;500…载置台;600…输送装置;620…带;630…输送辊;640…输送量传感器;A…输送方向;B…粘接剂;Ec…拍摄区域;Er…作业区域;G…图像;J1…第一转动轴;J2…第二转动轴;J3…第三转动轴;L…长度;Lx…分离距离;Ly…分离距离;M…作业轨迹;M1…一次校正作业轨迹;M2…二次校正作业轨迹;P1…作业点;P1’…作业点;P2…作业点;P2’…作业点;P3…作业点;P4…作业点;P5…作业点;P6…作业点;P7…作业点;P8…作业点;P9…作业点;P10…作业点;P11…作业点;P11’…作业点;S1…必要信息获取步骤;S2…图像获取步骤;S3…轨迹校正步骤;S4…作业步骤;t…移动时间;W…工件;Wn…工件;Wn+1…工件。100…tracking system; 200…robot; 210…base; 220…mechanical arm; 221…first arm; 222…second arm; 230…working head; 231…spline nut; 232…ball screw nut; 233 …spline shaft; 240…end effector; 271…first driving device; 272…second driving device; 273…third driving device; 274…fourth driving device; 290…moving mechanism; 300…shooting device; 400 ...control device; 500...carrying table; 600...conveying device; 620...belt; 630...conveying roller; 640...transporting sensor; A...conveying direction; B...adhesive; Ec...shooting area; Er...working area; G…image; J1…first rotation axis; J2…second rotation axis; J3…third rotation axis; L…length; Lx…separation distance; Ly…separation distance; M…operation track; M1…one-time calibration operation track ;M2...secondary calibration operation track; P1...operation point; P1'...operation point; P2...operation point; P2'...operation point; P3...operation point; P4...operation point; P5...operation point; P6...operation point ;P7...operation point; P8...operation point; P9...operation point; P10...operation point; P11...operation point; P11'...operation point; S1...necessary information acquisition step; S2...image acquisition step; ; S4...operation step; t...moving time; W...workpiece; Wn...workpiece; Wn+1...workpiece.
具体实施方式Detailed ways
下面参照附图对跟踪系统的控制方法及跟踪系统的优选实施方式进行说明。需要说明的是,下文中将相互正交的方向设为X轴、Y轴及Z轴,Z轴是沿垂直方向的轴。另外,将沿X轴的方向称为“X轴方向”,将沿Y轴的方向称为“Y轴方向”,将沿Z轴的方向称为“Z轴方向”。The control method of the tracking system and preferred implementations of the tracking system will be described below with reference to the accompanying drawings. It should be noted that, hereinafter, mutually orthogonal directions are referred to as an X axis, a Y axis, and a Z axis, and the Z axis is an axis along a vertical direction. In addition, the direction along the X-axis is called "X-axis direction", the direction along the Y-axis is called "Y-axis direction", and the direction along the Z-axis is called "Z-axis direction".
第一实施方式first embodiment
图1是示出第一实施方式的跟踪系统的整体结构图。图2是示出机器人的图。图3是示出作业轨迹的一例的图。图4是用于说明跟踪系统的控制方法的流程图。图5是示出二次校正作业轨迹的图。图6是示出计算二次校正作业轨迹的方法的图。图7是用于说明作业轨迹的起始点变更的图。FIG. 1 is an overall configuration diagram showing a tracking system according to a first embodiment. FIG. 2 is a diagram showing a robot. FIG. 3 is a diagram illustrating an example of a work trajectory. FIG. 4 is a flowchart for explaining a method of controlling the tracking system. FIG. 5 is a diagram showing a secondary correction work trajectory. FIG. 6 is a diagram illustrating a method of calculating a secondary correction work trajectory. FIG. 7 is a diagram for explaining the change of the starting point of the work trajectory.
图1所示的跟踪系统100具有机器人200、拍摄装置300、控制装置400和输送装置600。在跟踪系统100中,输送装置600沿着输送方向A输送工件W,该输送方向A沿着水平方向,控制装置400基于由拍摄装置300获取的图像G检测工件W的输送状况,机器人200基于工件W的输送状况一边追随输送中的工件W一边对工件W进行作业。The
作为工件W及对工件W进行的作业,并无特别限定,在本实施方式中,工件W是鞋子大底(鞋外底,outsole),对工件W进行的作业是在工件W上涂敷用于粘接鞋帮(upper)的粘接剂B的作业。即,本实施方式的跟踪系统100是作为鞋的制造装置的一部分发挥功能的系统。通过这样的工件W及作业,能够有效地利用跟踪系统100。There are no particular limitations on the workpiece W and the work performed on the workpiece W. In this embodiment, the workpiece W is a shoe outsole (outsole), and the work performed on the workpiece W is for coating on the workpiece W. It is used to bond the adhesive B of the shoe upper (upper). That is, the
机器人200
如图2所示,机器人200是SCARA机器人(水平多关节机器人)。机器人200具有固定在地面上的基座210和与基座210连接的机械臂220。机械臂220具有:第一臂221,基端部与基座210连接,相对于基座210绕沿垂直方向的第一转动轴J1转动;以及第二臂222,基端部与第一臂221的前端部连接,相对于第一臂221绕沿垂直方向的第二转动轴J2转动。As shown in FIG. 2, the
另外,在第二臂222的前端部设置有作业头230。作业头230具有:花键螺母231及滚珠丝杠螺母232,同轴地配置在第二臂222的前端部;以及花键轴233,插通花键螺母231及滚珠丝杠螺母232。花键轴233能够相对于第二臂222绕沿垂直方向的第三转动轴J3旋转,并且能够沿第三转动轴J3升降。In addition, a working
另外,在花键轴233的下端部安装有末端执行器240。末端执行器240适当选择装卸自如且适合于目标作业的末端执行器。本实施方式的末端执行器240是从其下端喷出粘接剂B的分配器。In addition, an
另外,机器人200具有:第一驱动装置271,使第一臂221相对于基座210绕第一转动轴J1转动;第二驱动装置272,使第二臂222相对于第一臂221绕第二转动轴J2转动;第三驱动装置273,使花键螺母231旋转而使花键轴233绕第三转动轴J3旋转;以及第四驱动装置274,使滚珠丝杠螺母232旋转而使花键轴233在沿着第三转动轴J3的方向上升降。In addition, the
另外,在第一、第二、第三、第四驱动装置271、272、273、274中分别设置有作为驱动源的电机和检测电机的旋转量的编码器。在跟踪系统100运行时,控制装置400执行使各编码器的输出所表示的机械臂220的位置与作为控制目标的目标位置一致的反馈控制。由此,能够使机器人200执行预定的作业。In addition, the first, second, third, and
以上对机器人200进行了说明,但作为机器人200,并无特别限定,例如也可以是具备具有六个旋转轴的机械臂的六轴机器人。The
输送装置600
输送装置600是带式输送机,如图1所示,具有带620、输送带620的输送辊630、驱动输送辊630的未图示的电机、以及将与输送辊630的旋转量相应的信号输出到控制装置400的输送量传感器640。输送量传感器640例如是编码器。在跟踪系统100运行时,控制装置400执行使输送量传感器640的输出所表示的工件W的输送速度与作为控制目标的目标输送速度一致的反馈控制。由此,能够以期望的速度稳定地输送工件W。The
拍摄装置300
拍摄装置300是照相机,从输送装置600的上方拍摄工件W,将拍摄的图像G输出到控制装置400。拍摄装置300的拍摄区域Ec位于比机器人200的作业区域Er更靠向输送方向A的上游侧的位置。如图1中的虚线所示,拍摄装置300具有包括在带620上输送的工件W的视场角。从拍摄装置300输出的图像G中的位置通过控制装置400与输送路径中的位置建立关联。因此,在拍摄装置300的视场角内存在工件W的情况下,控制装置400能够基于图像G内的工件W的位置来确定工件W的坐标(位置)。另外,控制装置400例如也可以通过对预先存储的多个模板和图像G内的工件W的轮廓形状进行比较的模板匹配来确定工件W的姿态。但是,对确定工件W的位置及姿态的方法并无特别限定。The
控制装置400
如图1所示,控制装置400分别控制机器人200、拍摄装置300及输送装置600的驱动。这样的控制装置400例如由计算机构成,具有处理信息的处理器(CPU)、以可通信的方式与处理器连接的存储器、以及进行与外部装置的连接的外部接口。存储器中保存有处理器能够执行的各种程序,处理器能够读入并执行存储器中存储的各种程序等。需要说明的是,控制装置400的构成要素的一部分或全部也可以配置在机器人200的壳体的内侧。另外,控制装置400也可以由多个处理器构成。As shown in FIG. 1 , the
以上对跟踪系统100的整体结构进行了简单说明。接下来,基于图4所示的流程图对跟踪系统100的控制方法进行说明。如图4所示,跟踪系统100的控制方法包括必要信息获取步骤S1、图像获取步骤S2、轨迹校正步骤S3和作业步骤S4。The overall structure of the
必要信息获取步骤S1Necessary information acquisition step S1
必要信息获取步骤S1在开始对工件W进行粘接剂涂敷作业之前进行,例如从未图示的主计算机获取该作业所需的各种信息。作为各种信息,并无特别限定,例如包括用于检测输送装置600上的工件W的姿态的模板匹配所需的工件W的CAD数据、规定了涂敷粘接剂B时的机器人200的动作(特别是末端执行器240的动作)的作业轨迹M等。The necessary information acquisition step S1 is performed before starting the adhesive coating operation on the workpiece W, and various information necessary for the operation is acquired, for example, from a host computer (not shown). Various types of information are not particularly limited, and include, for example, CAD data of the workpiece W necessary for template matching to detect the posture of the workpiece W on the
假设机器人200和工件W都静止的状态,即它们的相对速度为0(零)的状态而生成作业轨迹M。如图4所示,本实施方式的作业轨迹M为末端执行器240绕工件W的外缘部一周的轨迹。另外,作业轨迹M具有沿着配置成预定的姿态及位置(以下也称为“基准位置姿态Q0”)的工件W的外缘配置的多个作业点P1、P2、P3、P4、P5、P6、P7、P8、P9、P10、P11,相邻的作业点之间分别用直线相连。因此,作业轨迹M成为比较简单的轨迹,粘接剂涂敷作业的成品率得到提高,并且能够实现机器人200的长寿命化。另外,在作业轨迹M中,作业点P1、P11是相同的坐标,作业点P1为开始作业的起始点,作业点P11为结束作业的结束点。The work trajectory M is generated assuming that both the
需要说明的是,各作业点P1~P11的位置例如能够基于对机器人200设定的机器人坐标系来确定。另外,各作业点P1~P11的机器人坐标是三维坐标(xn、yn、zn),除了水平方向的x坐标及y坐标之外,还包括垂直方向即工件W的高度方向的坐标。另外,在各作业点P1~P11,以工件W与末端执行器240的分离距离相等的方式生成作业轨迹M。由此,在作业轨迹M的整个区域上粘接剂B的涂敷量变得均匀,能够进行高精度的作业。In addition, the position of each work point P1-P11 can be specified based on the robot coordinate system set to the
图像获取步骤S2Image acquisition step S2
当以恒速驱动输送装置600而开始由输送装置600输送工件W时,控制装置400在工件W通过拍摄区域Ec的期间,通过拍摄装置300以预定的帧频连续拍摄工件W,获取拍摄了工件W的多个图像G。接着,控制装置400根据所获取的各图像G求出各时刻的工件W的坐标,并基于求出的坐标检测工件W的输送速度Vw。根据这样的方法,能够容易且高精度地检测输送速度Vw。这里,如上所述,机器人200固定在地面等,因此输送速度Vw相当于机器人200与工件W的相对速度。When the conveying
需要说明的是,在通过输送装置600连续输送多个工件W时,可以对所有的工件W检测输送速度Vw,也可以不检测输送速度Vw。由于输送装置600以恒速驱动,因此也可以仅检测最初的工件W的输送速度Vw,将检测出的输送速度Vw用作之后的工件W的输送速度Vw使用。另外,也能够以预定时间间隔、预定工件数量的间隔(每隔预定数量的工件)来更新输送速度Vw。另外,对输送速度Vw的检测方法并无特别限定,例如,能够基于从输送装置600具备的输送量传感器640输出的信号来检测输送速度Vw。根据这样的方法,也能够容易且高精度地检测输送速度Vw。It should be noted that, when a plurality of workpieces W are continuously conveyed by the conveying
另外,控制装置400使用至少一个图像G,通过对映在该图像G中的工件W的轮廓和预先存储的上述CAD数据进行比较的模板匹配来检测工件W的姿态。由此,得到与工件W的位置及姿态(以下也称为“位置姿态”)相关的信息。In addition, the
轨迹校正步骤S3Trajectory correction step S3
在轨迹校正步骤S3中,控制装置400首先基于在图像获取步骤S2中得到的工件W的位置姿态(以下也称为“实际的位置姿态Q1”)对作业轨迹M进行校正。即,控制装置400检测基准位置姿态Q0与实际的位置姿态Q1的偏离,根据检测出的偏离对作业轨迹M进行校正。以下将该校正后的作业轨迹M称为一次校正作业轨迹M1。In the trajectory correction step S3, the
接着,控制装置400基于在图像获取步骤S2中得到的工件W的输送速度Vw,对一次校正作业轨迹M1进行校正。如上所述,由于一次校正作业轨迹M1是假设机器人200和工件W都静止的状态而生成的,因此对于正在以输送速度Vw输送的工件W,即使沿一次校正作业轨迹M1驱动机器人200,也不能沿工件W的外缘涂敷粘接剂B。即,不能适当地进行粘接剂涂敷作业。因此,为了对输送中的工件W也能够适当地进行粘接剂涂敷作业,需要基于输送速度Vw,即工件W与机器人200的相对速度来对一次校正作业轨迹M1进行校正。以下将该校正后的一次校正作业轨迹M1称为二次校正作业轨迹M2。Next, the
如图5所示,二次校正作业轨迹M2的作业点P1(以下也称为“作业点P1’”)是与一次校正作业轨迹M1的作业点P1相同的坐标。与此相对,二次校正作业轨迹M2的作业点P2(以下也称为“作业点P2’”)相对于一次校正作业轨迹M1的作业点P2,与从作业点P1到作业点P2的机器人200的移动时间的量相应地,向输送方向A的下游侧偏离。因此,将作业点P1’和作业点P2’相连的直线为校正后的轨迹。As shown in FIG. 5 , the working point P1 of the secondary calibration work trajectory M2 (hereinafter also referred to as "working point P1'") has the same coordinates as the working point P1 of the primary calibration work trajectory M1. On the other hand, the work point P2 of the secondary correction work trajectory M2 (hereinafter also referred to as "work point P2'") is different from the work point P2 of the primary correction work trajectory M1 from the work point P1 to the work point P2. The amount of moving time of is deviated to the downstream side of the transport direction A accordingly. Therefore, the straight line connecting the working point P1' and the working point P2' is the corrected trajectory.
这里,关于作业点P2’的坐标的计算方法,示出一个示例。如图6所示,在将作业点P1与作业点P2的X轴方向(输送方向A)上的分离距离设为Lx,将Y轴方向的分离距离设为Ly,将从作业点P1到作业点P2的机器人200的移动时间设为t,将连接作业点P1’和作业点P2’的直线(校正的轨迹)的长度设为L时,它们成为下述式(1)的关系。Here, an example of the calculation method of the coordinates of the work point P2' is shown. As shown in Figure 6, set the separation distance between the operation point P1 and the operation point P2 in the X-axis direction (transportation direction A) as Lx, set the separation distance in the Y-axis direction as Ly, and set the distance from the operation point P1 to the operation When the movement time of the
式1
另外,在假设机器人200进行理想动作的情况下,长度L如下述式(2)所示,可以使用移动时间t来表示。需要说明的是,在式(2)中,Vrb是机器人200的匀速时的速度,a+是机器人200的加速时的加速度,a-是机器人200的减速时的加速度。In addition, assuming that the
式2Formula 2
另外,通过根据上述式(1)、(2)设定下述的等式(3),能够求出移动时间t,并基于求出的移动时间t计算出作业点P2’。Also, by setting the following equation (3) based on the above equations (1) and (2), the travel time t can be obtained, and the work point P2' can be calculated based on the obtained travel time t.
式3Formula 3
以上对作业点P2’的计算方法进行了说明,对剩余的作业点P3~P11也同样地进行校正。即,二次校正作业轨迹M2的作业点P3(以下也称为“作业点P3’”)相对于一次校正作业轨迹M1的作业点P3,与从作业点P1到作业点P3的机器人200的移动时间的量相应地,向输送方向A的下游侧偏离。因此,将作业点P2’和作业点P3’相连的直线为校正后的轨迹。二次校正作业轨迹M2的作业点P4(以下也称为“作业点P4’”)相对于一次校正作业轨迹M1的作业点P4,与从作业点P1到作业点P4的机器人200的移动时间的量相应地,向输送方向A的下游侧偏离。因此,将作业点P3’和作业点P4’相连的直线为校正后的轨迹。作业点P5’及其之后也是同样的。The calculation method of the working point P2' has been described above, and the remaining working points P3 to P11 are also corrected in the same manner. That is, the working point P3 of the secondary correction work trajectory M2 (hereinafter also referred to as "work point P3'") is related to the movement of the
在以上的轨迹校正步骤S3中,对作业轨迹M进行校正而生成一次校正作业轨迹M1,进而对一次校正作业轨迹M1进行校正而生成二次校正作业轨迹M2,但并不限于此,也可以同时进行一次校正和二次校正,根据作业轨迹M直接生成二次校正作业轨迹M2。In the above trajectory correction step S3, the operation trajectory M is corrected to generate the primary correction operation trajectory M1, and then the primary correction operation trajectory M1 is corrected to generate the secondary correction operation trajectory M2, but it is not limited to this, and can also be simultaneously The primary correction and the secondary correction are performed, and the secondary correction operation trajectory M2 is directly generated according to the operation trajectory M.
在这样生成了二次校正作业轨迹M2之后,控制装置400判断作为二次校正作业轨迹M2的结束点的作业点P11’是否位于机器人200的作业区域Er内。假如作业点P11’位于作业区域Er外,则此时机器人200不能完成粘接剂涂敷作业。因此,控制装置400向用户通知该情况,使输送速度Vw变慢,以使作业点P11’包括在作业区域Er中。或者,提醒用户使输送速度Vw变慢。由此,能够在作业区域Er内可靠地完成粘接剂涂敷作业。After the secondary correction work trajectory M2 is generated in this way, the
作业步骤S4Job step S4
在作业步骤S4中,基于在轨迹校正步骤S3中得到的二次校正作业轨迹M2驱动机器人200,同时从末端执行器240喷出粘接剂B,由此一边追随工件W一边进行粘接剂涂敷作业。由此,粘接剂B沿工件W的外缘涂敷,高精度地完成预想的作业。In the work step S4, the
控制装置400对连续输送的多个工件W依次进行如上所述的步骤S1~S4。这里,也可以考虑到相对于第n个输送的工件Wn,第n+1个输送的工件Wn+1的位置姿态不同的情况。在这种情况下,对于针对工件Wn+1的二次校正作业轨迹M2,也可以从作业点P1变更起始点。The
当机器人200完成对工件Wn的粘接剂涂敷作业时,机器人200需要移动到工件Wn+1的起始点。因此,在这种情况下,作为工件Wn的结束点的作业点P11’与作为工件Wn+1的起始点的作业点P1’(=一次校正作业轨迹M1的作业点P1)的分离距离变大,对工件Wn+1的作业开始时刻延迟,也有可能难以在作业区域Er内完成粘接剂涂敷作业。When the
因此,在工件Wn+1相对于工件Wn的位置姿态不同的情况下,控制装置400能够检测工件Wn+1的一次校正作业轨迹M1的作业点P1~P11中,与工件Wn的作业点P11’的分离距离比工件Wn的作业点P11’与工件Wn+1的作业点P1的分离距离小的作业点,更优选检测与工件Wn的作业点P11’的分离距离最小的作业点,并将该作业点设定为工件Wn+1的起始点。在图7所示的结构中,能够将作业点P5设定为工件Wn+1的起始点。根据这样的控制方法,从对工件Wn的作业完成起到开始对工件Wn+1进行作业的时间变短,能够有效地抑制对工件Wn+1的作业开始时刻的延迟。Therefore, when the position and posture of the workpiece Wn+1 relative to the workpiece Wn are different, the
以上对跟踪系统100及其控制方法进行了说明。如上所述,这种跟踪系统100的控制方法中,跟踪系统100具有一边追随相对移动的工件W一边对工件W进行作业的机器人200,对使机器人200与工件W的相对速度即工件的输送速度Vw为0(零)而生成的机器人200相对于工件W的作业轨迹M,基于输送速度Vw进行校正。根据这样的控制方法,对相对移动的工件W也能够进行期望的作业。The
另外,如上所述,在跟踪系统100的控制方法中,通过输送装置600输送工件W。由此,成为结构更简单的跟踪系统100。In addition, as described above, in the control method of the
另外,如上所述,在跟踪系统100的控制方法中,在比机器人200的作业区域Er更靠向工件W的输送方向A上游侧的位置,拍摄包括工件W的图像G,并基于图像G检测相对速度即工件W的输送速度Vw。由此,能够高精度地检测输送速度Vw。In addition, as described above, in the control method of the
另外,如上所述,在跟踪系统100的控制方法中,基于图像G检测工件W的位置及姿态。由此,能够更可靠地对工件W进行作业。In addition, as described above, in the control method of the
另外,如上所述,在跟踪系统100的控制方法中,根据工件W的姿态来变更作业轨迹M的起始点。由此,能够缩短从对工件Wn的作业完成起到开始对工件Wn+1进行作业的时间,能够有效地抑制对工件Wn+1的作业开始时刻的延迟。In addition, as described above, in the control method of the
另外,如上所述,在跟踪系统100的控制方法中,也可以基于来自输送装置600具备的输送量传感器640的信号来检测工件W的输送速度Vw。由此,能够高精度地检测输送速度Vw。In addition, as described above, in the control method of the
另外,如上所述,作业是对工件W涂敷粘接剂。由此,能够有效地利用跟踪系统100的控制方法。In addition, as described above, the work is to apply an adhesive to the workpiece W. FIG. Thereby, the control method of the
另外,如上所述,工件W是鞋底。由此,能够有效地利用跟踪系统100的控制方法。In addition, as described above, the workpiece W is a shoe sole. Thereby, the control method of the
另外,如上所述,在作业轨迹M中包括与工件W的输送方向A正交的高度信息即z轴坐标。由此,对工件W这样的立体物也能够进行高精度的作业。In addition, as described above, the work trajectory M includes z-axis coordinates that are height information perpendicular to the conveyance direction A of the workpiece W. As shown in FIG. Accordingly, high-precision work can be performed on a three-dimensional object such as the workpiece W as well.
另外,如上所述,作业轨迹M由连续的直线构成。由此,作业轨迹M成为比较简单的轨迹,因此作业的成品率得到提高,并且能够实现机器人200的长寿命化。In addition, as described above, the work trajectory M is composed of continuous straight lines. Thus, the work trajectory M becomes a relatively simple trajectory, so that the yield of the work is improved and the life of the
另外,如上所述,跟踪系统100具有:机器人200,一边追随相对移动的工件W一边对工件W进行作业;以及控制装置400,对使相对速度即工件W的输送速度Vw为0(零)而生成的机器人200相对于工件W的作业轨迹M,基于输送速度Vw进行校正。根据这样的构成,对相对移动的工件W也能够进行期望的作业。In addition, as described above, the
另外,如上所述,跟踪系统100具有输送工件W的输送装置600。由此,成为结构更简单的跟踪系统100。In addition, the
第二实施方式second embodiment
图8是示出第二实施方式的跟踪系统的整体结构图。FIG. 8 is an overall configuration diagram showing a tracking system of a second embodiment.
本实施方式的跟踪系统100除了机器人200一边相对于静止的工件W移动一边对工件W进行作业以外,与上述第一实施方式的跟踪系统100相同。因此,在以下的说明中,关于本实施方式,以与上述第一实施方式的不同点为中心进行说明,关于相同的事项则省略其说明。另外,在本实施方式的各图中,对与上述实施方式相同的构成标注相同的附图标记。The
如图8所示,在本实施方式的跟踪系统100中,省略了输送装置600,各工件W载置于载置台500上并静止。与此相对,机器人200具有移动机构290,机器人200一边移动一边对载置台500上的各工件W连续地进行追随作业。即,在本实施方式中,机器人200与工件W的相对速度意味着机器人200的移动速度。As shown in FIG. 8 , in the
需要说明的是,作为具有移动机构290的机器人200,并无特别限定,例如可以使用自动输送车(AGV)、自主行进输送机器人(AMR)等。另外,例如也可以是能够在导轨上移动的机器人。It should be noted that the
根据上述第二实施方式,也能够发挥与上述第一实施方式相同的效果。Also according to the second embodiment described above, the same effects as those of the first embodiment described above can be exhibited.
以上基于图示的实施方式对本发明的跟踪系统的控制方法及跟踪系统进行了说明,但本发明并不限于此,各部分的构成可以替换为具有同样功能的任意构成。另外,也可以在本发明中附加其他任意构成物。另外,也可以适当组合各实施方式。The control method of the tracking system and the tracking system of the present invention have been described above based on the illustrated embodiments, but the present invention is not limited thereto, and the configuration of each part can be replaced with any configuration having the same function. In addition, other arbitrary components may be added to the present invention. In addition, the respective embodiments may be appropriately combined.
Claims (13)
Priority Applications (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202111166513.6A CN115890636A (en) | 2021-09-30 | 2021-09-30 | Tracking system control method and tracking system |
JP2021173682A JP2023051620A (en) | 2021-09-30 | 2021-10-25 | Tracking system control method and tracking system |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202111166513.6A CN115890636A (en) | 2021-09-30 | 2021-09-30 | Tracking system control method and tracking system |
Publications (1)
Publication Number | Publication Date |
---|---|
CN115890636A true CN115890636A (en) | 2023-04-04 |
Family
ID=85735666
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202111166513.6A Pending CN115890636A (en) | 2021-09-30 | 2021-09-30 | Tracking system control method and tracking system |
Country Status (2)
Country | Link |
---|---|
JP (1) | JP2023051620A (en) |
CN (1) | CN115890636A (en) |
Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US5727132A (en) * | 1994-08-25 | 1998-03-10 | Faunc Ltd. | Robot controlling method for tracking a moving object using a visual sensor |
JP2009028818A (en) * | 2007-07-25 | 2009-02-12 | Panasonic Electric Works Co Ltd | Robot system |
CN107618030A (en) * | 2016-07-16 | 2018-01-23 | 深圳市得意自动化科技有限公司 | The Robotic Dynamic tracking grasping means of view-based access control model and system |
WO2018091411A1 (en) * | 2016-11-15 | 2018-05-24 | Kuka Roboter Gmbh | Method and robot control system for creating a path of a robot |
CN109108959A (en) * | 2017-06-26 | 2019-01-01 | 发那科株式会社 | Robot system |
CN111347423A (en) * | 2020-01-19 | 2020-06-30 | 天津大学 | Dynamic tracking gluing method for industrial robot conveyor belt |
CN112835324A (en) * | 2019-11-22 | 2021-05-25 | Smc 株式会社 | Trajectory control device |
Family Cites Families (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPS63191591A (en) * | 1987-01-30 | 1988-08-09 | 株式会社東芝 | Follow-up controller |
WO2015025398A1 (en) * | 2013-08-22 | 2015-02-26 | 株式会社アシックス | Article production system, article production method, and pallet |
DE102014006651A1 (en) * | 2014-05-07 | 2015-11-12 | Dürr Systems GmbH | Coating system for coating components, in particular for painting motor vehicle body components |
JP6259796B2 (en) * | 2015-10-09 | 2018-01-10 | 紀州技研工業株式会社 | Printing method and printing apparatus |
JP6906404B2 (en) * | 2017-09-08 | 2021-07-21 | 株式会社安川電機 | Manufacturing method for robot systems, robot control devices and workpieces |
JP6963748B2 (en) * | 2017-11-24 | 2021-11-10 | 株式会社安川電機 | Robot system and robot system control method |
JP6836606B2 (en) * | 2018-04-24 | 2021-03-03 | ファナック株式会社 | Robot control and system |
KR102048160B1 (en) * | 2018-11-21 | 2019-11-22 | 한국로봇융합연구원 | Robot control device for adhesives spraying of an outsole and method thereof |
JP7489984B2 (en) * | 2018-12-19 | 2024-05-24 | スリーエム イノベイティブ プロパティズ カンパニー | AUTOMATED COATING SYSTEM HAVING SMART END EFFECTOR TOOLS - Patent application |
-
2021
- 2021-09-30 CN CN202111166513.6A patent/CN115890636A/en active Pending
- 2021-10-25 JP JP2021173682A patent/JP2023051620A/en not_active Withdrawn
Patent Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US5727132A (en) * | 1994-08-25 | 1998-03-10 | Faunc Ltd. | Robot controlling method for tracking a moving object using a visual sensor |
JP2009028818A (en) * | 2007-07-25 | 2009-02-12 | Panasonic Electric Works Co Ltd | Robot system |
CN107618030A (en) * | 2016-07-16 | 2018-01-23 | 深圳市得意自动化科技有限公司 | The Robotic Dynamic tracking grasping means of view-based access control model and system |
WO2018091411A1 (en) * | 2016-11-15 | 2018-05-24 | Kuka Roboter Gmbh | Method and robot control system for creating a path of a robot |
CN109108959A (en) * | 2017-06-26 | 2019-01-01 | 发那科株式会社 | Robot system |
CN112835324A (en) * | 2019-11-22 | 2021-05-25 | Smc 株式会社 | Trajectory control device |
CN111347423A (en) * | 2020-01-19 | 2020-06-30 | 天津大学 | Dynamic tracking gluing method for industrial robot conveyor belt |
Non-Patent Citations (1)
Title |
---|
刘凌云;罗敏;方凯;: "面向粗定位工件的涂胶机器人系统设计与实现", 组合机床与自动化加工技术, no. 01, 20 January 2013 (2013-01-20), pages 82 - 84 * |
Also Published As
Publication number | Publication date |
---|---|
JP2023051620A (en) | 2023-04-11 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN108214454B (en) | Robot system, robot control device, and robot control method | |
JP6646026B2 (en) | Work system, work execution method for article, and robot | |
JP5561260B2 (en) | Robot system and imaging method | |
EP3354418B1 (en) | Robot control method and device | |
WO2015079740A1 (en) | Robot system and robot system control method | |
EP2894012B1 (en) | Work device | |
CN110385695B (en) | Working robot system and working robot | |
US11679508B2 (en) | Robot device controller for controlling position of robot | |
JP6608977B2 (en) | Article transport system | |
JP2016147330A (en) | Control apparatus based on object recognition | |
US11161239B2 (en) | Work robot system and work robot | |
JP4303411B2 (en) | Tracking method and tracking system | |
TW202247966A (en) | production system | |
CN114434438B (en) | Robot control method and robot system | |
US20190381657A1 (en) | Robot system and robot | |
CN115890636A (en) | Tracking system control method and tracking system | |
JP5353718B2 (en) | Control device, robot, robot system, and robot tracking control method | |
US12226915B2 (en) | Belt conveyor calibration method, robot control method, and robot system | |
JP2021045835A (en) | Robot system | |
CN115605329A (en) | Follow-up robot | |
JP2011041986A (en) | Nozzle-suction type object carrying device and method, and program used for the same | |
CN114800484B (en) | Control method of robot system and robot system | |
JP2019214122A (en) | Work system | |
JP2024000289A (en) | Control method and control device of robot system | |
WO2025079271A1 (en) | System for performing work on object and method for calculating reference position |
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 |