CN115734847A - 数值控制系统 - Google Patents

数值控制系统 Download PDF

Info

Publication number
CN115734847A
CN115734847A CN202180046017.9A CN202180046017A CN115734847A CN 115734847 A CN115734847 A CN 115734847A CN 202180046017 A CN202180046017 A CN 202180046017A CN 115734847 A CN115734847 A CN 115734847A
Authority
CN
China
Prior art keywords
robot
coordinate
numerical control
controller
numerical
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
Application number
CN202180046017.9A
Other languages
English (en)
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.)
Fanuc Corp
Original Assignee
Fanuc Corp
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 Fanuc Corp filed Critical Fanuc Corp
Publication of CN115734847A publication Critical patent/CN115734847A/zh
Pending legal-status Critical Current

Links

Images

Classifications

    • 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/18Numerical control [NC], i.e. automatically operating machines, in particular machine tools, e.g. in a manufacturing environment, so as to execute positioning, movement or co-ordinated operations by means of programme data in numerical form
    • G05B19/4155Numerical control [NC], i.e. automatically operating machines, in particular machine tools, e.g. in a manufacturing environment, so as to execute positioning, movement or co-ordinated operations by means of programme data in numerical form characterised by programme execution, i.e. part programme or machine function execution, e.g. selection of a programme
    • 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/418Total 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], computer integrated manufacturing [CIM]
    • G05B19/41845Total 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], computer integrated manufacturing [CIM] characterised by system universality, reconfigurability, modularity
    • 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/1658Programme controls characterised by programming, planning systems for manipulators characterised by programming language
    • 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/1661Programme controls characterised by programming, planning systems for manipulators characterised by task planning, object-oriented languages
    • 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/39Robotics, robotics to robotics hand
    • G05B2219/39001Robot, manipulator control
    • 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/39Robotics, robotics to robotics hand
    • G05B2219/39158Configuration description language, to define behaviour of system

Abstract

数值控制系统(1)具有:数值控制装置(5),其按照机床用的数值控制程序生成针对机床(2)的指令即机床指令信号,按照机器人用的数值控制程序生成针对机器人(3)的指令即机器人指令信号;机器人控制装置(6),其能够与数值控制装置(5)进行通信,并且根据机器人指令信号控制机器人(3)的动作。机器人控制装置(6)取得确定机器人(3)的形态所需的信息即形态信息,并将该形态信息发送到数值控制装置(5),数值控制装置(5)根据从机器人控制装置(6)发送的形态信息以及机器人用的数值控制程序生成机器人指令信号。

Description

