CN103419198B - 机器人程序变更装置 - Google Patents
机器人程序变更装置 Download PDFInfo
- Publication number
- CN103419198B CN103419198B CN201310194262.1A CN201310194262A CN103419198B CN 103419198 B CN103419198 B CN 103419198B CN 201310194262 A CN201310194262 A CN 201310194262A CN 103419198 B CN103419198 B CN 103419198B
- Authority
- CN
- China
- Prior art keywords
- mentioned
- taught point
- change
- robot
- initial
- 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
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1628—Programme controls characterised by the control loop
- B25J9/1651—Programme controls characterised by the control loop acceleration, rate control
-
- 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/42—Recording and playback systems, i.e. in which the programme is recorded from a cycle of operations, e.g. the cycle of operations being manually controlled, after which this record is played back on the same machine
- G05B19/425—Teaching successive positions by numerical control, i.e. commands being entered to control the positioning servo of the tool head or end effector
-
- 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/36—Nc in input of data, input key till input tape
- G05B2219/36462—Minimize teach time, compress data, many points in curve, few in line
-
- 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/36—Nc in input of data, input key till input tape
- G05B2219/36492—Record position and orientation, posture of probe, tool
-
- 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/40—Robotics, robotics mapping to robotics vision
- G05B2219/40387—Modify without repeating teaching operation
Landscapes
- Engineering & Computer Science (AREA)
- Robotics (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Mechanical Engineering (AREA)
- Numerical Control (AREA)
- Manipulator (AREA)
Abstract
本发明提供一种机器人程序变更装置(10),其包含:顺序改换部(23),用于改换多个示教点的示教顺序,使得和按照初始示教点的初始示教顺序使机器人(15)移动的情况相比,机器人的移动时间的合计变小;计算部(25),用于计算通过模拟执行改换后动作程序时的机器人的轨迹以及初始示教点之间的偏离量;位置调整部(26),用于在偏离量成为预定的允许值以下之前,进行改换后动作程序的示教点的位置调整;和示教点变更部(27),用于在包含调整后的示教点的改换后动作程序的周期时间比初始周期时间长的情况下,把调整后的示教点变更为初始示教点,采用初始示教顺序。
Description
技术领域
本发明涉及为使机器人进行希望的动作而变更机器人的动作程序的机器人程序变更装置。
背景技术
一般,离线制作的机器人的动作程序,几乎不会原样不变地在现场使用,而在修正后使用。这是因为在离线的世界和在线(现场)的世界之间,工件和机器人的相对的位置关系或者机器人的姿势等微妙地不同、产生偏离的缘故。
如在日本特开2007-54942公报中记载的那样,通过模拟来求出机器人的电动机的负荷,根据求得的负荷变更动作程序的指令速度或者指令加速度,消除上述偏离。
有时示教平滑地连接为通过一个动作命令在某个示教点定位而开始减速,同时为通过下一动作命令向别的示教点移动而开始加速这样通过两个动作命令的移动的平滑动作。
图12A~图12C是用于说明平滑动作的图。在不示教平滑动作的情况下,如图12A所示,在第一程序段B1的移动指令中的期间D1以预定的加速度加速,并且在期间D2同样地减速,到达某个示教点P。其后,在第二程序段B2的移动指令中的期间D3再次加速,开始向其他的示教点移动。在这种情况下,通过图12C中用实线表示的轨迹。
与此相对,在示教了平滑动作的情况下,如图12B所示,在期间D2的开始时,在第一程序段B1的减速开始的同时开始第二程序段B2的加速。因此,在期间D2结束时第一程序段B1的减速动作结束,同时第二程序段B2的加速动作结束。因此,在示教了平滑动作的情况下,如图12C所示,能够圆滑地进行从第一程序段B1向第二程序段的转移。
如图12C中的实线所示,在不示教平滑动作的情况下,通过第一程序段的动作指令,机器人到达示教点P。但是,在示教了平滑动作的情况下,如图12C中的虚线所示,形成机器人不通过示教点P的轨迹。因此,当示教平滑动作时,相对于目标动作路径,机器人的实际的动作路径有时偏离。
与此相对,在不示教平滑动作的情况下,若示教点互相用最短距离连接,则机器人的实际的动作路径相对于目标动作路径不偏离。但是,在不示教平滑动作的情况下,如比较图12A和图12B所知,有时周期时间变长。
发明内容
鉴于这样的情况而做出本发明,其目的是提供一种变更动作程序的机器人程序变更装置,即使在进行平滑动作中的示教的情况下,也能够缩短动作程序的周期时间,同时使机器人通过原来的示教点。
为实现上述目的,本发明的第一方式提供一种机器人程序变更装置,用于变更进行平滑动作的机器人的程序,该平滑动作是指在进行第一移动指令中的减速时进行第二移动指令中的加速,平滑地进行从第一移动指令向第二移动指令的转移,所述机器人程序变更装置具有:程序存储部,用于存储机器人的动作程序;初始存储部,用于把通过模拟来执行在该程序存储部中存储的上述动作程序时的上述动作程序的周期时间作为初始周期时间来存储,把上述动作程序的多个示教点的位置作为多个初始示教点的位置来存储,同时把上述多个初始示教点的示教顺序作为初始示教顺序来存储;顺序改换部,用于改换上述多个示教点的示教顺序,使与按照在该初始存储部中存储的上述多个初始示教点的上述初始示教顺序使上述机器人移动的情况相比,上述多个示教点的各个示教点之间的上述机器人的移动时间的合计变小;臂尖端位置存储部,用于在每一预定时间存储通过模拟来执行通过该顺序改换部改换了示教顺序的改换后动作程序时的上述机器人的臂尖端的位置;计算部,用于对于上述每一初始示教点计算根据在该臂尖端位置存储部中存储的每一预定时间的位置制作的上述机器人的轨迹、和在上述初始存储部中存储的初始示教点之间的偏离量;位置调整部,用于进行上述改换后动作程序的上述示教点的位置调整,直到通过该计算部算出的上述偏离量成为预定的允许值以下为止;和示教点变更部,用于在通过模拟来执行包含通过该位置调整部调整的上述示教点的上述改换后动作程序时的上述改换后动作程序的周期时间比在上述初始存储部中存储的上述初始周期时间长的情况下,把被调整后的上述示教点变更为上述初始示教点,采用初始示教顺序。
本发明的第二方式,在第一方式中,上述顺序改换部包含:移动时间计算部,用于通过将上述机器人的各轴的移动角度除以上述机器人的各轴的旋转速度,计算示教点改换前的上述程序以及上述改换后动作程序中的各示教点之间的移动时间;判定部,用于改换上述动作程序中的上述多个示教点中的两个示教点的示教顺序,并且评价在上述示教点改换后从上述多个示教点的各个示教点之间的上述机器人的移动时间的合计中减去上述示教点改换前的上述机器人的上述移动时间的合计所得的偏差是否在允许值以下;顺序采用部,用于在通过该判定部判定为上述偏差在允许值以下的情况下采用上述示教点改换后的示教顺序,并且在判定为上述偏差不在允许值以下的情况下采用上述示教点改换前的示教顺序;允许值变更部,用于在通过该顺序采用部采用上述示教点改换后的示教顺序或者上述示教点改换前的示教顺序后把上述允许值减小预定量那样变更;和重复部,用于在预定的最大尝试次数的范围内重复上述示教顺序的改换作业,直到通过该允许值变更部变更后的上述允许值成为预定的规定值为止。
本发明的第三方式,在第一方式中,上述顺序改换部,根据上述动作程序的连续的三个示教点之间的第一动作段的移动矢量以及第二动作段的移动矢量形成的角度、和上述第二动作段中的移动时间,改换上述示教点的示教顺序。
本发明的第四方式,在从第一到第三的任何一种方式中,在通过上述计算部算出的上述偏离量超过允许值的情况下,上述位置调整部,从位于距上述初始示教点最短距离的上述轨迹上的点,在朝向上述初始示教点的矢量方向上使上述改换后动作程序的上述示教点移动一定距离来进行位置调整。
本发明的第五方式,在从第一到第四的任何一种方式中,还具有变更部,用于在即将进行上述动作程序的上述示教点的位置修正前,变更上述动作程序中的上述机器人的速度、加速度以及平滑程度中的至少一个的指令值,以使上述动作程序的周期时间变短。
附图说明
从附图中表示的本发明的典型的实施方式的详细的说明,能够更加明了本发明的这些目的、特征和优点以及其他目的、特征和优点。
图1是基于本发明的机器人程序变更装置的功能框图。
图2是说明基于本发明的机器人程序变更装置的动作的流程图。
图3是表示初始示教点以及轨迹的图。
图4是说明改换示教点的示教顺序的改换动作的流程图。
图5A是表示改换前的多个示教点的示教顺序的图。
图5B是表示改换后的多个示教点的示教顺序的图。
图6是说明改换示教点的示教顺序的另外的改换动作的第一流程图。
图7是说明改换示教点的示教顺序的另外的改换动作的第二流程图。
图8是表示多个示教点的图。
图9是表示多个示教点的另外的图。
图10是说明基于本发明的机器人程序变更装置的动作的另外的流程图。
图11是表示初始示教点以及轨迹的另外的图。
图12A是用于说明平滑动作的第一图。
图12B是用于说明平滑动作的第二图。
图12C是用于说明平滑动作的第三图。
具体实施方式
下面参照附图说明本发明的实施方式。在以下的附图中,对同样的部件附以同样的参照符号。为使理解容易,适宜变更了这些附图的比例尺。
图1是基于本发明的机器人程序变更装置的功能框图。如图1所示,机器人程序变更装置10主要包含显示部11,例如液晶显示器;控制装置12,例如计算机;输入部13,例如键盘以及鼠标等。
在显示部11上显示在臂尖端具有刀具16的机器人15、例如多关节机器人的三维模型。进而,在机器人15附近显示工件W的三维模型。这些三维模型与实际的机器人15、刀具16以及工件W对应地配置。
如图1所示,控制装置12包含:存储机器人15的动作程序的程序存储部21;和把通过模拟来执行在程序存储部21中存储的动作程序时的动作程序的周期时间CT作为初始周期时间CT0来存储,把动作程序的多个示教点的位置作为多个初始示教点的位置来存储,并且把多个初始示教点的示教顺序作为初始示教顺序来存储的初始存储部22。
另外,控制装置12作为顺序改换部23起作用,用于改换多个示教点的示教顺序,使得与按照在初始存储部22中存储的多个初始示教点的初始示教顺序使机器人15移动的情况相比,多个示教点的各个示教点之间的机器人15的移动时间的合计变小。
进而,控制装置12作为臂尖端位置存储部24和计算部25起作用,前者用于在每一预定时间存储通过模拟来执行通过顺序改换部23改换了示教顺序的改换后动作程序时的机器人15的臂尖端的位置,后者用于对于每一初始示教点计算根据在臂尖端位置存储部24中存储的每一预定时间的位置而制作的机器人15的轨迹和在初始存储部22中存储的初始示教点之间的偏离量。
进而,控制装置12作为位置调整部26和示教点变更部起作用,前者用于在通过计算部25算出的偏离量成为预定的允许值以下之前,进行改换后动作程序的示教点的位置调整;后者用于在通过模拟来执行包含通过位置调整部26调整的示教点的改换后动作程序时的改换后动作程序的周期时间CT比在初始存储部22中存储的初始周期时间CT0长的情况下,把被调整后的示教点变更为初始示教点后,采用初始示教顺序。
这里,顺序改换部23包含:移动时间计算部31,用于通过将机器人15的各轴的移动角度除以机器人15的各轴的旋转速度,计算示教点改换前的动作程序以及改换后动作程序中的各示教点之间的移动时间;判定部32,用于改换动作程序中的多个示教点中的两个示教点的示教顺序,并且评价在改换示教点后从多个示教点的各个之间的机器人15的移动时间的合计中减去示教点改换前的机器人15的移动时间的合计所得的偏差是否在允许值以下;顺序采用部33,用于在通过判定部32判定为偏差在允许值以下的情况下采用示教点改换后的示教顺序,并且在判定为偏差不在允许值以下的情况下采用示教点改换前的示教顺序;允许值变更部34,用于在通过顺序采用部33采用示教点改换后的示教顺序或者示教点改换前的示教顺序后把允许值减小预定量那样变更;和重复部35,用于在通过允许值变更部34变更的允许值成为预定的规定值之前,在预定的最大尝试次数的范围内重复示教顺序的改换作业。
另外,如后所述,顺序改换部23也可以根据动作程序的连续的三个示教点之间的第一动作段的移动矢量以及第二动作段的移动矢量形成的角度、和第二动作段中的移动时间,改换示教点的示教顺序。
进而,控制装置12作为变更部36起作用,用于在即将进行动作程序的示教点的位置修正前,变更动作程序中的机器人15的速度、加速度以及平滑程度中的至少一个的指令值,使得动作程序的周期时间CT变短那样变。
图2是说明基于本发明的机器人程序变更装置的动作的流程图。假定表示图2等的动作的控制程序以及在图2等中使用的各种数据在控制装置12的程序存储部21中另行存储。下面参照图1以及图2,说明本发明的机器人程序变更装置10。
另外,在本发明中,在机器人15的动作程序中记载的连续的两个移动指令中,在进行第一移动指令中的减速时进行第二移动指令中的加速,平滑地进行从第一移动指令向第二移动指令的转移。即,在本发明中,如参照图12说明的那样,假定在从某示教点向其他示教点移动时进行平滑动作。
首先,在图2的步骤S10,操作者使用输入部13设定通过动作程序规定的关于机器人15的臂尖端的轨迹和示教点之间的偏离量的允许值K(mm)。允许值K是比较小的正值,或者允许值K也可以是零。
接着,在步骤S11,从程序存储部21中读出动作程序。然后,把在动作程序中记载的多个示教点的位置作为多个初始示教点的位置存储在初始存储部22中,把初始示教点的示教顺序作为初始示教顺序存储在初始存储部22中。进而,通过模拟来执行动作程序,求动作程序的周期时间CT,将其作为初始周期时间CT0存储在初始存储部22中。
接着,在步骤S12,使用顺序改换部23改换至少两个示教点的示教顺序,由此,使至少两个示教点间的移动距离变小。关于示教顺序的改换作业,在后面详细叙述。
接着,在步骤S13,模拟改换了示教顺序的改换后动作程序。通过该模拟,因为机器人15的臂尖端在每一预定时间的位置已知,所以把这些位置存储在臂尖端位置存储部24中。
进而,在步骤S14,根据在臂尖端位置存储部24中存储的位置制作臂尖端的轨迹。进而,从初始存储部22中读出多个初始示教点的位置。图3是表示初始示教点以及轨迹的图。在图3中表示初始示教点P0和改换后动作程序的示教点P。进而,表示了根据改换后动作程序制作的轨迹X1。在本发明中因为进行平滑动作,所以轨迹X1不位于改换后动作程序的示教点P上。在步骤S14,计算部25对于每一个初始示教点计算改换后动作程序的多个初始示教点P0的各位置和轨迹X1之间的偏离量。如从图3所知,偏离量与初始示教点P0和轨迹X1的最短距离相当。
其后,在步骤S15,判定偏离量是否在允许值K以下。在判定全部偏离量都在允许值K以下的情况下,前进到步骤S16,通过模拟来执行改换后动作程序,计算改换后动作程序的周期时间CT。
与此相对,在步骤S15中判定为至少一个偏离量不在允许值K以下的情况下,前进到步骤S18。在步骤S18,通过位置调整部27调整改换后动作程序的多个示教点的位置。然后,在关于全部示教点的偏离量都成为允许值K以下之前,重复上述步骤S14~步骤S16的处理。关于位置调整部27的具体的动作,在后面叙述。
然后,在步骤S17,比较周期时间CT和在初始存储部22中存储的初始周期时间CT0。并且,在周期时间CT比初始周期时间CT0小的情况下,原样不变地采用改换后动作程序。与此相对,在周期时间CT不比初始周期时间CT0小的情况下,位置调整部27把全部示教点P的位置变更为初始示教点P0,另外,恢复动作程序使采用初始示教顺序。
这样在本发明中,改换动作程序的示教点的示教顺序,并且进行示教点的位置调整,使得轨迹和初始示教点间的偏离量成为允许值K以下。另外,在得到比初始周期时间短的周期时间的情况下排除那样的动作程序。因此,即使在进行平滑动作中的示教的情况下,也能够缩短动作程序的周期时间,同时能够变更动作程序使得机器人在包含初始示教点的范围内通过。
图4是说明改换示教点的示教顺序的改换动作的流程图。下面参照图4说明顺序改换部23的改换动作。开始,在图4的步骤S21,操作者使用输入部13设定累计各示教点间的机器人15的移动时间所得的合计移动时间的允许值T。允许值T是合计移动时间的允许误差,在步骤S21,优选把允许值T设定得比较大。
接着在步骤S22,移动时间计算部31计算示教顺序s的改换前的动作程序中的示教点间的机器人15的移动时间的合计移动时间E(s)。具体说,移动时间计算部31,通过将全部示教点的位置的机器人15的各轴的移动角度除以机器人15的各轴的旋转速度,求示教点间的移动时间。然后,通过累计这些移动时间计算合计移动时间G1。
图5A以及图5B是表示多个示教点的示教顺序的图。如图5A所示,在示教顺序的改换前,遵照示教顺序s(P(1)-P(2)-P(3)-P(4)-P(5)-P(6))配置多个例如六个示教点P(1)~P(6)。
接着,在步骤S23,改换动作程序的多个示教点中的两个的示教顺序。例如当改换图5A中表示的两个示教点P(1)、P(2)的示教顺序时,如图5B所示,得到新的示教顺序s’(P(2)-P(1)-P(3)-P(4)-P(5)-P(6))。然后,在步骤S24,移动时间计算部31遵照新的示教顺序s’如上述那样计算改换后动作程序的合计移动时间E(s’)。
其后,在步骤S25,从改换后的合计移动时间E(s’)中减去改换前的合计移动时间E(s)来计算偏差。然后,判定部32判定偏差是否在允许值T以下。在偏差在允许值T以下的情况下,前进到步骤S26,采用改换后的示教顺序s’。与此相对,在偏差不在允许值T以下的情况下,前进到步骤S27,采用改换前的示教顺序s。
然后,前进到步骤S28,允许值变更部34把允许值T减小预定的微小量ΔT。其后,前进到步骤S29,判定允许值T是否达到预定的规定值T0(<T)。
在判定为允许值T在规定值T0以下的情况下结束处理。与此相对,在判定为允许值T不在预定的规定值T0以下的情况下,返回步骤S23,重复部35在允许值T成为预定的规定值T0以下之前重复上述的处理。这样,在本发明中,能够改换示教点的示教顺序使得示教点间的合计移动时间变小。
图6以及图7是说明改换示教点的示教顺序的另外的改换动作的流程图。另外,图8以及图9是表示多个示教点的图。下面参照图6到图9,说明顺序改换部23的另外的改换动作。
开始,在图6的步骤S31,求动作程序的全部多个示教点的位置的中心PG。如图8所示,在用黑圆圈表示的六个示教点的位置间配置中心PG。然后,选择位于离开中心PG最远的示教点作为第一示教点P(1)。
接着,在步骤S32,从剩余的示教点中如下选择第二示教点P(2)。首先,制作从第一示教点P(1)朝向中心PG的矢量P(1)PG、和从第一示教点P(1)朝向剩余的各个示教点的矢量。然后,对于矢量P(1)PG,决定顺时针成最大角度的矢量、和反时针成最大角度的矢量。但是,假定该角度在90度以下。
在图8中,矢量P(1)P(2B)是反时针成最大角度的矢量。矢量P(1)P(2A)是顺时针成最大角度的矢量。接着,比较示教点P(1)、P(2B)间的移动时间和示教点P(1)、P(2A)间的移动时间,选择与较短的移动时间相关的示教点P(2A)作为第二示教点P(2)。示教点间的移动时间通过上述的移动时间计算部31求出。
接着,在步骤S33把变量N设定为1。然后在步骤S34,除已经决定了示教顺序的示教点(例如示教点P(1)、P(2))外,选择示教点间的移动时间第N号短的示教点P(Nth)。示教点间的移动时间通过上述的移动时间计算部31求出。
然后,在步骤S35,如图9所示,考虑示教点P(Nth)之前的两个示教点P(i-1)、P(i)。这三个示教点P(i-1)、P(i)、P(Nth)连续。然后,设定两个示教点P(i-1)、P(i)之间的第一段的第一移动矢量V1、和两个示教点P(i)、P(Nth)之间的第二段的第二移动矢量V2。进而,判定第一移动矢量V1和第二移动矢量V2之间成的角度θ是否比预定的设定值θ0小。
然后,在判定为角度θ比预定的设定值θ0小的情况下,前进到步骤S36,把示教点P(Nth)设定为下一示教点P(i+1)。关于该点,在图9中表示离开示教点P(i)的距离和示教点P(Nth)的情况下大体相等的示教点P’。但是,示教点P’因为上述角度比设定值θ0大,所以不把示教点P’设定为下一示教点P(i+1)。
当设定下一示教点P(i+1)时,在步骤S37,判定全部示教点的示教顺序的改换是否结束。然后,在全部示教顺序已改换的情况下结束处理。对此,在未改换全部示教顺序的情况下,返回步骤S33重复处理。
在步骤S35判定为角度θ不比预定的设定值θ0小的情况下,前进到步骤S38。在步骤S38,判定变量N是否等于除已决定了示教顺序的示教点以外的示教点的数量。在变量N不等于剩余的示教点的数量的情况下,在步骤S39在恢复改换前的示教顺序的同时在变量N上加“1”。其后返回步骤S34重复处理。
与此相对,在变量N等于剩余的示教点的数量的情况下,前进到步骤S40。在步骤S40,把离开当前的示教点P(i)的移动时间最短的示教点设定为下一示教点P(i+1)。其后,返回步骤S33重复处理。
在图6中,在步骤S34以移动时间短为前提选择示教点。因此,可知能够改换多个示教点的示教顺序以使机器人15的臂尖端的平均的移动速度变大。
图10是说明基于本发明的机器人程序变更装置的动作的另外的流程图。在图10中仅表示图2表示的步骤S12到S15,为了简洁的目的,省略图2中的步骤S10、S11、S16、S17、S19的图示。另外,关于已参照图2说明的步骤,省略再次的说明。
下面参照图10主要叙述和图1的不同点。为在步骤S18中进行动作程序的示教点的位置调整,如在步骤S12a中所示,优选把机器人15的指令速度、指令加速度和/或指令平滑程度设定为各自的最大值。此外,表示平滑动作的程度的平滑程度用百分数表示。然后,在步骤S15判定为算出的偏离量不在允许值K以下的情况下,前进到步骤S15a。在步骤S15a,在达到预先由操作者设定的最大尝试次数之前,判定是否已执行步骤S13~步骤S15的处理。
然后,在达到最大尝试次数的情况下前进到步骤12b。在步骤12b,变更部36把机器人15的指令速度、指令加速度和/或指令平滑程度降低各自的预定量,接着返回步骤S13。与此相对,在未达到最大尝试次数的情况下,在步骤S18进行动作程序的示教点的位置调整。此外,示教点的位置调整作业和图1表示的流程图的步骤S18相同。
图11是表示初始示教点以及轨迹的另外的图。如图11所示,决定形成初始示教点P0和轨迹X1之间的最短距离的方向。然后,为使示教点P在该方向上从初始示教点P0离开,使示教点P移动预定距离。在图11中,表示通过位置调整部27将两个示教点P分别移动到示教点Pnew的位置。
图11中表示的虚线X2,是基于示教点Pnew通过步骤S13的处理形成的、机器人15的臂尖端的轨迹。如图11所示,虚线X2出现在初始示教点P0上。也就是说,用虚线X2表示的轨迹,可以在把允许值K设定为零的情况下最终得到。
可知,在这样的情况下,即使在进行平滑动作下的示教的情况下,也能够一方面缩短动作程序的周期时间,一方面变更动作程序以使机器人通过初始示教点。
在图10中省略了图示的步骤S16中,计算周期时间CT。在到达步骤S16时,进行步骤S18中的示教点的位置调整处理,或者步骤S12b中的指令速度、指令加速度和/或指令平滑程度的降低处理。然后,在图10的步骤S12,也可以进行参照图4或者图6说明的两种示教顺序的改换动作中的双方。
在这样的情况下,在图10中未表示的步骤S16中得到两种周期时间CT。然后,在步骤S11(图10中省略),求出初始周期时间CT0。因此,也可以在图10中未表示的步骤S17中,选择初始周期时间CT0和两种周期时间CT中最小的周期时间。由此可知能够选择进行了周期时间更短的位置调整处理等的动作程序。
在第一方式中,改换动作程序的示教点的示教顺序,并且进行示教点的位置调整,以使轨迹和初始示教点之间的偏离量成为允许值以下。另外,在得到比初始周期时间短的周期时间的情况下,排除那样的动作程序。因此,即使在进行平滑动作中的示教的情况下,也能够一边缩短动作程序的周期时间,一边变更动作程序以使机器人通过包含初始示教点的范围。
在第二方式中,改换示教点的示教顺序以使示教点间的合计移动时间变小。
在第三方式中,改换示教点的示教顺序以使机器人的臂尖端的平均的移动速度变大。
在第四方式中,能够决定使轨迹和初始示教点之间的偏离量成为允许值以下那样的示教点的位置。
在第五方式中,通过变更机器人的速度、加速度和/或平滑程度,能够缩短动作程序的周期时间。
使用典型的实施方式说明了本发明,但是本领域技术人员能够理解,不脱离本发明的范围的情况下,能够进行上述的变更以及各种其他的变更、省略、追加。
Claims (6)
1.一种机器人程序变更装置(10),用于变更进行平滑动作的机器人(15)的程序,该平滑动作是指在进行第一移动指令中的减速时进行第二移动指令中的加速,平滑地进行从第一移动指令向第二移动指令的转移,所述机器人程序变更装置的特征在于,具有:
程序存储部(21),用于存储机器人的动作程序;
初始存储部(22),用于把通过模拟来执行在该程序存储部中存储的上述动作程序时的上述动作程序的周期时间作为初始周期时间来存储,把上述动作程序的多个示教点的位置作为多个初始示教点的位置来存储,同时把上述多个初始示教点的示教顺序作为初始示教顺序来存储;
顺序改换部(23),用于改换上述多个示教点的示教顺序,使与按照在该初始存储部中存储的上述多个初始示教点的上述初始示教顺序使上述机器人移动的情况相比,上述多个示教点的各个示教点之间的上述机器人的移动时间的合计变小;
臂尖端位置存储部(24),用于在每一预定时间存储通过模拟来执行通过该顺序改换部改换了示教顺序的改换后动作程序时的上述机器人的臂尖端的位置;
计算部(25),用于对于上述每一初始示教点计算根据在该臂尖端位置存储部中存储的每一预定时间的位置制作的上述机器人的轨迹、和在上述初始存储部中存储的初始示教点之间的偏离量;
位置调整部(26),用于进行上述改换后动作程序的上述示教点的位置调整,直到通过该计算部算出的上述偏离量成为预定的允许值以下为止;和
示教点变更部(27),用于在通过模拟来执行包含通过该位置调整部调整的上述示教点的上述改换后动作程序时的上述改换后动作程序的周期时间比在上述初始存储部中存储的上述初始周期时间长的情况下,把被调整后的上述示教点变更为上述初始示教点,采用初始示教顺序。
2.根据权利要求1所述的机器人程序变更装置,其特征在于,
上述顺序改换部包含:
移动时间计算部(31),用于通过将上述机器人的各轴的移动角度除以上述机器人的各轴的旋转速度,计算示教点改换前的上述程序以及上述改换后动作程序中的各示教点之间的移动时间;
判定部(32),用于改换上述动作程序中的上述多个示教点中的两个示教点的示教顺序,并且评价在上述示教点改换后从上述多个示教点的各个示教点之间的上述机器人的移动时间的合计中减去上述示教点改换前的上述机器人的上述移动时间的合计所得的偏差是否在允许值以下;
顺序采用部(33),用于在通过该判定部判定为上述偏差在允许值以下的情况下采用上述示教点改换后的示教顺序,并且在判定为上述偏差不在允许值以下的情况下采用上述示教点改换前的示教顺序;
允许值变更部(34),用于在通过该顺序采用部采用上述示教点改换后的示教顺序或者上述示教点改换前的示教顺序后把上述允许值减小预定量那样变更;和
重复部(35),用于在预定的最大尝试次数的范围内重复上述示教顺序的改换作业,直到通过该允许值变更部变更后的上述允许值成为预定的规定值为止。
3.根据权利要求1所述的机器人程序变更装置,其特征在于,
上述顺序改换部(23),根据上述动作程序的连续的三个示教点之间的第一动作段的移动矢量以及第二动作段的移动矢量形成的角度、和上述第二动作段中的移动时间,改换上述示教点的示教顺序。
4.根据权利要求1到3中任何一项所述的机器人程序变更装置,其特征在于,
在通过上述计算部算出的上述偏离量超过允许值的情况下,上述位置调整部(26),从位于距上述初始示教点最短距离的上述轨迹上的点,在朝向上述初始示教点的矢量方向上使上述改换后动作程序的上述示教点移动一定距离来进行位置调整。
5.根据权利要求1到3中任何一项所述的机器人程序变更装置,其特征在于,
还具有变更部(36),用于在即将进行上述动作程序的上述示教点的位置修正前,变更上述动作程序中的上述机器人的速度、加速度以及平滑程度中的至少一个的指令值,以使上述动作程序的周期时间变短。
6.根据权利要求4所述的机器人程序变更装置,其特征在于,
还具有变更部(36),用于在即将进行上述动作程序的上述示教点的位置修正前,变更上述动作程序中的上述机器人的速度、加速度以及平滑程度中的至少一个的指令值,以使上述动作程序的周期时间变短。
Applications Claiming Priority (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2012118638A JP5426722B2 (ja) | 2012-05-24 | 2012-05-24 | ロボットプログラム変更装置 |
JP2012-118638 | 2012-05-24 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN103419198A CN103419198A (zh) | 2013-12-04 |
CN103419198B true CN103419198B (zh) | 2016-01-20 |
Family
ID=49547108
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201310194262.1A Active CN103419198B (zh) | 2012-05-24 | 2013-05-23 | 机器人程序变更装置 |
Country Status (4)
Country | Link |
---|---|
US (1) | US8831777B2 (zh) |
JP (1) | JP5426722B2 (zh) |
CN (1) | CN103419198B (zh) |
DE (1) | DE102013008523B4 (zh) |
Families Citing this family (32)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP5912627B2 (ja) * | 2012-02-14 | 2016-04-27 | 川崎重工業株式会社 | 撮像検査装置ならびにその制御装置および制御方法 |
KR101330049B1 (ko) * | 2012-03-06 | 2013-11-18 | 한국기계연구원 | 3차원 특징점 기반 직접 교시 궤적 후보정 방법 |
JP6360301B2 (ja) * | 2013-12-25 | 2018-07-18 | 川崎重工業株式会社 | 動作プログラム作成方法およびロボットの制御方法 |
DE102014202145A1 (de) | 2014-02-06 | 2015-08-06 | Kuka Roboter Gmbh | Verfahren zum Programmieren eines Industrieroboters und zugehörigerIndustrieroboter |
US10162328B2 (en) * | 2014-03-14 | 2018-12-25 | Omron Corporation | Controller and control system |
JP6467646B2 (ja) * | 2014-03-27 | 2019-02-13 | パナソニックIpマネジメント株式会社 | ロボット制御方法 |
JP6006277B2 (ja) * | 2014-11-06 | 2016-10-12 | ファナック株式会社 | 産業用ロボットのプログラム修正装置及びプログラム修正方法 |
US9381645B1 (en) * | 2014-12-08 | 2016-07-05 | Amazon Technologies, Inc. | System for automating manipulation of items |
JP6122046B2 (ja) | 2015-01-29 | 2017-04-26 | ファナック株式会社 | 加工サイクルの部分修正が可能な数値制御装置 |
DE112016002431T8 (de) * | 2015-05-29 | 2018-04-05 | Abb Schweiz Ag | Verfahren und System zur robotischen adaptiven Produktion |
US10813709B2 (en) * | 2015-08-25 | 2020-10-27 | Kawasaki Jukogyo Kabushiki Kaisha | Robot system |
US10399326B2 (en) * | 2015-10-30 | 2019-09-03 | Stratasys, Inc. | In-situ part position measurement |
WO2017079892A1 (en) * | 2015-11-10 | 2017-05-18 | Abb Schweiz Ag | A method and system for machining, and a robot system |
JP6370821B2 (ja) * | 2016-02-12 | 2018-08-08 | ファナック株式会社 | ロボットプログラムの教示を行うロボットプログラミング装置 |
US11036230B1 (en) * | 2016-03-03 | 2021-06-15 | AI Incorporated | Method for developing navigation plan in a robotic floor-cleaning device |
JP6348141B2 (ja) * | 2016-04-28 | 2018-06-27 | ファナック株式会社 | 付加軸の状態が含まれる動作プログラムを表示するロボットの制御装置 |
JP6457435B2 (ja) * | 2016-05-26 | 2019-01-23 | ファナック株式会社 | 研削ロボットシステム |
CN107443389B (zh) * | 2016-05-31 | 2019-12-31 | 发那科株式会社 | 机器人控制装置及机器人控制方法 |
CN106371400B (zh) * | 2016-10-31 | 2019-02-15 | 成都乐创自动化技术股份有限公司 | 一种示教轨迹选中方法及装置 |
JP6469162B2 (ja) * | 2017-04-17 | 2019-02-13 | ファナック株式会社 | ロボットのオフライン教示装置 |
CN107584493B (zh) * | 2017-08-29 | 2020-08-14 | 成都乐创自动化技术股份有限公司 | 一种捕捉目标示教点的方法及系统 |
JP7087316B2 (ja) * | 2017-09-27 | 2022-06-21 | オムロン株式会社 | 情報処理装置、情報処理方法およびプログラム |
JP6763846B2 (ja) * | 2017-11-24 | 2020-09-30 | ファナック株式会社 | ロボットの教示操作を行う教示装置および教示方法 |
JP7115090B2 (ja) * | 2018-07-17 | 2022-08-09 | オムロン株式会社 | 加速度調整装置及び加速度調整プログラム |
JP6838028B2 (ja) * | 2018-10-31 | 2021-03-03 | ファナック株式会社 | 自動プログラム修正装置および自動プログラム修正方法 |
US11059173B2 (en) * | 2018-12-30 | 2021-07-13 | UBTECH Robotics Corp. | Robot joint motion control method, device and robot using the same |
JP7232704B2 (ja) * | 2019-05-13 | 2023-03-03 | 株式会社トヨタプロダクションエンジニアリング | ロボットプログラム評価装置、ロボットプログラム評価方法及びロボットプログラム評価プログラム |
JP7493926B2 (ja) * | 2019-10-30 | 2024-06-03 | キヤノン株式会社 | 制御方法、制御装置、ロボットシステム、物品の製造方法、動作プログラム作成方法、動作プログラム作成装置、表示装置、表示装置の制御方法、プログラムおよび記録媒体 |
JP7120512B2 (ja) * | 2019-11-22 | 2022-08-17 | Smc株式会社 | 軌跡制御装置 |
JP7454965B2 (ja) * | 2020-03-11 | 2024-03-25 | 本田技研工業株式会社 | 情報処理装置、情報処理システムおよび情報処理方法 |
US11707843B2 (en) | 2020-04-03 | 2023-07-25 | Fanuc Corporation | Initial reference generation for robot optimization motion planning |
CN115782681B (zh) * | 2023-01-10 | 2023-04-21 | 江苏智慧优视电子科技有限公司 | 一种应用于新能源重卡电池箱的定位系统及方法 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US5495410A (en) * | 1994-08-12 | 1996-02-27 | Minnesota Mining And Manufacturing Company | Lead-through robot programming system |
JPH11249725A (ja) * | 1998-02-26 | 1999-09-17 | Fanuc Ltd | ロボット制御装置 |
CN101105715A (zh) * | 2006-07-12 | 2008-01-16 | 发那科株式会社 | 机器人系统的模拟装置 |
CN101204813A (zh) * | 2006-12-20 | 2008-06-25 | 发那科株式会社 | 用于执行机器人离线编程的装置、方法、程序及记录介质 |
CN101362335A (zh) * | 2007-08-10 | 2009-02-11 | 发那科株式会社 | 机器人程序调整装置 |
Family Cites Families (14)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US4815007A (en) * | 1984-12-20 | 1989-03-21 | Seiko Epson Corporation | Apparatus for controlling a robot |
JPH01133726A (ja) | 1987-11-19 | 1989-05-25 | Takano:Kk | 紙製包装材 |
JPH03213285A (ja) * | 1990-01-19 | 1991-09-18 | Toshiba Corp | ロボットの制御方法 |
JP3104535B2 (ja) * | 1994-07-25 | 2000-10-30 | 日産自動車株式会社 | ロボットの作業分担決定方法 |
WO1997011416A1 (fr) * | 1995-09-19 | 1997-03-27 | Kabushiki Kaisha Yaskawa Denki | Processeur de langage robotique |
JPH1069310A (ja) * | 1996-08-28 | 1998-03-10 | Matsushita Electric Ind Co Ltd | ロボットの軌道生成装置 |
JPH1133726A (ja) * | 1997-07-10 | 1999-02-09 | Toyota Motor Corp | 溶接ロボットへの教示方法 |
JPH11249723A (ja) * | 1998-03-03 | 1999-09-17 | Kawasaki Heavy Ind Ltd | ロボットの制御方法および制御装置 |
JP4056662B2 (ja) * | 1999-09-16 | 2008-03-05 | 株式会社デンソー | 外観検査装置 |
JP4165404B2 (ja) * | 2003-01-17 | 2008-10-15 | 富士電機システムズ株式会社 | 最適化装置、制御プログラム生成装置、プログラム |
JP3905075B2 (ja) | 2003-11-17 | 2007-04-18 | ファナック株式会社 | 作業プログラム作成装置 |
JP3946753B2 (ja) | 2005-07-25 | 2007-07-18 | ファナック株式会社 | ロボットプログラム評価・修正方法及びロボットプログラム評価・修正装置 |
JP4174517B2 (ja) * | 2006-03-13 | 2008-11-05 | ファナック株式会社 | 教示位置修正装置および教示位置修正方法 |
JP4238256B2 (ja) * | 2006-06-06 | 2009-03-18 | ファナック株式会社 | ロボットシミュレーション装置 |
-
2012
- 2012-05-24 JP JP2012118638A patent/JP5426722B2/ja active Active
-
2013
- 2013-04-10 US US13/859,993 patent/US8831777B2/en active Active
- 2013-05-17 DE DE102013008523.3A patent/DE102013008523B4/de active Active
- 2013-05-23 CN CN201310194262.1A patent/CN103419198B/zh active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US5495410A (en) * | 1994-08-12 | 1996-02-27 | Minnesota Mining And Manufacturing Company | Lead-through robot programming system |
JPH11249725A (ja) * | 1998-02-26 | 1999-09-17 | Fanuc Ltd | ロボット制御装置 |
CN101105715A (zh) * | 2006-07-12 | 2008-01-16 | 发那科株式会社 | 机器人系统的模拟装置 |
CN101204813A (zh) * | 2006-12-20 | 2008-06-25 | 发那科株式会社 | 用于执行机器人离线编程的装置、方法、程序及记录介质 |
CN101362335A (zh) * | 2007-08-10 | 2009-02-11 | 发那科株式会社 | 机器人程序调整装置 |
Also Published As
Publication number | Publication date |
---|---|
JP5426722B2 (ja) | 2014-02-26 |
US20130317646A1 (en) | 2013-11-28 |
DE102013008523B4 (de) | 2019-03-28 |
JP2013244550A (ja) | 2013-12-09 |
DE102013008523A1 (de) | 2013-11-28 |
US8831777B2 (en) | 2014-09-09 |
CN103419198A (zh) | 2013-12-04 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN103419198B (zh) | 机器人程序变更装置 | |
CN110355751B (zh) | 控制装置和机器学习装置 | |
JP7096288B2 (ja) | ロボットを制御する方法 | |
CN104249195B (zh) | 具备视觉传感器和力传感器的毛刺去除装置 | |
US9149931B2 (en) | Robot system, robot control device and method for controlling robot | |
JP6128767B2 (ja) | ロボット制御装置、及びロボット制御方法 | |
JP6717768B2 (ja) | 生産ラインにおける運用を考慮した学習制御を行うロボット及びその制御方法 | |
CN104647387A (zh) | 机器人控制方法、系统和装置 | |
US20120116582A1 (en) | Robot controlling device | |
US20070021868A1 (en) | Method of evaluating and correcting robot program and device for evaluating and correcting robot program | |
JP6669715B2 (ja) | 振動抑制装置 | |
CN104793622A (zh) | 两足步行机器人控制方法和两足步行机器人控制系统 | |
CN105171745A (zh) | 一种机器人离线编程系统 | |
TW201521929A (zh) | 雷射加工機操作的控制方法及用以控制雷射加工機之第1致動器操作之控制器 | |
CN114603558B (zh) | 混合空间过渡轨迹规划方法及装置 | |
CN111679632A (zh) | 切割控制的处理方法、装置、电子设备与存储介质 | |
US11137728B2 (en) | Processing device, control parameter determination method, and non-transitory recording medium storing a control parameter determination program | |
JP2007000954A (ja) | ロボット教示装置及び方法 | |
TWI594858B (zh) | 機械手臂教導控制系統 | |
CN114800523B (zh) | 机械臂轨迹修正方法、系统、计算机及可读存储介质 | |
US10474127B2 (en) | Numerical controller | |
CN111079280B (zh) | 固体姿轨控发动机控制系统快速原型仿真的方法及装置 | |
JP6792184B1 (ja) | シミュレーションシステム、シミュレーション方法、シミュレーションプログラム、ロボットの製造方法、およびロボットシステム | |
JP6823032B2 (ja) | プログラム修正装置 | |
CN105549422A (zh) | 基于Maya软件的机构运动轨迹规划方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
C14 | Grant of patent or utility model | ||
GR01 | Patent grant |