CN105829033A - 动作程序生成方法以及机械手的控制方法 - Google Patents

动作程序生成方法以及机械手的控制方法 Download PDF

Info

Publication number
CN105829033A
CN105829033A CN201480070768.4A CN201480070768A CN105829033A CN 105829033 A CN105829033 A CN 105829033A CN 201480070768 A CN201480070768 A CN 201480070768A CN 105829033 A CN105829033 A CN 105829033A
Authority
CN
China
Prior art keywords
taught point
speed
taught
operation program
mechanical hand
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.)
Granted
Application number
CN201480070768.4A
Other languages
English (en)
Other versions
CN105829033B (zh
Inventor
渡边雅之
吉村高行
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Kawasaki Motors Ltd
Original Assignee
Kawasaki Jukogyo KK
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Kawasaki Jukogyo KK filed Critical Kawasaki Jukogyo KK
Publication of CN105829033A publication Critical patent/CN105829033A/zh
Application granted granted Critical
Publication of CN105829033B publication Critical patent/CN105829033B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00Programme-controlled manipulators
    • B25J9/16Programme controls
    • B25J9/1628Programme controls characterised by the control loop
    • B25J9/163Programme controls characterised by the control loop learning, adaptive, model based, rule based expert control
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00Programme-controlled manipulators
    • B25J9/16Programme controls
    • B25J9/1656Programme controls characterised by programming, planning systems for manipulators
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00Programme-controlled manipulators
    • B25J9/16Programme controls
    • B25J9/1656Programme controls characterised by programming, planning systems for manipulators
    • B25J9/1664Programme controls characterised by programming, planning systems for manipulators characterised by motion, path, trajectory planning
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05BCONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B19/00Programme-control systems
    • G05B19/02Programme-control systems electric
    • G05B19/42Recording 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
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05BCONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B2219/00Program-control systems
    • G05B2219/30Nc systems
    • G05B2219/40Robotics, robotics mapping to robotics vision
    • G05B2219/40449Continuous, smooth robot motion
    • YGENERAL 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
    • Y10TECHNICAL SUBJECTS COVERED BY FORMER USPC
    • Y10STECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
    • Y10S901/00Robots
    • Y10S901/02Arm motion controller
    • Y10S901/03Teaching system

Landscapes

  • Engineering & Computer Science (AREA)
  • Robotics (AREA)
  • Mechanical Engineering (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Numerical Control (AREA)
  • Manipulator (AREA)

Abstract

一种动作程序生成方法是使计算机以设定所述多个示教点的每一个速度的形式实行生成所述机械手的动作程序的速度设定步骤;速度设定步骤基于包含预定移动路线中的第一示教点、以及相比该第一示教点更靠近上游侧的示教点和/或相比该第一示教点更靠近下游侧的示教点在内的多个示教点的位置变化或姿势变化而设定第一示教点的速度。

Description

动作程序生成方法以及机械手的控制方法
技术领域
本发明涉及动作程序生成方法以及机械手的控制方法。
背景技术
在具备进行作业的作业部和使该作业部相对于基座移动的连杆部的机械手中,在脱机状态下示教该作业部的梢端的位置以及姿势是已知的。此时,在示教顺序中的相邻示教点前后的位置变化较大、或者相邻示教点中的作业部的姿势变化较大的情况下,可能发生在实际移动机械手时作业部的梢端位置无法到达指定的示教点。尤其,在相邻示教点间的间隔较短且示教点前后的位置变化或者机械手的姿势变化较大的情况下,机械手的控制会跟不上,造成位置精度恶化。
又,作为利用机械手的加工方法,已知的是在机械手的作业部的梢端位置上安装加工夹具,并将加工夹具向工件推压,同时使机械手的作业部的梢端对工件进行相对移动,以此进行加工的构成(例如专利文献1等)。在这样的构成中,由于位置精度的恶化直接关系到加工精度的恶化,因此并不理想。
另一方面,为了避免因机械手姿势的快速变化而造成的对机械手的过大的负载,例如在专利文献2中公开了对被输入到控制装置中的示教点的数据进行加工以使机械手姿势变得流畅的方法。
现有技术文献:
专利文献1:日本特开2011-41992号公报
专利文献2:日本特开平6-348322号公报。
发明内容
发明要解决的问题:
然而,如果像专利文献2那样对示教点的数据进行加工,则会使作业部的梢端位置的轨迹发生变化,因此难以高精度地进行位置控制。
本发明是为了解决上述问题而形成,目的是提供能够提高定位到示教点(指令值)的定位精度的、用于机械手装置的动作程序生成方法以及机械手的控制方法。
解决问题的手段:
根据本发明的一种形态的动作程序生成方法,是用于包括机械手、以及基于所述机械手的动作程序对所述机械手进行控制的控制装置的机械手装置而生成所述动作程序的动作程序生成方法,其中,所述机械手具备进行作业的作业部和使该作业部相对于基座移动的连杆部,所述机械手的动作程序包括:规定(define)所述作业部的预定移动路线的多个示教点、该多个示教点中所述作业部的姿势、以及该多个示教点中所述作业部的速度;所述动作程序生成方法是使计算机以设定所述多个示教点的每一个速度的形式实行生成所述机械手的动作程序的速度设定步骤,所述速度设定步骤基于所述预定移动路线中包含第一示教点、以及相比该第一示教点更靠近上游侧的示教点和/或相比该第一示教点更靠近下游侧的示教点在内的多个示教点的位置变化或姿势变化而设定所述第一示教点的速度。
根据上述方法,根据相对于作业部预定移动路线上游侧的示教点和/或下游侧的示教点的位置变化或姿势变化设定示教点的速度,以此能够在实际移动作业部时提高定位到示教点(指令值)的定位精度。
所述速度设定步骤包括速度降低步骤亦可,所述速度降低步骤在符合第一条件和第二条件中至少任意一方的情况下,将所述第一示教点的速度设定为与所述第一条件和所述第二条件中的任意一方均不相符的情况相比降低的值,其中,所述第一条件是指:由连接所述预定移动路线中包含第一示教点、相比该第一示教点更靠近上游侧的示教点以及相比该第一示教点更靠近下游侧的示教点在内的三个示教点的线段所形成的内角的值为预定值以下,所述第二条件是指:所述预定移动路线中的第一示教点与相比该第一示教点更靠近上游侧的示教点之间所述作业部的姿势的角度变化值为预定值以上。据此,从预定移动路线上游侧的示教点开始朝向应设定速度的示教点的线段与从该示教点开始朝向下游侧的示教点的线段形成的角度较大的情况下,降低速度。或者,应设定速度的示教点的姿势与预定移动路线上游侧的示教点中的机械手的姿势相比变化较大的情况下,降低速度。由此,能够在实际移动作业部时提高定位到示教点(指令值)的定位精度。
在所述速度设定步骤中,所述第一示教点的速度被设定为降低的值的情况下,将到达该示教点的路线中的速度设定为从比所述第一示教点靠前规定距离的位置开始慢慢降低的值。由此,能够缓和机械手的速度变化从而使机械手流畅地移动。
在所述速度设定步骤中,所述第一示教点的速度被设定为降低的值的情况下,将从该示教点开始朝向下一示教点的路线中的速度设定为保持所述第一示教点的速度的值直至比所述第一示教点靠后规定距离的位置。由此,能够提高到达示教点的到达精度,并且能够缓和机械手的速度变化从而使机械手流畅地移动。
在所述速度设定步骤中,从所述多个示教点中指定一个以上的示教点,对该被指定的一个以上的示教点进行速度设定亦可。由此,通过去除多个示教点中变化较少的示教点(位于直线上的示教点等)并采用变化较大的示教点,使得作为指令位置而有效化的示教点变少,因此能够缩短计算时间。
所述机械手装置形成为如下结构:在所述机械手的作业部安装有棒状工具,且以将该棒状工具向工件依次推压由此对该工件进行增量成形加工的形式使所述控制装置对所述机械手进行控制。在增量成型中要求高的加工精度,因此示教点较多且沿示教顺序示教点间的间隔倾向于较短。所以,在这样的增量成形中基于上述动作程序生成方法生成动作程序,以此能够提高机械手的动作精度,实现更高的加工精度。又,可以实现更加复杂的形状的加工。
根据本发明的其他形态的机械手的控制方法是基于由上述动作程序生成方法生成的动作程序对所述机械手进行控制。根据该方法,能够在实际移动作业部时提高定位到示教点(指令值)的定位精度。
参照附图,从以下的优选实施形态的详细说明可以明了本发明的上述目的、其他目的、特征以及优点。
发明效果:
本发明如以上说明那样构成,并发挥能够提高定位到示教点(指令值)的定位精度的效果。
附图说明
图1是示出含有应用了本发明的一实施形态的动作程序生成方法的计算机终端的机械手装置的概略结构的图;
图2是示出被输入至图1所示的计算机终端的三维图样数据的例子的图;
图3是图2所示的三维图样数据中Ⅲ部附近的放大图;
图4是例示图2所示的三维图样数据的各示教点被赋予的姿势坐标的图;
图5是示出应用于图1所示的机械手装置的动作程序其速度设定步骤中的处理流程的流程图;
图6是示出本实施形态中的第一条件对应的速度设定表格的图;
图7是示意性示出时间上连续的三个示教点的图。
具体实施方式
以下,参照附图说明根据本发明的实施形态。另外,以下,相同或对应的部分在所有附图中以相同的符号标记而省略重复的说明。
图1是示出含有应用了本发明的一实施形态的动作程序生成方法的计算机终端的机械手装置的概略结构的图。如图1所示,本实施形态的机械手装置1具备机械手2和作为机械手2的控制装置的机械手控制部3。机械手控制部3被输入并存储机械手2的动作程序。机械手控制部3基于该动作程序计算对机械手2的指令值,并将该指令值输出至机械手2,以此控制机械手2。
机械手2具备进行作业的作业部4和使该作业部4相对于基座5移动的连杆部6。机械手2的作业部4的梢端位置形成为可安装作为加工夹具的棒状工具7结构。连杆部6由将多根(例如6根)伸缩连杆构件13并列组合而构成的、所谓的Stewart平台(Stewartplatform)等构成。各伸缩连杆构件13其本体伸缩而连杆长度发生变化,并且通过万向节(万向接头以及球窝接头等)分别与基座5和作业部4连接。因此,机械手2通过使连杆部6的各伸缩连杆构件13伸缩,以此能够使作业部4的姿势发生变化或使作业部4的梢端位置相对工件W进行相对移动。
机械手装置1形成为,以将棒状工具7的梢端向工件W推压的同时使机械手2的作业部4的梢端对工件进行相对移动以此加工(增量成形)工件W的形式对机械手2进行控制的结构。即,本实施形态的机械手装置1作为进行增量成形(incrementalforming)的机械手装置而构成。
动作程序由3D-CAD等三维制图程序所绘制的三维图样数据生成。三维图样数据中,基于预先由CAD等得到的设计图样,通过CAM装置或CAM程序,赋予用于机械手处理的示教点以及各种编码。图2是示出被输入至图1所示的计算机终端的三维图样数据的例子的图,图3是图2所示的三维图样数据中Ⅲ部附近的放大图。图2和图3例如是用于形成机动车门板上的把手部的凹陷(供握住把手的手抽离的部分)等形状的三维图样数据。图2和图3中示出了作业部4的梢端部在多个示教点P上依次移动的预定移动路线Q。
生成动作程序的计算机终端8具备:三维图样数据被输入的输入部9;基于被输入的三维图样数据进行各种计算的CPU等计算部10;存储计算结果的RAM或者外部存储装置等存储部11;以及将生成的动作程序输出的输出部12。计算机终端8的输出部12与机械手控制部3通过有线或者无线通信连接亦可。替代地,将动作程序从计算机终端8的输出部12输出并存储至规定的存储介质(未图示),通过将存储了动作程序的存储介质连接到机械手控制部3,使机械手控制部3能够读取动作程序亦可。
动作程序包括:规定(define)机械手2的作业部4的预定移动路线的多个示教点、该多个示教点中的作业部4的姿势、以及该多个示教点中的作业部4的速度。多个示教点包括机械手2的作业部4的梢端中规定坐标系的位置坐标。又,作业部4的姿势由工具坐标系(OAT坐标系)的方向示出。生成动作程序的计算机终端8通过以下方法设定各示教点中的作业部4的姿势:基于三维图样数据,将该三维图样数据所示出的示教点的坐标转换为机械手的坐标系,或者,基于示教点的移动路线,套用预先图形化的作业部4的姿势变化。另外地或者可替代地,作业部4的姿势能通过对各个示教点人工输入等设定亦可。
图4是例示图2所示的三维图样数据的各示教点被赋予的姿势坐标的图。图4是对图2所示的三维图样数据中Ⅳ部附近的示教点上姿势坐标的方向进行例示的图。图4示出在作业部4的梢端部上设定的工具坐标系(正交坐标系)其在示教点中如何被设定。另外,图4中仅示出与图4的纸面平行的Ry轴(点划线箭头)以及Rz轴(实线箭头),而省略了与图4的纸面垂直且以朝向纸面的方向为正的Rx轴。
用于生成动作程序的计算机终端8设定基于三维图样数据的多个示教点的每一个的速度,从而实行生成机械手2的动作程序的速度设定步骤。速度设定步骤基于包含预定移动路线中的第一示教点、以及相比该第一示教点P更靠近上游侧的示教点和/或相比该第一示教点P更靠近下游侧的示教点在内的多个示教点的位置变化或姿势变化而设定第一示教点的速度。
根据上述方法,根据相对于作业部预定移动路线上游侧的示教点和/或下游侧的示教点的位置变化或姿势变化而设定示教点的速度,以此能够在实际移动作业部时提高定位到示教点(指令值)的定位精度。
以下,进行更具体的说明。图5是示出应用于图1所示的机械手装置的动作程序其速度设定步骤中的处理流程的流程图。首先,计算机终端8的计算部10中,作为初始设定,将表示示教点编号的标志P设定为初始值1并存储于存储部11(步骤S1)。接着,计算部10从存储部11读取与标志P-1,P,P+1相对应的示教点以及该示教点的位置和姿势(步骤S2)。即,计算部10读取第一示教点P、相比该第一示教点P更靠近上游侧的示教点P-1、以及相比该第一示教点P更靠近下游侧的示教点P+1的位置和姿势。另外,在初始状态(P=1)中,也读取机械手2的动作开始状态中的信息(作业部4的位置和姿势)作为示教点P=0(P-1)。
然后,计算部10基于所读取的从示教点P-1到示教点P的位置变化以及姿势变化而设定示教点P中的作业部4的速度V0(以下,初始条件速度)(步骤S3)。
此外,计算部10判定所读取的示教点P-1,P,P+1是否满足第一条件(步骤S4)。第一条件是指:由连接预定移动路线中包含第一示教点P、相比该第一示教点P更靠近上游侧的示教点P-1、以及相比该第一示教点P更靠近下游侧的示教点P+1在内的三个示教点P-1,P,P+1的线段形成的内角θ的值为预定值以下。满足第一条件的情况下(步骤S4中是),计算部10将示教点P中的作业部4的速度设定为低于初始条件速度V0的值(以下,第一条件速度V1)(步骤S5)。
第一条件速度V1根据连接三个示教点P-1,P,P+1的线段的内角θ的值而决定。具体的,存储部11中预先存储有与内角θ的范围及其对应的速度相关联的速度设定表格,计算部10计算上述线段的内角θ的值,并从速度设定表格读取计算求得的内角θ其所属范围对应的速度,从而设定第一条件速度V1。图6是示出本实施形态中的第一条件对应的速度设定表格的图。如图6所示,速度设定表格设定为内角θ越小(变成锐角的程度),速度值越低。
又,计算部10判定所读取的示教点P-1、P是否满足第二条件(步骤S6)。第二条件是指:预定移动路线中的第一示教点P与相比该第一示教点P更靠近上游侧的示教点P-1之间作业部4的姿势的角度变化值为预定值以上。例如,姿势的角度变化值可设定为两个示教点P-1、P之间工具坐标轴Rx、Ry、Rz中角度变化最大的轴中的角度变化值,也可设定为预定的工具坐标轴Rx、Ry、Rz中至少一个轴中的角度变化值。
满足第二条件的情况下(步骤S6中是),计算部10将示教点P中的作业部4的速度设定为低于初始条件速度V0的值(以下,第二条件速度V2)(步骤S7)。第二条件速度V2根据两个示教点P-1、P的每一个中的作业部4的姿势变化大小而决定。在第二条件速度V2中,亦与第一条件速度V1中所用的速度设定表格(图6)相同地,将与姿势的角度变化的范围及其对应的速度相关联的速度设定表格存储于存储部11中,计算部10计算姿势的角度变化值,并从速度设定表格读取计算求得的姿势的角度变化其所属范围对应的速度,从而设定第二条件速度V2
计算部10将算出的速度中被设定成最低速的速度设定为该示教点P的速度VP(步骤S8至S12)。即,计算部10判定是否设定了第一条件速度V1和/或第二条件速度V2(步骤S8),设定有第一条件速度V1和/或第二条件速度V2的情况下(步骤S8中是),判定第一条件速度V1、V2中的哪个速度更低(步骤S9)。计算部10将第一条件速度V1和第二条件速度V2中更低的速度设定为该示教点P的速度VP
即,第一条件速度V1为第二条件速度V2以下的情况下(步骤S9中是),将第一条件速度V1设定为该示教点P的速度VP(步骤S10),第一条件速度V1大于第二条件速度V2的情况下(步骤S9中否),将第二条件速度V2设定为该示教点P的速度(步骤S11)。另外,在仅仅只算出第一条件速度V1和第二条件速度V2中任意一方的情况下,将所算出的条件速度设定为该示教点P的速度VP。例如,关于未算出的条件速度,设定初始条件速度V0亦可。具体的,在步骤4中否的情况下,设定初始条件速度V0作为第一条件速度V1,类似的,在步骤6中否的情况下,设定初始条件速度V0作为第二条件速度V2
第一条件速度V1或第二条件速度V2均未算出的情况下(步骤4中否且步骤6中否的情况下),计算部10将初始条件速度V0设定为示教点P的速度VP(步骤S12)。
由此,在速度设定步骤中包括速度降低步骤,所述速度降低步骤为:在第一示教点P与该示教点P上游侧的示教点P-1和/或该示教点P下游侧的示教点P+1的关系符合第一条件和第二条件中至少任意一方的情况下,将第一示教点P的速度VP设定为与第一条件和第二条件中的任意一方均不相符的情况(初始条件速度V0)相比降低的值。
设定示教点P的速度VP之后,计算部10将标志P加1(设置为P=P+1)并存储到存储部11(步骤S13)。计算部10判定标记P是否已达到表示机械手2的一个循环的动作中最后一个示教点的Pfin(步骤S14)。标记P超过Pfin时(步骤S14中是),计算部10判断为已设定所有示教点P的速度VP而处理结束。标记P为Pfin以下的情况下(步骤S14中否),计算部10进行以下处理:基于以新的示教点P为中心的三个示教点,设定新的示教点P(P+1)的速度VP(步骤S2~S12)。
根据上述结构,从预定移动路线上游侧的示教点P-1开始朝向应设定速度的示教点P的线段与从该示教点P开始朝向下游侧的示教点P+1的线段形成的角度(内角)θ较大的情况下,将速度VP降低至第一条件速度V1。或者,应设定速度VP的示教点P的姿势与预定移动路线上游侧的示教点P-1中的机械手2的姿势相比变化较大的情况下,将速度VP降低至第二条件速度V2。由此,能够在实际移动作业部4时提高定位到示教点(指令值)的定位精度。尤其,在增量成型中要求高加工精度,因此示教点较多(例如,可能发生一个循环的加工中有几万点示教点)且沿示教顺序示教点间的间隔倾向于较短(例如,间隔约0.3mm)。所以,在这样的增量成形中基于上述动作程序生成方法生成动作程序,以此能够提高机械手2的动作精度,实现更高的加工精度。又,可以实现更加复杂的形状的加工。
在速度设定步骤中,第一示教点P的速度VP被设定为降低的值的情况下,即,实行速度降低步骤的情况下,能够将从其上游侧的示教点P-1至该示教点P之间的速度控制和/或从该示教点P至其下游侧的示教点P+1之间的速度控制设置为与平时不同的控制。
图7是示意性示出时间上连续的三个示教点的图。如图7所示,在速度设定步骤中,在第一示教点P的速度VP被设定为降低的值(第一条件速度V1或者第二条件速度V2)的情况下,计算部10将到达该示教点P的路线中的速度Vapp设定为从比第一示教点P靠前规定距离Lapp的位置开始慢慢降低的值。减速度根据示教点P的速度VP设定亦可。由此,能够缓和机械手2的速度变化从而使机械手2流畅地移动。另外,第一示教点P与上游侧的示教点P-1之间的距离比距离Lapp短的情况下,设定为从上游侧的示教点P-1的速度Vp-1慢慢降低速度从而达到示教点P的速度Vp亦可。
此外,计算部10将从示教点P开始朝向下一示教点P+1的路线中的速度Vdep设定为保持第一示教点P的速度VP的值(即,Vdep=Vp)直至比第一示教点P靠后规定距离Ldep的位置。由此,能够提高到达示教点P的到达精度,并且能够缓和机械手2的速度变化从而使机械手2流畅地移动。另外,第一示教点P与下游侧的示教点P+1之间的距离比距离Ldep短的情况下,使下游侧的示教点P+1的速度Vp+1与示教点P的速度Vp相同(使示教点P和示教点P+1之间进行等速动作)亦可。
上述距离Lapp、Ldep如上所述设定为一定的距离亦可,替代地,设定为相对于两个示教点间距离的比例亦可。例如,从第一示教点P与上游侧的示教点P-1的距离Lp-1,p的一半位置开始速度被控制为慢慢降低亦可。即,可以设定为距离Lapp=Lp-1,p/2。又,例如,控制为保持速度直至第一示教点P与下游侧的示教点P+1的距离Lp,p+1的三分之一的位置亦可。即,也可设定为距离Ldep=Lp,p+1/3。
另外,可以不对三维图样数据所示出的所有示教点执行速度设定步骤。例如,对于直线部分等被认为基本上未发生速度变化的示教点,不执行速度设定步骤亦可。这种情况下,在速度设定步骤中,从三维图样数据所包含的多个示教点中指定一个以上的示教点。计算部10对被指定的一个以上的示教点进行速度设定。由此,通过去除多个示教点中变化较少的示教点(位于直线上的示教点等)并采用变化较大的示教点,使得作为指令位置而有效化的示教点变少,因此能够缩短计算时间。
选择进行速度设定的示教点,操作员可以一点一点任意地选择,操作员也可以对直线区域等规定的区域进行范围指定,以此不对范围指定的区域内的示教点进行速度设定。又,同样地进行范围指定,范围指定的区域内的示教点中,仅将每等间隔规定的示教点作为示教点处理亦可(例如,连续十点中的一点被指定为进行速度设定的示教点而其余九点被指定为不进行速度设定的点等)。
这样进行示教点的选择的情况下,图5所示的速度设定步骤的流程图中时间上连续的示教点P-1,P,P+1不限于三维图样数据上连续的三个示教点。即,亦可假定三维图样数据上的多个示教点中,进行速度设定的第一示教点与速度降低步骤所针对的上游侧的示教点和/或下游侧的示教点之间存在示教点。此外,关于被用作速度降低步骤时的条件的示教点P-1,P+1,亦可不一定必须设定速度。例如,对每规定数的示教点隔开间隔进行速度的设定,另一方面,对是否使用该进行速度设定的示教点以及其前一个示教点和/或后一个示教点(任一示教点均未进行速度的设定)执行速度降低步骤进行判定(步骤S4,S6)亦可。
以上,对本发明的实施形态进行了说明,但本发明并非限于上述实施形态,在不脱离该主旨的范围内,可以进行各种改良、变形、修改。
例如,在上述实施形态中,作为本发明应用的机械手2,例示了连杆部6中采用了Stewart平台的增量成形用机械手,但本发明不限于此。可以应用于具备进行作业的作业部和使该作业部相对于基座移动的连杆部那样的各种机械手。例如,应用于具备多个臂构件和连接这些臂构件的多个关节(旋转轴)的多关节机械手亦可。
又,在上述实施形态中设置为,判定第一条件(步骤S4)和第二条件(步骤S6)这两方,如满足至少任意一方的条件则进行速度降低步骤,与此同时,任一条件均满足的情况下,采用设定的第一条件速度V1和者第二条件速度V2中速度更低的一方。然而,本发明不限于此。例如,设置为仅判定第一条件和第二条件的任意一方亦可。又,设置为例如不满足第一条件的情况下判定是否满足第二条件,而满足第一条件的情况下不进行第二条件的判定亦可。将第一条件和第二条件进行置换亦可。
基于上述说明,本领域技术人员能够明了本发明的较多的改良和其他实施形态等。因此,上述说明仅作为示例性的解释,旨在向本领域技术人员提供教导实施本发明的最优选的形态。在不脱离本发明的精神的范围内,可以实质上变更其结构和/或功能的具体内容。
工业应用性:
本发明的动作程序生成方法以及机械手的控制方法对于提高定位到示教点(指令值)的定位精度是有用的。
符号说明:
1机械手装置
2机械手
3机械手控制部(控制装置)
4作业部
5基座
6连杆部
7棒状工具
8计算机终端
9输入部
10计算部
11存储部
12输出部
W工件。

Claims (7)

1.一种动作程序生成方法,是用于包括机械手、以及基于所述机械手的动作程序对所述机械手进行控制的控制装置的机械手装置而生成所述动作程序的动作程序生成方法,其中,所述机械手具备进行作业的作业部和使该作业部相对于基座移动的连杆部,所述机械手的动作程序包括:规定所述作业部的预定移动路线的多个示教点、该多个示教点中所述作业部的姿势、以及该多个示教点中所述作业部的速度;
所述动作程序生成方法是使计算机以设定所述多个示教点的每一个速度的形式实行生成所述机械手的动作程序的速度设定步骤;
所述速度设定步骤基于所述预定移动路线中包含第一示教点、以及相比该第一示教点更靠近上游侧的示教点和/或相比该第一示教点更靠近下游侧的示教点在内的多个示教点的位置变化或姿势变化而设定所述第一示教点的速度。
2.根据权利要求1所述的动作程序生成方法,其特征在于,
所述速度设定步骤包括速度降低步骤,所述速度降低步骤在符合第一条件和第二条件中至少任意一方的情况下,将所述第一示教点的速度设定为与所述第一条件和所述第二条件中的任意一方均不相符的情况相比降低的值,其中,所述第一条件是指:由连接所述预定移动路线中包含第一示教点、相比该第一示教点更靠近上游侧的示教点以及相比该第一示教点更靠近下游侧的示教点在内的三个示教点的线段所形成的内角的值为预定值以下,所述第二条件是指:所述预定移动路线中的第一示教点与相比该第一示教点更靠近上游侧的示教点之间所述作业部的姿势的角度变化值为预定值以上。
3.根据权利要求2所述的动作程序生成方法,其特征在于,
在所述速度设定步骤中,所述第一示教点的速度被设定为降低的值的情况下,将到达该示教点的路线中的速度设定为从比所述第一示教点靠前规定距离的位置开始慢慢降低的值。
4.根据权利要求2或3所述的动作程序生成方法,其特征在于,
在所述速度设定步骤中,所述第一示教点的速度被设定为降低的值的情况下,将从该示教点开始朝向下一示教点的路线中的速度设定为保持所述第一示教点的速度的值直至比所述第一示教点靠后规定距离的位置。
5.根据权利要求1至4中任一项所述的动作程序生成方法,其特征在于,
在所述速度设定步骤中,从所述多个示教点中指定一个以上的示教点,对该被指定的一个以上的示教点进行速度设定。
6.根据权利要求1至5中任一项所述的动作程序生成方法,其特征在于,
所述机械手装置形成为如下结构:在所述机械手的作业部安装有棒状工具,且以将该棒状工具向工件依次推压由此对该工件进行增量成形加工的形式使所述控制装置对所述机械手进行控制。
7.一种机械手的控制方法,基于由权利要求1至6中任一项所述的动作程序生成方法生成的动作程序对所述机械手进行控制。
CN201480070768.4A 2013-12-25 2014-12-22 动作程序生成方法以及机械手的控制方法 Active CN105829033B (zh)

Applications Claiming Priority (3)

Application Number Priority Date Filing Date Title
JP2013-267755 2013-12-25
JP2013267755A JP6360301B2 (ja) 2013-12-25 2013-12-25 動作プログラム作成方法およびロボットの制御方法
PCT/JP2014/006382 WO2015098085A1 (ja) 2013-12-25 2014-12-22 動作プログラム作成方法およびロボットの制御方法

Publications (2)

Publication Number Publication Date
CN105829033A true CN105829033A (zh) 2016-08-03
CN105829033B CN105829033B (zh) 2018-09-07

Family

ID=53477983

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201480070768.4A Active CN105829033B (zh) 2013-12-25 2014-12-22 动作程序生成方法以及机械手的控制方法

Country Status (5)

Country Link
US (1) US10105842B2 (zh)
EP (1) EP3088142B1 (zh)
JP (1) JP6360301B2 (zh)
CN (1) CN105829033B (zh)
WO (1) WO2015098085A1 (zh)

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN109760080A (zh) * 2018-12-27 2019-05-17 大族激光科技产业集团股份有限公司 一种机械夹具组及相关方法

Families Citing this family (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP6816364B2 (ja) * 2016-02-25 2021-01-20 セイコーエプソン株式会社 制御装置、ロボット、及びロボットシステム
CN106003067A (zh) * 2016-07-14 2016-10-12 东莞市李群自动化技术有限公司 工业机器人示教方法和示教文件制作方法及装置
JP6464204B2 (ja) * 2017-01-17 2019-02-06 ファナック株式会社 オフラインプログラミング装置及び位置パラメータ補正方法
JP6904759B2 (ja) * 2017-04-11 2021-07-21 日本電産サンキョー株式会社 ロボットの移動速度制御装置及び方法
JP6592053B2 (ja) 2017-10-11 2019-10-16 ファナック株式会社 作業ツールの移動方向を監視する制御装置

Citations (10)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH08123531A (ja) * 1994-10-24 1996-05-17 Hitachi Ltd 軌道の制御方法
JPH1039917A (ja) * 1996-07-26 1998-02-13 Daihen Corp ロボットの制御方法
JPH1069310A (ja) * 1996-08-28 1998-03-10 Matsushita Electric Ind Co Ltd ロボットの軌道生成装置
JPH10301616A (ja) * 1997-04-25 1998-11-13 Tokico Ltd ロボットの教示装置
JPH1124720A (ja) * 1997-07-03 1999-01-29 Fanuc Ltd ロボットの教示プログラムの変換方法
JPH11104982A (ja) * 1997-10-01 1999-04-20 Meidensha Corp ロボットの教示方法
JPH11249723A (ja) * 1998-03-03 1999-09-17 Kawasaki Heavy Ind Ltd ロボットの制御方法および制御装置
CN1319478A (zh) * 2000-03-28 2001-10-31 松下电器产业株式会社 机器人教示装置,使用它的机器人和机器人的操作方法
CN102785046A (zh) * 2011-05-17 2012-11-21 发那科株式会社 具备学习控制功能的机器人和点焊机器人
JP2013215753A (ja) * 2012-04-05 2013-10-24 Toyota Motor Corp インクリメンタル成形加工時の金属板の押さえ治具及びインクリメンタル成形加工時の金属板の押さえ方法

Family Cites Families (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS59106007A (ja) * 1982-12-10 1984-06-19 Toyota Central Res & Dev Lab Inc 多関節型ロボツトの軌跡制御装置
JPH079606B2 (ja) * 1988-09-19 1995-02-01 豊田工機株式会社 ロボット制御装置
JPH06348322A (ja) 1993-06-07 1994-12-22 Fanuc Ltd ロボットのオフライン教示方法
JPH06348332A (ja) 1993-06-14 1994-12-22 Toshiba Corp プラント運転制御装置
JPH07319547A (ja) * 1994-05-20 1995-12-08 Fanuc Ltd ロボットの倣い制御方法
JP5236596B2 (ja) 2009-08-19 2013-07-17 ファナック株式会社 加工ロボットシステム
JP5479541B2 (ja) * 2011-08-23 2014-04-23 パナソニック株式会社 パラレルリンクロボットおよびその動作教示方法
JP5696682B2 (ja) * 2012-04-05 2015-04-08 トヨタ自動車株式会社 金属板の成形加工方法
JP5426722B2 (ja) * 2012-05-24 2014-02-26 ファナック株式会社 ロボットプログラム変更装置

Patent Citations (10)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH08123531A (ja) * 1994-10-24 1996-05-17 Hitachi Ltd 軌道の制御方法
JPH1039917A (ja) * 1996-07-26 1998-02-13 Daihen Corp ロボットの制御方法
JPH1069310A (ja) * 1996-08-28 1998-03-10 Matsushita Electric Ind Co Ltd ロボットの軌道生成装置
JPH10301616A (ja) * 1997-04-25 1998-11-13 Tokico Ltd ロボットの教示装置
JPH1124720A (ja) * 1997-07-03 1999-01-29 Fanuc Ltd ロボットの教示プログラムの変換方法
JPH11104982A (ja) * 1997-10-01 1999-04-20 Meidensha Corp ロボットの教示方法
JPH11249723A (ja) * 1998-03-03 1999-09-17 Kawasaki Heavy Ind Ltd ロボットの制御方法および制御装置
CN1319478A (zh) * 2000-03-28 2001-10-31 松下电器产业株式会社 机器人教示装置,使用它的机器人和机器人的操作方法
CN102785046A (zh) * 2011-05-17 2012-11-21 发那科株式会社 具备学习控制功能的机器人和点焊机器人
JP2013215753A (ja) * 2012-04-05 2013-10-24 Toyota Motor Corp インクリメンタル成形加工時の金属板の押さえ治具及びインクリメンタル成形加工時の金属板の押さえ方法

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN109760080A (zh) * 2018-12-27 2019-05-17 大族激光科技产业集团股份有限公司 一种机械夹具组及相关方法

Also Published As

Publication number Publication date
US20160325431A1 (en) 2016-11-10
US10105842B2 (en) 2018-10-23
CN105829033B (zh) 2018-09-07
EP3088142A4 (en) 2017-09-13
WO2015098085A1 (ja) 2015-07-02
JP2015123517A (ja) 2015-07-06
JP6360301B2 (ja) 2018-07-18
EP3088142B1 (en) 2020-02-05
EP3088142A1 (en) 2016-11-02

Similar Documents

Publication Publication Date Title
CN105829033A (zh) 动作程序生成方法以及机械手的控制方法
CN106346478A (zh) 机械臂的控制方法和装置
CN104423318B (zh) 具有冗余的轴的加工机及实时地解决冗余
EP2495628A1 (en) Tool path generation method and device
CN111002315B (zh) 一种轨迹规划方法、装置及机器人
CN106003033A (zh) 一种具有力控制的六自由度机械臂标准汉字书写方法
CN105522577B (zh) 一种用于五轴折弯机器人笛卡尔轨迹规划的方法及其装置
CN109465817B (zh) 机器人系统、机器人控制装置和被加工物的制造方法
EP2634658A1 (en) Tool path generation method and tool path generation device
JP2007286976A (ja) ロボットシミュレーション装置
EP1310338A3 (en) Simulation system
EP3624997B1 (en) Method and control system for controlling movement sequences of a robot
JP2728399B2 (ja) ロボツトの制御方法
CN105563463A (zh) 加工装置、示教方法、工件的生产方法、控制器及控制方法
US11833687B2 (en) Robot apparatus, control method for the robot apparatus, assembly method using the robot apparatus, and recording medium
CN104793615A (zh) 机器人及机器人的控制方法
KR101989123B1 (ko) 동작지령 검증방법, 가공장치의 제어방법, 동작지령 검증프로그램을 기록한 기록매체 및 동작지령 검증시스템
CN112171664B (zh) 基于视觉识别的生产线机器人轨迹补偿方法、装置和系统
JPH08286722A (ja) Cadデータ利用オフラインティーチング方法及びそのシステム
JPH06122025A (ja) プレスブレーキロボットシステムのワーク曲げ追従方法
CN113302026B (zh) 两个机器人机械手的路径的协调
KR100288318B1 (ko) 8축 로봇을 이용한 모서리 작업방법
JP2009012057A (ja) 線状加熱曲げ加工の加熱位置修正方法
JPH0962325A (ja) ロボット到達可否判断装置
CN112643680A (zh) 运动学逆解方法、机器人以及计算机可读储存介质

Legal Events

Date Code Title Description
C06 Publication
PB01 Publication
C10 Entry into substantive examination
SE01 Entry into force of request for substantive examination
GR01 Patent grant
GR01 Patent grant