数值控制系统
技术领域
本公开涉及数值控制系统。
背景技术
一般而言,用于控制机床的数值控制程序与用于控制机器人的机器人程序的程序语言不同。因此,为了使机床和机器人并行地运转,操作员需要对数值控制程序和机器人程序双方都熟练。
在专利文献1中示出了通过数值控制程序来控制机床和机器人双方的数值控制装置。根据专利文献1的数值控制装置,熟悉数值控制程序的操作员不用对机器人程序熟练也能控制机器人。
现有技术文献
专利文献
专利文献1:日本专利第6647472号发明内容
发明要解决的课题
然而,一般的6轴多关节型机器人的位置以及姿态通过以6个关节的旋转角度值(J1、J2、J3、J4、J5、J6)为成分的关节坐标格式(joint coordinate format,也称为各轴坐标格式)、以沿着3个直角坐标轴的坐标值(X、Y、Z)以及绕各直角坐标轴的旋转角度值(A、B、C)为成分的直角坐标格式等来表现。因此,数值控制装置中的数值控制程序优选能够以关节坐标格式以及直角坐标格式中的任一种坐标格式来制作。
在此,根据在关节坐标格式下制作出的数值控制程序,直接指定机器人的各关节的旋转角度,因此,机器人的各臂部、手腕的轴配置、能够旋转360度以上的关节的转速(以下,将它们统称为“机器人的形态”)也唯一地确定。与之相对地,在直角坐标格式下,基本上通过上述的6个坐标值(X、Y、Z、A、B、C)来指定机器人的控制点(例如,机器人的臂部前端部)的位置以及姿态,因此,机器人的形态无法唯一地确定。
因此,以往在数值控制装置中在直角坐标格式下制作数值控制程序时,操作员除了控制点的坐标值,还需要确定用于确定机器人的形态的形态信息,程序大小相应地增加。另外,在操作员不熟悉机器人的情况下,制作机器人的数值控制程序可能花费时间。
本公开是鉴于上述课题而完成的,提供一种能够制作用于控制机器人的数值控制程序而不用识别机器人的形态的数值控制系统。
用于解决课题的手段
本公开的一方式是一种数值控制系统,具有:数值控制装置,其按照第一数值控制程序生成针对机床的指令即机床指令信号,按照第二数值控制程序生成针对机器人的指令即机器人指令信号;以及机器人控制装置,其能够与所述数值控制装置进行通信,并且根据所述机器人指令信号来控制所述机器人的动作,其中,所述机器人控制装置取得确定所述机器人的形态所需的信息即形态信息,并将该形态信息发送到所述数值控制装置,所述数值控制装置根据从所述机器人控制装置发送的形态信息以及所述第二数值控制程序来生成所述机器人指令信号。
发明效果
在本公开的一方式中,数值控制装置按照第一数值控制程序生成针对机床的机床指令信号,并且按照第二数值控制程序生成针对机器人的机器人指令信号,机器人控制装置能够与数值控制装置进行通信,并且根据从数值控制装置发送的机器人指令信号来控制机器人的动作。另外,机器人控制装置取得确定机器人的形态所需的信息即形态信息,并将该形态信息发送到数值控制装置,数值控制装置根据从机器人控制装置发送的形态信息和第二数值控制程序生成机器人指令信号。由此,根据本公开的一方式,数值控制装置能够根据需要取得此时的机器人的形态信息,因此,操作员能够制作第二数值控制程序而不用识别机器人的形态,所以对于不熟悉机器人的操作员来说是很便利的。由此,还可以将第二数值控制程序的大小压缩机器人的形态信息的量。
附图说明
图1是本公开的一实施方式的数值控制系统的概略图。
图2是数值控制装置以及机器人控制装置的功能框图。
图3A是表示坐标形态信息管理处理的过程的流程图(其1)。
图3B是表示坐标形态信息管理处理的过程的流程图(其2)。
图4是机器人用的数值控制程序的一例。
图5A是根据图4所例示的机器人用的数值控制程序使数值控制装置工作时的时序图(其1)。
图5B是根据图4所例示的机器人用的数值控制程序使数值控制装置工作时的时序图(其2)。
具体实施方式
以下,参照附图,对本公开的一实施方式的数值控制系统1进行说明。
图1是本实施方式的数值控制系统1的概略图。
数值控制系统1具有:机床2、控制该机床2的数值控制装置(CNC)5、设置在机床2的附近的机器人3、以及能够通信地与数值控制装置5连接的机器人控制装置6。数值控制装置5按照规定的数值控制程序,生成针对机床2的指令即机床指令信号以及针对机器人3的指令即机器人指令信号,并将这些机床指令信号以及机器人指令信号发送到机床2以及机器人控制装置6。机器人控制装置6根据从数值控制装置5发送的机器人指令信号来控制机器人3的动作。
机床2根据从数值控制装置5发送的机床指令信号对未图示的工件进行加工。在此,机床2例如是车床、钻床、铣床、磨床、激光加工机以及注射成型机等,但不限于此。
机器人3在机器人控制装置6的控制下进行动作,例如对经机床2加工了的工件进行规定作业。机器人3例如是多关节机器人,在其臂部前端部31安装有用于把持工件的把持工具32。以下,对机器人3在规定位置利用把持工具32把持经机床2加工了的工件,并将该工件向规定位置输送的情况进行说明,但不限于此。另外,以下对机器人3为6轴的多关节机器人的情况进行说明,但轴数不限于此。
数值控制装置5以及机器人控制装置6分别是由CPU(Central Processing Unit:中央处理单元)等运算处理单元、储存各种程序的HDD(Hard Disk Drive:硬盘驱动器)、SSD(Solid State Drive:固态硬盘)等辅助存储单元、用于储存运算处理单元执行程序时暂时需要的数据的RAM(Random Access Memory:随机存取存储器)这样的主存储单元、操作员进行各种操作的键盘这样的操作单元、以及向操作员显示各种信息的显示器这样的显示单元等硬件构成的计算机。这些机器人控制装置6以及数值控制装置5例如能够通过以太网(注册商标)相互收发各种信号。
图2是数值控制装置5以及机器人控制装置6的功能框图。
如图2所示,在数值控制装置5中,通过上述硬件结构,实现作为机床2的控制系统的机床控制模块51、作为机器人3的控制系统的机器人控制模块52、以及存储部53等的各种功能。
在存储部53中例如储存有根据操作员的操作而制作出的多个数值控制程序。更具体而言,在存储部53中储存有用于控制机床2的动作的作为第一数值控制程序的机床用的数值控制程序、用于控制机器人3的动作的作为第二数值控制程序的机器人用的数值控制程序等。这些机床用的数值控制程序以及机器人用的数值控制程序用共同的编程语言(例如,G代码)编写。
根据以在机床2上或机床2的附近确定的基准点为原点的作为第一坐标系的机床坐标系,来描述机床用的数值控制程序。即,在机床用的数值控制程序中,通过机床坐标系中的坐标值来描述机床2的控制点的位置以及姿态。
根据与机床坐标系不同的作为第二坐标系的机器人坐标系,来描述机器人用的数值控制程序。即,在机器人用的数值控制程序中,通过与机床坐标系不同的机器人坐标系中的坐标值来描述机器人3的控制点(例如,机器人3的臂部前端部31)的位置以及姿态。该机器人坐标系是以在机器人3上或机器人3的附近确定的基准点为原点的坐标系。此外,以下对机器人坐标系与机床坐标系不同的情况进行说明,但本公开不限于此。机器人坐标系也可以与机床坐标系一致。换言之,可以使机器人坐标系的原点、坐标轴方向与机床坐标系的原点、坐标轴方向一致。
另外,在该机器人用的数值控制程序中,机器人坐标系可以在控制轴不同的2个以上的坐标格式之间切换。更具体而言,在机器人用的数值控制程序中,机器人3的控制点的位置以及姿态可以通过直角坐标格式或者关节坐标格式来指定。
在关节坐标格式中,机器人3的控制点的位置以及姿态通过以机器人3的6个关节的旋转角度值(J1、J2、J3、J4、J5、J6)为成分的共计6个实数的坐标值来指定。
在直角坐标格式中,机器人3的控制点的位置以及姿态通过以沿着3个直角坐标轴的3个坐标值(X,Y,Z)和绕各直角坐标轴的3个旋转角度值(A,B,C)为成分的共计6个实数的坐标值来指定。
在此,在关节坐标格式下,直接指定机器人3的各关节的旋转角度,因此,机器人3的各臂部或手腕的轴配置、能旋转360度以上的关节的转速(以下,将它们统称为“机器人3的形态”)也唯一地确定。与之相对地,在直角坐标格式下,通过6个坐标值(X、Y、Z、A、B、C)来指定机器人3的控制点的位置以及姿态,因此,机器人3的形态无法唯一地确定。因此,在机器人用的数值控制程序中,可以通过规定位数的整数值即形态值P来指定机器人3的形态。因此,机器人3的控制点的位置以及姿态和机器人3的形态在关节坐标格式下由6个坐标值(J1、J2、J3、J4、J5、J6)来表示,在直角坐标格式下由6个坐标值以及1个形态值(X、Y、Z、A、B、C、P)来表示。
在机器人用的数值控制程序中,可以通过G代码“G68.8”以及“G68.9”来设定坐标格式。更具体而言,通过输入G代码“G68.8”,坐标格式被设定为关节坐标格式,通过输入G代码“G68.9”,坐标格式被设定为直角坐标格式。用于设定这些坐标格式的G代码“G68.8”以及“G68.9”是模态(modal)。因此,在坐标格式被这些G代码设定为关节坐标格式或直角坐标格式之后,就维持坐标格式,直到坐标格式被这些G代码再次变更。此外,在本实施方式中,在机器人用的数值控制程序中没有记载用于设定这些坐标格式的G代码时,坐标格式自动地被设定为直角坐标格式,但不限于此。
机床控制模块51按照机床用的数值控制程序生成针对机床2的指令即机床指令信号,输入到机床2的未图示的致动器。更具体而言,机床控制模块51读出储存在存储部53中的机床用的数值控制程序,并对基于该数值控制程序的指令类别进行解析来生成机床指令信号。机床2根据从机床控制模块51发送的机床指令信号进行动作,对未图示的工件进行加工。
机器人控制模块52按照机器人用的数值控制程序生成针对机器人3的指令即机器人指令信号、针对机器人控制装置6的各种请求信号,并将这些信号发送到机器人控制装置6。更具体而言,机器人控制模块52具有:程序输入部521、输入解析部522、坐标形态信息控制部523、坐标形态信息管理部524、机器人指令信号生成部525、存储器526、坐标显示部527以及数据收发部528,通过它们生成机器人指令信号、各种请求信号。
程序输入部521从存储部53读出机器人用的数值控制程序,并将其依次输入到输入解析部522。
输入解析部522按程序块依次解析基于从程序输入部521输入的数值控制程序的指令类别,并将解析结果发送到坐标形态信息控制部523以及机器人指令信号生成部525。
坐标形态信息控制部523根据从输入解析部522输入的解析结果,确定根据机器人用的数值控制程序设定的坐标格式即指定坐标格式。如上所述,在机器人用的数值控制程序中,坐标格式能够通过规定的G代码设定或者变更为关节坐标格式或直角坐标格式。坐标形态信息控制部523根据从输入解析部522输入的解析结果来确定指定坐标格式,并将与当前的指定坐标格式相关的信息发送到坐标形态信息管理部524以及机器人指令信号生成部525。
另外,坐标形态信息控制部523在机器人用的数值控制程序的执行过程中在规定的时刻,将用于从机器人控制装置6新取得与确定出的指定坐标格式中各控制轴的当前坐标值相当的基准坐标值的基准坐标值请求信号、用于从机器人控制装置6新取得与机器人3的当前形态值相当的基准形态值的基准形态值请求信号,写入到数据收发部528,并将这些基准坐标值请求信号以及基准形态值请求信号发送到机器人控制装置6。此外,关于将这些基准坐标值请求信号以及基准形态值请求信号发送到机器人控制装置6的时刻,将在后面详细地进行说明。
坐标形态信息管理部524通过存储器526管理以由坐标形态信息控制部523确定出的指定坐标格式中各控制轴的坐标值为成分的坐标信息以及以机器人3的形态值为成分的形态信息。如图2所示,存储器526具有用于储存多个成分的坐标值的坐标信息储存区域526a和用于储存形态值的形态信息储存区域526b。在存储器526的坐标信息储存区域526a中储存多组坐标值,在形态信息储存区域526b中例如储存1组形态值。在此,可以储存在坐标信息储存区域526a中的坐标值的组数,即由坐标形态信息管理部524以及存储器526管理的坐标信息的成分数量,优选比直角坐标格式的控制轴数量即6与关节坐标格式的控制轴数量即6之和少。以下,对将可以储存在坐标信息储存区域526a中的坐标值的组数设为直角坐标格式以及关节坐标格式的控制轴数量即6的情况进行说明,但不限于此。
坐标形态信息管理部524在指定坐标格式为关节坐标格式时,按照后面参照图3A以及图3B说明的过程,取得机器人3的关节坐标格式中各控制轴的坐标值(J1、J2、J3、J4、J5、J6),并将这些坐标值储存在坐标信息储存区域526a的第一成分#1、第二成分#2、第三成分#3、第四成分#4、第五成分#5以及第六成分#6中。
坐标形态信息管理部524在指定坐标格式为直角坐标格式时,按照后面参照图3A以及图3B说明的过程,取得机器人3的直角坐标格式中各控制轴的坐标值(X、Y、Z、A、B、C),并将这些坐标值储存在坐标信息储存区域526a的各成分#1~#6中。另外,坐标形态信息管理部524在指定坐标格式为直角坐标格式时,按照后面参照图3A以及图3B说明的过程,取得机器人3的形态值P,并将该形态值P储存在形态信息储存区域526b中。
图3A以及图3B是表示通过坐标形态信息管理部524以及存储器526管理指定坐标格式下的坐标信息、形态信息的处理(以下,称为“坐标形态信息管理处理”)的过程的流程图。关于图3A以及图3B所示的坐标形态信息管理处理,在机器人控制模块52中执行机器人用的数值控制程序的过程中,在坐标形态信息管理部524中以规定周期反复执行。
首先,在S1中,坐标形态信息管理部524判定指定坐标格式是否是关节坐标格式。坐标形态信息管理部524在S1的判定结果为是的情况下转移到S2,在S1的判定结果为否的情况下转移到S4。
在S2中,坐标形态信息管理部524判定是否为从机器人控制装置6刚接收到包含最新基准坐标值的基准坐标值信息之后。如上所述,基准坐标值是指指定坐标格式中各控制轴的当前坐标值。如后面说明的那样,机器人控制装置6根据在规定的时刻从坐标形态信息控制部523发送的基准坐标值请求信号取得基准坐标值,并将包含该基准坐标值的基准坐标值信息返回给数值控制装置5。坐标形态信息管理部524在S2的判定结果为是的情况下转移到S3,在S2的判定结果为否的情况下结束图3A以及图3B所示的处理。
在S3中,坐标形态信息管理部524根据从机器人控制装置6发送的基准坐标值,更新储存在存储器526的坐标信息储存区域526a中的坐标信息之后,结束图3A以及图3B所示的处理。更具体而言,坐标形态信息管理部524根据从机器人控制装置6发送的基准坐标值,置换储存在坐标信息储存区域526a的各成分#1~#6中的坐标值。
在S4中,坐标形态信息管理部524判定是否为从机器人控制装置6刚接收到包含最新基准坐标值的基准坐标值信息之后。坐标形态信息管理部524在S4的判定结果为是的情况下转移到S5,在S4的判定结果为否的情况下转移到S6。
在S5中,坐标形态信息管理部524按照与上述S3相同的过程,根据从机器人控制装置6发送的基准坐标值,更新储存在存储器526的坐标信息储存区域526a中的坐标信息之后,转移到S6。
在S6中,坐标形态信息管理部524判定是否从机器人控制装置6接收到包含最新基准形态值的基准形态值信息。如上所述,基准形态值是指机器人3的当前形态值。如后面说明的那样,机器人控制装置6根据在规定的时刻从坐标形态信息控制部523发送的基准形态值请求信号取得基准形态值,并将包含该基准形态值的基准形态值信息返回给数值控制装置5。坐标形态信息管理部524在S6的判定结果为是的情况下转移到S7,在S6的判定结果为否的情况下转移到S8。
在S7中,坐标形态信息管理部524根据从机器人控制装置6发送的基准形态值,更新储存在存储器526的形态信息储存区域526b中的形态信息之后,结束图3A以及图3B所示的处理。更具体而言,坐标形态信息管理部524根据从机器人控制装置6发送的基准形态值,置换储存在存储器526的形态信息储存区域526b中的形态值。
在S8中,坐标形态信息管理部524根据从输入解析部522输入的在数值控制程序中指定的形态值,更新储存在存储器526的形态信息储存区域526b中的形态信息之后,结束图3A以及图3B所示的处理。
如上所述,坐标形态信息管理部524在接收到从机器人控制装置6发送的基准坐标值的时刻,用基准坐标值更新储存在存储器526的坐标信息储存区域526a中的坐标信息。
另外,坐标形态信息管理部524在指定坐标格式为直角坐标格式时,根据从机器人控制装置6发送的基准形态值或者在数值控制程序中指定的形态值,更新储存在存储器526的形态信息储存区域526b中的形态信息。更具体而言,坐标形态信息管理部524在接收到从机器人控制装置6发送的基准形态值时,根据该基准形态值更新储存在形态信息储存区域526b中的形态信息,在除此以外的情况下,根据在数值控制程序中指定的形态值更新储存在形态信息储存区域526b中的形态信息。
返回到图2,坐标显示部527在机器人用的数值控制程序的执行过程中以规定周期读出储存在存储器526的坐标信息储存区域526a中的坐标信息,并将该坐标信息与指定坐标格式一起显示在未图示的显示器。由此,操作员能够通过数值来确认机器人3的位置以及姿态。
机器人指令信号生成部525根据储存在存储器526中的最新的坐标信息和形态信息、从输入解析部522输入的数值控制程序的解析结果,生成与数值控制程序对应的机器人指令信号,将生成的机器人指令信号写入到数据收发部528中,并将该机器人指令信号发送到机器人控制装置6。
在此,对基于数值控制程序的指令类别伴随机器人3的控制点的位置以及姿态、机器人3的形态变化的情况(具体而言,例如G代码是与定位(快进)相当的“G00”的情况、是与直线插补相当的“G01”的情况等)进行说明。该情况下,机器人指令信号生成部525在指定坐标格式下计算以储存在存储器526的坐标信息储存区域526a中的坐标值为机器人3的控制点的起点的情况下的机器人3的控制点的终点以及速度,并将包含与这些指定坐标格式、终点以及速度相关的信息的机器人指令信号写入到数据收发部528中。另外,机器人指令信号生成部525在如以上那样计算了机器人3的控制点的终点的坐标值之后,根据计算出的终点坐标值更新储存在存储器526的坐标信息储存区域526a中的起点坐标值。
然而,如上所述,在直角坐标格式下,无法唯一地确定机器人3的形态。因此,在指定坐标格式为直角坐标格式时,机器人指令信号生成部525以储存在存储器526的坐标信息储存区域526a中的坐标值为机器人3的控制点的起点,计算机器人3的控制点的终点、速度以及终点处的形态值,并将包含与指定坐标格式、终点、速度以及终点处的形态值相关的信息的机器人指令信号写入到数据收发部528中。另外,机器人指令信号生成部525在如以上那样计算了机器人3的控制点的终点的坐标值之后,根据计算出的终点坐标值来更新储存在存储器526的坐标信息储存区域526a中的起点坐标值。
接下来,对在坐标形态信息控制部523中生成基准坐标值请求信号以及基准形态值请求信号,并将这些请求信号发送到机器人控制装置6的时刻进行说明。如上所述,基准坐标值请求信号、基准形态值请求信号触发根据从机器人控制装置6发送的信息来更新储存在存储器526中的坐标信息、形态信息。因此,坐标形态信息控制部523判断在机器人控制模块52中执行机器人用的数值控制程序的过程中是否需要取得基准坐标值、基准形态值,在判断为需要取得基准坐标值时,将基准坐标值请求信号发送到机器人控制装置6,在判断为需要取得基准形态值时,将基准形态值请求信号发送到机器人控制装置6。
更具体而言,在是机器人用的数值控制程序的执行开始时的情况下、是因某些理由而中断的机器人用的数值控制程序的再次开始时的情况下、根据机器人用的数值控制程序新设定指定坐标格式的情况下、以及根据机器人用的数值控制程序变更指定坐标格式的情况下,坐标形态信息控制部523判断为需要取得基准坐标值,并将基准坐标值请求信号写入到数据收发部528中。由此,从数据收发部528向机器人控制装置6发送基准坐标值请求信号。
另外,坐标形态信息控制部523至少在指定坐标格式为直角坐标格式的情况下判断为需要取得基准形态值,并将基准形态值请求信号写入到数据收发部528中。由此,从数据收发部528向机器人控制装置6发送基准形态值请求信号。更具体而言,坐标形态信息控制部523在以指定坐标格式为直角坐标格式而开始了执行机器人用的数值控制程序的情况下、以及在指定坐标格式为直角坐标格式且在数值控制程序中未指定形态值的情况下,判断为需要取得基准形态值,并将基准形态值请求信号发送到机器人控制装置6。另外,坐标形态信息控制部523在指定坐标格式为直角坐标格式且在数值控制程序中指定了形态值的情况下,判断为不需要取得基准形态值,不将基准形态值请求信号发送到机器人控制装置6。即,坐标形态信息控制部523在数值控制程序中指定了形态值时,使在数值控制程序中指定的形态值比在机器人控制装置6中取得的基准形态值更优先,来生成机器人指令信号。
当通过机器人指令信号生成部525写入机器人指令信号时,数据收发部528将该机器人指令信号发送到机器人控制装置6的数据收发部61。另外,当通过坐标形态信息控制部523写入基准坐标值请求信号、基准形态值请求信号时,数据收发部528将这些基准坐标值请求信号、基准形态值请求信号发送到机器人控制装置6的数据收发部61。
当接收到从机器人控制装置6的数据收发部61发送的基准坐标值信息、基准形态值信息时,数据收发部528将这些基准坐标值信息、基准形态值信息发送到坐标形态信息管理部524。
如图2所示,在机器人控制装置6中,通过上述硬件结构,实现数据收发部61、输入解析部62、机器人位置控制部63、伺服控制部64以及机器人位置管理部65等各种功能。
当接收到从数值控制装置5的数据收发部528发送的机器人指令信号、基准坐标值请求信号以及基准形态值请求信号时,数据收发部61将这些信号发送到输入解析部62。
当通过机器人位置管理部65写入基准坐标值信息、基准形态值信息时,数据收发部61将这些基准坐标值信息、基准形态值信息发送到数值控制装置5的数据收发部528。
当从数据收发部61发送机器人指令信号时,输入解析部62根据该机器人指令信号转换为用于控制机器人3的机器人程序,将该机器人程序发送到机器人位置控制部63。另外,当从数据收发部61发送基准坐标值请求信号、基准形态值请求信号时,输入解析部62将这些请求信号发送到机器人位置管理部65。
机器人位置控制部63按照从输入解析部62发送的机器人程序进行运动变换(kinematic transformation),由此,生成针对未图示的多个伺服马达的指令,并输入到伺服控制部64,其中,所述多个伺服马达用于使机器人3的各关节旋转。
伺服控制部64对机器人3的各伺服马达进行反馈控制,以实现从机器人位置控制部63输入的指令。
机器人位置管理部65当接收到从输入解析部62发送的基准坐标值请求信号时,取得设置于机器人3的各种位置传感器(未图示)的检测值,并根据这些检测值在指定坐标格式下计算机器人坐标系中各控制轴的坐标值。机器人位置管理部65以计算出的坐标值为基准坐标值,将包含这些基准坐标值的基准坐标值信息写入到数据收发部61中。由此,从数据收发部61向数值控制装置5发送基准坐标值信息。
另外,机器人位置管理部65当接收到从输入解析部62发送的基准形态值请求信号时,取得设置于机器人3的各种位置传感器的检测值,并根据这些检测值来计算机器人3的形态值。机器人位置管理部65以计算出的形态值为基准形态值,并将包含该基准形态值的基准形态值信息写入到数据收发部61中。由此,从数据收发部61向数值控制装置5发送基准形态值信息。
接下来,一边参照图4、图5A以及图5B一边对如上构成的数值控制系统1中的各种信号、信息的流动进行说明。
图4是机器人用的数值控制程序的一例。
图5A以及图5B是表示根据图4所例示的机器人用的数值控制程序使数值控制装置5工作时的数值控制装置5与机器人控制装置6之间的信号、信息的流动的时序图。
首先,在序列编号“N10”所示的程序块中,向数值控制装置5的坐标形态信息控制部523输入命令“G68.8”。与之对应地,坐标形态信息控制部523将关节坐标格式设定为指定坐标格式。另外,坐标形态信息控制部523响应在该程序块中首次设定了指定坐标格式,而将基准坐标值请求信号发送到机器人控制装置6的机器人位置管理部65。机器人控制装置6的机器人位置管理部65响应接收到基准坐标值请求信号,而取得当前的指定坐标格式下的基准坐标值(J1、J2、J3、J4、J5、J6),并将包含该基准坐标值的基准坐标值信息发送到数值控制装置5的坐标形态信息管理部524。另外,数值控制装置5的坐标形态信息管理部524根据接收到的基准坐标值更新储存在存储器526的坐标信息储存区域526a中的坐标信息。
接着,在序列编号“N11”所示的程序块中,向数值控制装置5的机器人指令信号生成部525输入基于关节坐标格式的命令“G00 J1=_J2=_J3=_J4=_J5=_J6=_”。此外,在命令中的下划线部分输入终点的坐标值。机器人指令信号生成部525根据储存在存储器526的坐标信息储存区域526a中的坐标信息和输入的命令,生成机器人指令信号,并发送到机器人控制装置6。机器人控制装置6根据接收到的机器人指令信号来控制机器人3的动作。此外,此后数值控制装置5的机器人指令信号生成部525以在序列编号“N10”的程序块中取得的基准坐标值为基准,根据数值控制程序更新储存在坐标信息储存区域526a中的坐标信息,直到在序列编号“N20”中指定坐标格式被变更为止。
接着,在序列编号“N20”所示的程序块中,向数值控制装置5的坐标形态信息控制部523输入命令“G68.9”。与之对应地,坐标形态信息控制部523将指定坐标格式从至此为止的关节坐标格式变更为直角坐标格式。另外,坐标形态信息控制部523响应在该程序块中变更了指定坐标格式,而将基准坐标值请求信号发送到机器人控制装置6的机器人位置管理部65。机器人控制装置6的机器人位置管理部65响应接收到基准坐标值请求信号,而取得当前的指定坐标格式下的基准坐标值(X、Y、Z、A、B、C),并将包含该基准坐标值的基准坐标值信息发送到数值控制装置5的坐标形态信息管理部524。另外,数值控制装置5的坐标形态信息管理部524根据接收到的基准坐标值更新储存在存储器526的坐标信息储存区域526a中的坐标信息。
接着,在序列编号“N21”所示的程序块中,向数值控制装置5的坐标形态信息控制部523以及机器人指令信号生成部525输入基于直角坐标格式的命令“G01 X_Y_Z_A_B_C_”。此外,在该程序块中输入的命令中,未指定机器人3的形态值。坐标形态信息控制部523在指定坐标格式为直角坐标格式且在该程序块中输入的命令中未指定形态值时,判断为需要取得基准形态值,并将基准形态值请求信号发送到机器人控制装置6的机器人位置管理部65。机器人位置管理部65响应接收到基准形态值请求信号,而取得当前的机器人3的形态值(P),并将包含该基准形态值的基准形态值信息发送到数值控制装置5的坐标形态信息管理部524。另外,坐标形态信息管理部524根据接收到的基准形态值更新储存在存储器526的形态信息储存区域526b中的形态信息。
在如上那样更新了形态信息之后,数值控制装置5的机器人指令信号生成部525根据储存在存储器526的坐标信息储存区域526a中的坐标信息、储存在形态信息储存区域526b中的形态信息以及输入的命令来生成机器人指令信号,并发送到机器人控制装置6。机器人控制装置6根据接收到的机器人指令信号来控制机器人3的动作。此外,此后数值控制装置5的机器人指令信号生成部525以在序列编号“N20”的程序块中取得的基准坐标值为基准,根据数值控制程序更新储存在坐标信息储存区域526a中的坐标信息,直到在序列编号“N40”中指定坐标格式被变更为止。
接着,在序列编号“N30”所示的程序块中,向数值控制装置5的坐标形态信息控制部523以及机器人指令信号生成部525输入基于直角坐标格式的命令“G01 X_Y_Z_A_B_C_P_”。此外,在该程序块中输入的命令中指定了机器人3的形态值。这样,在命令中指定了形态值时,坐标形态信息控制部523与序列编号“N21”所示的程序块不同,不发送基准形态值请求信号。另外,该情况下,数值控制装置5的坐标形态信息管理部524根据在输入的命令中指定的形态值更新储存在形态信息储存区域526b中的形态信息。
在如上那样更新了形态信息之后,数值控制装置5的机器人指令信号生成部525根据储存在存储器526的坐标信息储存区域526a中的坐标信息、储存在形态信息储存区域526b中的形态信息以及输入的命令来生成机器人指令信号,并发送到机器人控制装置6。机器人控制装置6根据接收到的机器人指令信号来控制机器人3的动作。
接着,在序列编号“N40”所示的程序块中,向数值控制装置5的坐标形态信息控制部523输入命令“G68.8”。与之对应地,坐标形态信息控制部523将指定坐标格式从至此为止的直角坐标格式变更为关节坐标格式。另外,坐标形态信息控制部523响应在该程序块中变更了指定坐标格式,而将基准坐标值请求信号发送到机器人控制装置6的机器人位置管理部65。机器人位置管理部65响应接收到基准坐标值请求信号,而取得当前的指定坐标格式下的基准坐标值(J1、J2、J3、J4、J5、J6),并将包含该基准坐标值的基准坐标值信息发送到数值控制装置5的坐标形态信息管理部524。另外,坐标形态信息管理部524根据接收到的基准坐标值更新储存在存储器526的坐标信息储存区域526a中的坐标信息。
接着,在序列编号“N41”所示的程序块中,向数值控制装置5的机器人指令信号生成部525输入基于关节坐标格式的命令“G01 J1=_J2=_J3=_J4=_J5=_J6=_”。机器人指令信号生成部525根据储存在存储器526的坐标信息储存区域526a中的坐标信息和输入的命令,生成机器人指令信号,并发送到机器人控制装置6。机器人控制装置6根据接收到的机器人指令信号来控制机器人3的动作。此外,此后数值控制装置5的机器人指令信号生成部525以在序列编号“N40”的程序块中取得的基准坐标值为基准,根据数值控制程序更新储存在坐标信息储存区域526a中的坐标信息,直到指定坐标格式被变更为止。
根据本实施方式,获得以下的效果。
数值控制装置5按照机床用的数值控制程序生成针对机床2的机床指令信号,并且按照机器人用的数值控制程序生成针对机器人3的机器人指令信号。机器人控制装置6能够与数值控制装置5进行通信,并且根据从数值控制装置5发送的机器人指令信号来控制机器人3的动作。另外,机器人控制装置6取得确定机器人3的形态所需的形态值,并将该形态值作为基准形态值发送到数值控制装置5。数值控制装置5根据从机器人控制装置6发送的基准形态值和机器人用的数值控制程序来生成机器人指令信号。因此,根据本实施方式,数值控制装置5能够根据需要取得此时的机器人3的形态值,因此,操作员能够制作机器人用的数值控制程序而不用识别机器人3的形态,因此,对于不熟悉机器人3的操作员来说是很便利的。由此,还可以将机器人用的数值控制程序的大小压缩机器人3的形态值的量。
数值控制装置5的坐标形态信息控制部523判断在机器人用的数值控制程序的执行过程中是否需要取得基准形态值,在判断为需要从机器人控制装置6取得基准形态值时,将基准形态值请求信号发送到机器人控制装置6。另外,机器人控制装置6响应接收到基准形态值请求信号而取得基准形态值,并将该基准形态值发送到数值控制装置5。由此,能够将数值控制装置5与机器人控制装置6之间的通信抑制为最小限度,因此,能够相应地减轻运算负荷,进而也能够抑制机器人3、机床2的加工性能降低。
在本实施方式的机器人用的数值控制程序中,机器人3的位置以及姿态可以通过直角坐标格式或者关节坐标格式来指定。另外,在直角坐标格式为指定坐标格式时,数值控制装置5的坐标形态信息控制部523判断为需要从机器人控制装置6取得基准形态值,并将基准形态值请求信号发送到机器人控制装置6的机器人位置管理部65。在关节坐标格式下,机器人3的形态唯一地确定,因此,不需要取得基准坐标值。因此,根据本实施方式,能够将数值控制装置5与机器人控制装置6之间的通信抑制为最小限度,因此,能够相应地减轻运算负荷,进而能够抑制机器人3、机床2的加工性能降低。
在直角坐标格式为指定坐标格式且根据机器人用的数值控制程序指定了机器人3的形态值时,数值控制装置5的坐标形态信息控制部523判断为不需要从机器人控制装置6取得基准形态值。即,坐标形态信息控制部523在数值控制程序中指定了形态值时,使在数值控制程序中指定的形态值比在机器人控制装置6中取得的基准形态值更优先,来生成机器人指令信号。由此,能够将数值控制装置5与机器人控制装置6之间的通信抑制为最小限度,因此,能够相应地减轻运算负荷,进而能够抑制机器人3、机床2的加工性能降低。
本公开并不限定于上述实施方式,可以进行各种变更以及变形。
符号说明
1…数值控制系统
2…机床
3…机器人
5…数值控制装置
51…机床控制模块
52…机器人控制模块
521…程序输入部
522…输入解析部
523…坐标形态信息控制部
524…坐标形态信息管理部
525…机器人指令信号生成部
526…存储器
526a…坐标信息储存区域
526b…形态信息储存区域
527…坐标显示部
528…数据收发部
53…存储部
6…机器人控制装置
61…数据收发部
62…输入解析部
63…机器人位置控制部
64…伺服控制部
65…机器人位置管理部。

Claims (4)

1.一种数值控制系统,具有:
数值控制装置,其按照第一数值控制程序生成针对机床的指令即机床指令信号,按照第二数值控制程序生成针对机器人的指令即机器人指令信号;以及
机器人控制装置,其能够与所述数值控制装置进行通信,并且根据所述机器人指令信号来控制所述机器人的动作,
其特征在于,
所述机器人控制装置取得确定所述机器人的形态所需的信息即形态信息,并将该形态信息发送到所述数值控制装置,
所述数值控制装置根据从所述机器人控制装置发送的形态信息以及所述第二数值控制程序来生成所述机器人指令信号。
2.根据权利要求1所述的数值控制系统,其特征在于,
所述数值控制装置在所述第二数值控制程序的执行过程中判断是否需要取得形态信息,在判断为需要从所述机器人控制装置取得形态信息时,将规定的请求信号发送到所述机器人控制装置,
所述机器人控制装置响应接收到所述请求信号而取得形态信息,并将该形态信息发送到所述数值控制装置。
3.根据权利要求2所述的数值控制系统,其特征在于,
在所述第二数值控制程序中,所述机器人的位置以及姿态能够通过直角坐标格式或者关节坐标格式来指定,
在根据所述第二数值控制程序指定所述直角坐标格式时,所述数值控制装置判断为需要从所述机器人控制装置取得形态信息。
4.根据权利要求3所述的数值控制系统,其特征在于,
在根据所述第二数值控制程序指定所述直角坐标格式且根据所述第二数值控制程序确定形态信息时,所述数值控制装置判断为不需要从所述机器人控制装置取得形态信息。
CN202180046017.9A 2020-06-30 2021-06-28 数值控制系统 Pending CN115734847A (zh)

Applications Claiming Priority (3)

Application Number Priority Date Filing Date Title
JP2020-113272 2020-06-30
JP2020113272 2020-06-30
PCT/JP2021/024344 WO2022004649A1 (ja) 2020-06-30 2021-06-28 数値制御システム

Publications (1)

Publication Number Publication Date
CN115734847A true CN115734847A (zh) 2023-03-03

Family

ID=79315319

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202180046017.9A Pending CN115734847A (zh) 2020-06-30 2021-06-28 数值控制系统

Country Status (5)

Country Link
US (1) US20230251630A1 (zh)
JP (1) JP7022260B1 (zh)
CN (1) CN115734847A (zh)
DE (1) DE112021003517T5 (zh)
WO (1) WO2022004649A1 (zh)

Families Citing this family (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP7311732B1 (ja) 2023-01-31 2023-07-19 ファナック株式会社 数値制御装置及び数値制御システム
JP7448736B1 (ja) 2023-09-22 2024-03-12 ファナック株式会社 数値制御装置及び数値制御システム

Family Cites Families (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH0222713A (ja) * 1988-07-12 1990-01-25 Mitsubishi Electric Corp 数値制御装置
JP6903275B2 (ja) * 2017-09-14 2021-07-14 オムロン株式会社 制御装置および制御方法
DE112019006613T5 (de) * 2019-01-09 2021-09-30 Mitsubishi Electric Corporation Numerische Steuerungsvorrichtung und numerisches Steuerungsverfahren

Also Published As

Publication number Publication date
DE112021003517T5 (de) 2023-05-25
JPWO2022004649A1 (zh) 2022-01-06
JP7022260B1 (ja) 2022-02-17
US20230251630A1 (en) 2023-08-10
WO2022004649A1 (ja) 2022-01-06

Similar Documents

Publication Publication Date Title
CN115734847A (zh) 数值控制系统
WO2022224425A1 (ja) 数値制御装置及び数値制御システム
CN111775145B (zh) 一种串并联机器人的控制系统
CN111103850A (zh) 机床系统
WO2022034848A1 (ja) 数値制御システム及びロボット制御方法
US20230415341A1 (en) Numerical control device and numerical control system
CN115735165A (zh) 数值控制系统
CN115735166A (zh) 数值控制系统
JP7177301B1 (ja) 数値制御装置、及び数値制御システム
US20240028000A1 (en) Numerical control system, and industrial machine control method
JP7121221B1 (ja) 数値制御装置及び数値制御システム
CN116964537A (zh) 指令生成装置及计算机程序
JP7157281B1 (ja) ロボット制御装置、数値制御システム及び数値制御方法
US20240134342A1 (en) Command generation device and non-transitory computer-readable medium storing a computer program
WO2022191057A1 (ja) 動作経路生成装置、数値制御装置、数値制御システム、及びコンピュータプログラム
JP7448736B1 (ja) 数値制御装置及び数値制御システム
JPH09128024A (ja) 冗長軸を有するロボットの動作プログラムの最適化方法
WO2022269896A1 (ja) 数値制御システム
CN117957503A (zh) 数值控制系统以及机器人控制装置
JPS638910A (ja) ロボツト位置表示方法
JPH09179617A (ja) 溶接ロボットの制御装置

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