CN105555489A - 多轴机械手的动力切断装置以及多轴机械手 - Google Patents
多轴机械手的动力切断装置以及多轴机械手 Download PDFInfo
- Publication number
- CN105555489A CN105555489A CN201480051270.3A CN201480051270A CN105555489A CN 105555489 A CN105555489 A CN 105555489A CN 201480051270 A CN201480051270 A CN 201480051270A CN 105555489 A CN105555489 A CN 105555489A
- Authority
- CN
- China
- Prior art keywords
- loop
- semiconductor switch
- switch device
- cut
- signal
- 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
Links
- 239000004065 semiconductor Substances 0.000 claims abstract description 83
- 230000004044 response Effects 0.000 claims abstract description 19
- 238000003754 machining Methods 0.000 claims description 35
- 230000009471 action Effects 0.000 claims description 12
- 239000003990 capacitor Substances 0.000 description 7
- 238000010586 diagram Methods 0.000 description 5
- 238000009434 installation Methods 0.000 description 5
- 230000005284 excitation Effects 0.000 description 4
- 238000001514 detection method Methods 0.000 description 2
- 238000003745 diagnosis Methods 0.000 description 2
- 230000000694 effects Effects 0.000 description 2
- 210000000707 wrist Anatomy 0.000 description 2
- 230000002159 abnormal effect Effects 0.000 description 1
- 230000008901 benefit Effects 0.000 description 1
- 230000008859 change Effects 0.000 description 1
- 238000006243 chemical reaction Methods 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 210000003414 extremity Anatomy 0.000 description 1
- 230000005669 field effect Effects 0.000 description 1
- 230000007274 generation of a signal involved in cell-cell signaling Effects 0.000 description 1
- 210000004247 hand Anatomy 0.000 description 1
- 230000006872 improvement Effects 0.000 description 1
- 230000001681 protective effect Effects 0.000 description 1
- 230000008439 repair process Effects 0.000 description 1
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J19/00—Accessories fitted to manipulators, e.g. for monitoring, for viewing; Safety devices combined with or specially adapted for use in connection with manipulators
- B25J19/06—Safety devices
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J19/00—Accessories fitted to manipulators, e.g. for monitoring, for viewing; Safety devices combined with or specially adapted for use in connection with manipulators
- B25J19/0004—Braking devices
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J19/00—Accessories fitted to manipulators, e.g. for monitoring, for viewing; Safety devices combined with or specially adapted for use in connection with manipulators
- B25J19/06—Safety devices
- B25J19/066—Redundant equipment
-
- H—ELECTRICITY
- H02—GENERATION; CONVERSION OR DISTRIBUTION OF ELECTRIC POWER
- H02P—CONTROL OR REGULATION OF ELECTRIC MOTORS, ELECTRIC GENERATORS OR DYNAMO-ELECTRIC CONVERTERS; CONTROLLING TRANSFORMERS, REACTORS OR CHOKE COILS
- H02P3/00—Arrangements for stopping or slowing electric motors, generators, or dynamo-electric converters
- H02P3/02—Details of stopping control
- H02P3/04—Means for stopping or slowing by a separate brake, e.g. friction brake or eddy-current brake
-
- H—ELECTRICITY
- H02—GENERATION; CONVERSION OR DISTRIBUTION OF ELECTRIC POWER
- H02P—CONTROL OR REGULATION OF ELECTRIC MOTORS, ELECTRIC GENERATORS OR DYNAMO-ELECTRIC CONVERTERS; CONTROLLING TRANSFORMERS, REACTORS OR CHOKE COILS
- H02P3/00—Arrangements for stopping or slowing electric motors, generators, or dynamo-electric converters
- H02P3/06—Arrangements for stopping or slowing electric motors, generators, or dynamo-electric converters for stopping or slowing an individual dynamo-electric motor or dynamo-electric converter
Landscapes
- Engineering & Computer Science (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Power Engineering (AREA)
- Manipulator (AREA)
- Control Of Multiple Motors (AREA)
- Control Of Ac Motors In General (AREA)
Abstract
本发明具备:分别驱动多轴机械手的多个轴的多个马达(M1~M6);将电力进行控制并供给至多个马达而分别控制该多个马达的动作的多个电力转换器(11);向构成各电力转换器(11)的第一半导体开关器件的控制端子输出根据用于控制马达的动作的控制信号的驱动信号,从而驱动该第一半导体开关器件的驱动回路(12);设置于向驱动回路(12)供给第一工作用电力的电路(L1)的中途的切断回路(14a);和向切断回路输出切断信号的切断控制回路(15)。切断回路(14a)包括相互串联地分别嵌入于电路中,根据切断信号分别断开而切断电路的两个以上的第二半导体开关器件(Tr1以及Tr2)。
Description
技术领域
本发明涉及具备分别驱动多轴机械手的多个轴的多个马达的动力切断装置以及多轴机械手。
背景技术
一般而言,作为工业机械手等使用的机械手形成为设置有对工作所需的可动构件进行驱动的多个马达的多轴机械手结构。在使这样的机械手工作时,同时运行多个马达并执行控制。在紧急停止时形成为启动安全回路的结构(例如参照专利文献1)。
在现有的机械手中,通过安全回路完全切断马达的动力。为了保证马达无法工作的状态,例如采用通过电磁接触器(magnetcontact)机械切断使马达工作的三相交流电源的电力供给线路的方式。
现有技术文献:
专利文献:
专利文献1:美国专利第7253577号说明书;
专利文献2:美国专利申请公开第2005/122641号说明书;
专利文献3:日本特开2008-153748号公报;
专利文献4:日本特开2011-182535号公报;
专利文献5:日本特开2008-187873号公报;
专利文献6:日本特开平11-122981号公报;
专利文献7:日本特开2005-161486号公报。
发明内容
发明要解决的问题:
然而,上述电磁接触器等机械式开关,其设置空间较大,成本方面缺点也较大。又,存在由于是机械部件所以成为寿命有限的部件这样的问题。
因此,本发明是为了解决这样的问题而形成的,其目的是提供:具备与使用现有的机械式开关的切断回路相比设置空间小、成本低、且寿命长的切断回路且能够安全可靠地停止驱动马达的多轴机械手。
解决问题的手段:
为了解决上述问题,根据本发明一种形态的多轴机械手的动力切断装置具备:分别驱动多轴机械手的多个轴的多个马达;将电力进行控制并供给至所述多个马达而分别控制该多个马达的动作的多个电力转换器;向构成各所述电力转换器的第一半导体开关器件的控制端子输出根据用于控制所述马达的动作的控制信号的驱动信号,从而驱动该第一半导体开关器件的驱动回路;设置于向所述驱动回路供给第一工作用电力的第一电路的中途的第一切断回路;对所述多个轴分别进行制动的多个电磁制动器;设置于向各所述电磁制动器供给第二工作用电力的第二电路的中途的第二切断回路;和向所述第一切断回路以及第二切断回路输出切断信号的切断控制回路;所述第一切断回路以及第二切断回路中至少任意一个切断回路(以下称为特定切断回路)包括两个以上的第二半导体开关器件,所述两个以上的第二半导体开关器件相互串联地分别嵌入于所述第一电路以及第二电路中的与该特定切断回路相对应的电路(以下称为特定电路)中,并且根据所述切断信号分别断开而切断所述特定电路。在这里,在半导体开关器件所必备的三个端子中,将与需要导通以及切断的电路连接的一对端子定义为主端子,将控制导通以及切断的信号被输入的端子定义为控制端子。例如,如果是FET,则源极以及漏极为主端子,栅极为控制端子。如果是IGBT以及双极型晶体管,则发射极以及集电极为主端子,基极为控制端子。
根据上述结构,切断回路由半导体开关器件构成,因此相较于现有的具有电磁接触器(以下称为MC)等机械式开关的切断回路而言,能够实现切断回路的集成化,从而能够削减设置空间。又,通过集成回路,无需使用MC便能够以低廉价格构成回路,从而削减切断回路的成本。又,半导体开关器件不通过机械式接点而通过对半导体中载流子移动的控制进行开启(导通)以及断开(非导通),因此延长切断回路的寿命。此外,通过相互串联地分别嵌入于作为切断对象的电路中的两个以上半导体开关器件切断该电路,因此即便一个半导体开关器件发生故障,也能够通过剩余的半导体开关器件切断特定电路,因此改善安全性。在这里,半导体开关器件例如是晶体管、闸流晶体管等,具体而言是FET。另外,也可以是双极型晶体管、或者IGBT。
也可以是所述切断控制回路向所述第二半导体开关器件的控制端子定期地输出使该第二半导体开关器件断开的脉冲,并且诊断所述第二半导体开关器件是否断开。
通过上述结构,关于切断回路是否处于正常,能够定期地进行自我诊断,因此改善安全性。
在将所述驱动回路以及所述电磁制动器定义为负载、将所述两个以上的第二半导体开关器件中的一个半导体开关器件定义为电源侧半导体开关器件、将比该电源侧半导体开关器件靠近所述负载侧的位置上的另一半导体开关器件定义为负载侧半导体开关器件的情况下,所述切断控制回路还具备向所述电源侧半导体开关器件的控制端子输出包含所述脉冲的第一诊断信号的第一诊断回路、和向所述负载侧半导体开关器件的控制端子输出第二诊断信号的第二诊断回路,所述第二诊断信号包含具有与所述第一诊断信号的脉冲不同的相位的脉冲;所述第一诊断回路从所述负载侧半导体开关器件的所述负载侧的主端子接收对所述第二诊断信号的响应信号,并且诊断所述负载侧半导体开关器件是否正常工作;所述第二诊断回路从所述电源侧半导体开关器件的所述负载侧的主端子接收对所述第一诊断信号的响应信号,并且诊断所述电源侧半导体开关器件是否正常工作。
根据上述结构,在两个诊断回路中,相互确认是否从对方的诊断回路输出诊断信号,从而能够防止因未输出诊断信号而导致的误诊断。
根据本发明一种形态的多轴机械手具备上述多轴机械手的动力切断装置。
发明效果:
本发明发挥如下效果:能够提供具备相较于现有的使用机械式开关的切断回路而言设置空间小、成本低、以及寿命长的切断回路、且能安全可靠地停止驱动马达的多轴机械手。
本发明的上述目的、其他目的、特征以及优点是在参照附图的基础上,由以下优选的实施形态的详细说明得以明了。
附图说明
图1是示出使用根据本实施形态的多轴机械手的动力切断装置的该多轴机械手结构的图;
图2是示出图1多轴机械手的马达驱动系统的动力切断装置回路结构的一个示例的回路图;
图3是示出图1多轴机械手的制动系统的动力切断装置回路结构的一个示例的回路图;
图4是图2以及图3所示的动力切断装置中的自我诊断控制的时序图;
图5是示出图2以及图3所示的动力切断装置的切断回路的其他结构的回路图。
具体实施方式
以下,参照附图说明根据本发明的实施形态。
图1是示出使用根据本实施形态多轴机械手的动力切断装置的该多轴机械手的结构的图。在本实施形态中,多轴机械手只要形成为具备工作所需的多个可动构件、且它们由多个马达驱动的结构即可。因此,在本实施形态中,作为多轴机械手,典型的有多关节机械手,但是不限于此。如图1所示,多轴机械手100例如形成为六轴机械手的结构,该六轴机械手具备设置于梢端的腕部、和从规定的基端向该腕部依次设置的六个关节J1~J6,且六个关节J1~J6分别具有第一旋转轴至第六旋转轴A1~A6。在基台2上依次连接设置有旋转台3、臂构件4~7以及附件8。另外,在附件8的凸缘面上可装卸地安装有工具构件9。被连接设置的从基台2至附件8的构件2~8以相互能够进行相对旋转的形式连接。以下,将像这样通过六个关节J1~J6相互连接设置的构件组2~8称为机械臂。
以与第一关节至第六关节J1~J6的每一个对应的形式分别设置有伺服马达M1~M6、对伺服马达M1~M6的旋转进行制动的制动器B1~B6以及检测伺服马达M1~M6的旋转位置的位置传感器E1~E6。作为伺服马达M1~M6,例如采用DC伺服马达。作为位置传感器E1~E6,例如采用编码器(encoder)和旋转变压器(resolver)等。作为制动器B1~B6,例如采用励磁工作型电磁制动器,该励磁工作型电磁制动器在通过供电实现励磁时,制动被解除,相反地,在未实现励磁时,制动有效。通过驱动各伺服马达M1~M6,在第一关节至第六关节J1~J6中进行各自被允许的绕第一旋转轴至第六旋转轴A1~A6的旋转。另外,各伺服马达M1~M6能够相互之间独立地进行工作。又,在各伺服马达M1~M6工作时,通过各位置传感器E1~E6执行绕各伺服马达M1~M6的第一旋转轴至第六旋转轴A1~A6的旋转位置的检测。
伺服马达M1~M6与控制装置200之间借助于马达电缆L1相连接,制动器B1~B6与控制装置200之间借助于制动器电缆L2相连接,位置传感器E1~E6与控制装置200之间借助于位置传感器电缆L3相连接。马达电缆L1是用于从控制装置200向伺服马达M1~M6供电的第一电路。制动器电缆L2是用于从控制装置200向制动器B1~B6供电的第二电路。位置传感器电缆L3是用于从控制装置200向位置传感器E1~E6供电,且从位置传感器E1~E6向控制装置200供给位置检测信号的第三电路。
控制装置200对配备于第一关节至第六关节J1~J6的伺服马达M1~M6分别执行使工具构件9沿着任意路径向任意的位置以及姿势移动的伺服控制。通过伺服控制,多轴机械手100执行规定的动作。多轴机械手100的用途并不特别限定。
控制装置2具备如下动力切断功能:在紧急时操作紧急停止开关SW,以此切断伺服马达M1~M6的驱动系统的动力,且使制动器B1~B6的驱动系统工作,从而使多轴机械手100的机械臂安全地停止。
图2是示出伺服马达M1~M6驱动系统的动力切断装置的回路结构的一个示例的回路图。如图2所示,动力切断装置1a具备:分别与多个伺服马达M1~M6对应的多个电力转换器11;多个驱动回路12;工作用电压生成部30;切断回路14a;和包括切断控制回路15a的控制部40。
多个伺服马达M1~M6分别驱动多轴机械手100的多个轴A1~A6。以下简称为马达M1~M6。
多个电力转换器11将电力进行控制并供给至对应的马达M1~M6,从而分别控制该马达M1~M6的动作。各电力转换器11是将直流电力转换为交流电力的设备,例如是具有半导体开关器件Q1~Q6的三相桥式逆变器回路。在本实施形态中,半导体开关器件Q1~Q6由续流二极管以反并联形式被连接的六个IGBT(InsulatedGateBipolarTransistor;绝缘栅双极型晶体管)构成。
多个驱动回路12向构成各电力转换器11的半导体开关器件Q1~Q6的控制端子输出根据用于控制马达M1~M6动作的控制信号的驱动信号,从而驱动该半导体开关器件Q1~Q6。在本实施形态中,各驱动回路12向IGBT的栅极端子输出驱动信号而驱动IGBT。
在本实施形态中,六个电力转换器11以及驱动它们的六个驱动回路12封装于IPM(intelligentpowermodule;智能功率模块)10内。IPM10除了这些回路以外还内设有未图示的保护回路功能,从而能够实现保护以免受来自于过热、短路、控制回路的异常等的影响。通过从外部供给电源电压以及控制信号等,以此使IPM10工作。
工作用电压生成部30具备交流电源31、AC/DC转换部32、平滑电容器33、和IPM栅极电源13。AC/DC转换部32例如将由交流电源31输出的三相交流电力转换为直流电力并输出。该直流电力被供给至IPM10内的各电力转换器11。在本实施形态中,AC/DC转换部32是三相全波整流回路,是由六个二极管构成的桥式整流回路。又,通过平滑电容器33对直流输出电压进行平滑化。
IPM栅极电源13是内部具备如上所述的AC/DC转换部以及平滑电容器(未图示)的电源回路。在本实施形态中,IPM栅极电源13将从交流电源31输出的二相交流电力转换为平滑的直流电力,并且将转换的直流电力的电压(例如200V)降至规定的电压(例如20V),并且供给至IPM的正电源端子VDD。IPM栅极电源13通过电路L1向IPM4内部的包括驱动电路12在内的规定要素供给作为工作用电力的电源电压。另外,来自于IPM栅极电源13的电源电压除了IPM10以外还供给至切断控制回路15。
切断回路14a设置于向包括驱动回路12的IPM10供给作为工作用电力的电源电压的电路L1的中途。切断回路14a包括两个以上的半导体开关器件,该两个以上的半导体开关器件相互串联地分别嵌入于电路L1中,并且根据来自于切断控制回路15a的切断信号分别断开,从而将电路L1切断。像这样,通过相互串联地分别嵌入于作为切断对象的电路中的两个以上的半导体开关器件切断该电路L1,因此即便一个半导体开关器件发生故障,也能够通过剩余的半导体开关器件切断特定的电路,因此改善安全性。在本实施形态中,两个半导体开关器件Tr1、Tr2串联连接于电路L1。半导体开关器件Tr1、Tr2例如是晶体管,具体而言是两个n沟道型FET(fieldeffecttransistor;场效应晶体管)。作为其他晶体管,也可以是双极型晶体管、或者IGBT。
像这样,切断回路14a由半导体开关器件构成,因此相较于现有的具有电磁接触器等机械式开关的切断回路而言,能够实现集成化,从而能够削减设置空间。又,通过集成回路,无需使用机械式开关便能够以低廉价格构成回路,从而削减成本。又,半导体开关器件不通过机械式接点而是通过控制半导体中的载流子移动以此进行开启(导通)以及断开(非导通),因此延长切断回路14a的寿命。
以下,将驱动回路12定义为负载,将两个半导体开关器件Tr1、Tr2中的一个半导体开关器件定义为第一晶体管(电源侧半导体开关器件)Tr1,并且将比该第一晶体管Tr1靠近负载侧的位置上的另一半导体开关器件定义为第二晶体管(负载侧半导体开关器件)Tr2。此外,切断回路14a中第二晶体管Tr2的负载侧与包括二极管以及电容器的输出回路(滤波器)连接。通过该结构,即便第一晶体管Tr1以及第二晶体管Tr1分别通过后述的第一诊断信号以及第二诊断信号瞬间断开,也能够由输出回路的电容器向IPM10的驱动回路12供给电力,借助于此使大致恒定的电力(电压)供给至IPM10的驱动回路12。
控制部40管理用于控制多轴机械手100的控制装置200整体的控制,并且具备切断控制回路15a以及生成控制信号的控制信号生成回路18,且具备其他后述的制动系统的切断控制回路等。控制部40例如可以由微型控制器、CPU、MPU、DSP、ASIC或FPGA等构成。控制部40可以由相互进行分散控制的多个控制器构成。
切断控制回路15a为了在紧急时刻根据紧急停止开关SW的停止操作将切断回路14a切断而输出切断信号,并且在通常时,为了自我诊断切断回路14a是否正常而输出诊断信号。具体而言,切断控制回路15a还具备:向第一晶体管Tr1的控制端子输出包含脉冲的第一切断信号或第一诊断信号的第一诊断回路16a;和向第二晶体管Tr2的控制端子输出包含脉冲的第二切断信号或第二诊断信号的第二诊断回路17a。在本实施形态中,第一诊断回路16a以及第二诊断回路17a分别由CPLD(complexprogrammablelogicdevice;复杂可编程逻辑器件)构成。
图3是示出多轴机械手100的制动器B1~B6系统的动力切断装置的回路结构的一个示例的回路图。如图3所示,动力切断装置1b具备:包括对多个轴分别进行制动的多个电磁制动器B1~B6的制动器回路50;生成向制动器回路50内的各电磁制动器供给的工作用电力的制动器回路电源20;切断回路14b;和包括切断控制回路15b以及生成制动信号的制动信号生成回路19的控制部40。
制动器回路50包括对多个轴分别进行制动的多个电磁制动器B1~B6,并且具备与各电磁制动器相对应且根据来自于制动信号生成回路19的制动信号在励磁和非励磁之间进行切换的开关器件、即晶体管。
制动器回路电源20是在图2所示的工作用电压生成部30中,将从AC/DC转换部32输出的直流电力的电压(例如200V)降至规定的电压(例如24~26V)并向制动器回路50供给工作用电力的电源回路。
切断回路14b设置于向制动器回路50内的各电磁制动器供给工作用电力的电路L2的中途。切断回路14b包括两个以上的半导体开关器件,该两个以上的半导体开关器件相互串联地分别嵌入于电路L2中,并且根据来自于切断控制回路15b的切断信号分别断开,从而将电路L2切断。在本实施形态中,两个半导体开关器件Tr1、Tr2串联连接于电路L2。半导体开关器件Tr1、Tr2例如是晶体管,具体而言是两个n沟道型FET。此外,切断回路14b在第二晶体管Tr2的负载侧未连接有包括二极管以及电容器的滤波回路,这构成了与切断回路14a的不同点。其理由如下。在各电磁制动器中,电磁线圈具有较大的电感,因此即便第一晶体管Tr1以及第二晶体管Tr1分别根据后述的第一诊断信号以及第二诊断信号瞬间断开,也能够通过该电感防止电流的变化,从而向各电磁制动器供给大致恒定的电力(电流)。因此,不需要如上所述的输出回路。
以下,将电磁制动器B1~B6定义为负载,将两个半导体开关器件中的一个半导体开关器件定义为第一晶体管(电源侧半导体开关器件)Tr1,将比该第一晶体管Tr1靠近负载侧的位置上的另一个半导体开关器件定义为第二晶体管(负载侧半导体开关器件)Tr2。
又,与马达驱动系统的动力切断装置1a相同地,在制动系统的动力切断装置1b中,切断控制回路15b具备第一诊断回路16b以及第二诊断回路17b。第一诊断回路16b以及第二诊断回路17b的结构与第一诊断回路16a以及第二诊断回路17a的结构相同,因此省略说明。
利用图2说明在如上所述的马达驱动系统的动力切断装置1a以及制动系统的动力切断装置1b中的切断控制。图2的动力切断装置1a中的切断控制回路15a,为了在紧急时刻根据紧急停止开关SW的停止操作将切断回路14a切断而输出切断信号。具体而言,第一诊断回路16a,为了将切断回路14a的第一晶体管Tr1切断,而向第一晶体管Tr1的控制端子输出包含脉冲的第一切断信号OUT_1。另一方面,第二诊断回路17a,为了将切断回路14a的第二晶体管Tr2切断,而向第二晶体管Tr2的控制端子输出包含脉冲的第二切断信号OUT_2。
在这里,第一诊断回路16a以及第二诊断回路17a可以以相同的相位同时输出第一切断信号OUT_1以及第二切断信号OUT_2,也可以以不同的相位进行输出。
又,DIAG_1是第二诊断回路17a从第一晶体管Tr1的负载(驱动回路12)侧的主端子接收的对第一切断信号OUT_1的响应信号。DIAG_2是第一诊断回路16a从第二晶体管Tr2的负载(驱动回路12)侧的主端子接收的对第二切断信号OUT_2的响应信号。
接着,参照图2以及图4说明马达驱动系统的动力切断装置1a中的自我诊断控制。切断控制回路15a向切断回路14a的半导体开关器件Tr1以及Tr2的控制端子定期地输出断开该半导体开关器件Tr1以及Tr2的脉冲,并且诊断半导体开关器件Tr1以及Tr2是否断开。
在自我诊断控制中,第一诊断回路16a向第一晶体管Tr1的控制端子输出包含脉冲的第一诊断信号。另一方面,第二诊断回路17a向第二晶体管Tr2的控制端子输出第二诊断信号,该第二诊断信号包含具有与第一诊断信号的脉冲不同的相位的脉冲。
第一诊断回路16a从第二晶体管Tr2的负载(驱动回路12)侧的主端子接收对第二诊断信号OUT_2的响应信号DIAG_2并诊断第二晶体管Tr2是否正常工作。第二诊断回路17a从第一晶体管Tr1的负载(驱动回路12)侧的主端子接收对第一诊断信号OUT_1的响应信号DIAG_1并诊断第一晶体管Tr1是否正常工作。
图4是自我诊断控制中的时序图。在这里,OUT_1是第一诊断回路16a向第一晶体管Tr1的控制端子以及第二诊断回路17a输出的第一诊断信号。OUT_2是第二诊断回路17a向第二晶体管Tr2的控制端子以及第一诊断回路16a输出的第二诊断信号。DIAG_1是第二诊断回路17a从第一晶体管Tr1的负载(驱动回路12)侧的主端子接收的对第一诊断信号OUT_1的响应信号。DIAG_2是第一诊断回路16a从第二晶体管Tr2的负载(驱动回路12)侧的主端子接收的对第二诊断信号OUT_2的响应信号。
如图4所示,在切断回路14a中输入相位互不相同的一定周期的第一诊断信号OUT_1以及第二诊断信号OUT_2。
在时刻t0时,第二诊断回路17a从第一晶体管Tr1的负载(驱动回路12)侧的主端子接收对第一诊断信号OUT_1的响应信号DIAG_1并诊断第一晶体管Tr1的动作。在这里,响应信号DIAG_1的脉冲信号降低至低电平,因此第二诊断回路17a诊断为第一晶体管Tr1正常工作。
在时刻t0+Δt时,第一诊断回路16a从第二晶体管Tr2的负载(驱动回路12)侧的主端子接收对第二诊断信号OUT_2的响应信号DIAG_2并诊断第二晶体管Tr2的动作。在这里,响应信号DIAG_2的脉冲信号降低至低电平,因此第一诊断回路16a诊断为第二晶体管Tr2正常工作。
根据时刻t0~t0+Δt时的诊断结果,切断控制回路15a判断为切断回路14a的第一晶体管Tr1以及第二晶体管Tr2这两者均正常工作。
另一方面,在时刻t3时,第二诊断回路17a从第一晶体管Tr1的负载(驱动回路12)侧的主端子接收对第一诊断信号OUT_1的响应信号DIAG_1并诊断第一晶体管的动作。在这里,响应信号DIAG_1的脉冲信号维持高电平,因此第二诊断回路17a诊断为第一晶体管Tr1未正常工作。
在时刻t3+Δt时,第一诊断回路16a从第二晶体管Tr2的负载(驱动回路12)侧的主端子接收对第二诊断信号OUT_2的响应信号DIAG_2并诊断第二晶体管Tr2的动作。在这里,响应信号DIAG_2的脉冲信号降低至低电平,因此第一诊断回路16a判断为第二晶体管Tr2正常工作。
根据这样的诊断结果,判明了第二晶体管Tr2正常工作但第一晶体管Tr1发生故障,因此在时刻t4时还切断第二晶体管Tr2,停止机械手的动作并承担修复作业。
借助于此,在切断回路14a中,确认串联连接的两个晶体管Tr1、Tr2是否正常工作,而且即便在切断回路14a中发生了故障,也能够特别指定出两个晶体管(Tr1以及Tr1)中的哪一个晶体管发生了故障。又,在两个诊断回路中,相互确认是否从对方的诊断回路输出诊断信号,从而能够防止因未输出诊断信号而导致的误诊断,因此改善安全性。
另外,在本实施形态中,构成切断回路14a以及14b的FET均形成为n沟道型,但是不限于这样的结构。图5(a)以及图5(b)是示出切断回路的其他示例的回路结构图。可以是如图5(a)所示,切断回路14a或14b由P沟道型和N沟道型的FET构成,也可以是如图5(b)所示,切断回路14a或14b由P沟道型和P沟道型的组合构成。但是,P沟道型FET嵌入于将IPM栅极电源13和IPM10的驱动回路12的GND进行连接的电路中。
另外,在本实施形态中多轴机械手形成为具有六个轴的六轴多关节机械手,但是不限于此,只要具有至少两个以上轴的多轴机械手即可。
另外,在本实施形态中,切断回路14a以及14b包括相互串联地分别嵌入于与它们两者对应的电路L1以及电路L2中、且根据切断信号分别断开从而对这些电路进行切断的两个半导体开关器件Tr1以及Tr2,但是也可以使任意一方的切断回路包括半导体开关器件Tr1以及Tr2。
又,半导体开关器件可以是3个以上。
基于上述说明,本领域技术人员能够明了本发明的较多的改良和其他实施形态等。因此,上述说明仅作为示例性的解释,旨在向本领域技术人员提供教导实施本发明的最优选的形态。在不脱离本发明的精神的范围内,可以实质上变更其结构和/或功能的具体内容。
工业应用性:
本发明可以使用于具备分别驱动多个轴的多个马达的多轴机械手中。
符号说明:
1a、1b动力切断装置;
10IPM;
11电力转换器;
12驱动回路;
13IPM栅极电源;
14a、14b切断回路;
15a、15b切断控制回路;
16a、16b第一诊断回路;
17a、16b第二诊断回路;
18控制信号生成回路;
19制动信号生成回路;
20制动器回路电源;
30工作用电压生成部;
31交流电源;
32AC/DC转换部;
33平滑电容器;
40控制部;
50制动器回路;
100多轴机械手;
200控制装置。
Claims (4)
1.一种多轴机械手的动力切断装置,具备:
分别驱动多轴机械手的多个轴的多个马达;
将电力进行控制并供给至所述多个马达而分别控制该多个马达的动作的多个电力转换器;
向构成各所述电力转换器的第一半导体开关器件的控制端子输出根据用于控制所述马达的动作的控制信号的驱动信号,从而驱动该第一半导体开关器件的驱动回路;
设置于向所述驱动回路供给第一工作用电力的第一电路的中途的第一切断回路;
对所述多个轴分别进行制动的多个电磁制动器;
设置于向各所述电磁制动器供给第二工作用电力的第二电路的中途的第二切断回路;和
向所述第一切断回路以及第二切断回路输出切断信号的切断控制回路;
所述第一切断回路以及第二切断回路中至少任意一个切断回路(以下称为特定切断回路)包括两个以上的第二半导体开关器件,所述两个以上的第二半导体开关器件相互串联地分别嵌入于所述第一电路以及第二电路中的与该特定切断回路相对应的电路(以下称为特定电路)中,并且根据所述切断信号分别断开而切断所述特定电路。
2.根据权利要求1所述的多轴机械手的动力切断装置,其特征在于,
所述切断控制回路向所述第二半导体开关器件的控制端子定期地输出使该第二半导体开关器件断开的脉冲,并且诊断所述第二半导体开关器件是否断开。
3.根据权利要求2所述的多轴机械手的动力切断装置,其特征在于,
在将所述驱动回路以及所述电磁制动器定义为负载、将所述两个以上的第二半导体开关器件中的一个半导体开关器件定义为电源侧半导体开关器件、将比该电源侧半导体开关器件靠近所述负载侧的位置上的另一半导体开关器件定义为负载侧半导体开关器件的情况下,所述切断控制回路还具备向所述电源侧半导体开关器件的控制端子输出包含所述脉冲的第一诊断信号的第一诊断回路、和向所述负载侧半导体开关器件的控制端子输出第二诊断信号的第二诊断回路,所述第二诊断信号包含具有与所述第一诊断信号的脉冲不同的相位的脉冲;
所述第一诊断回路从所述负载侧半导体开关器件的所述负载侧的主端子接收对所述第二诊断信号的响应信号,并且诊断所述负载侧半导体开关器件是否正常工作;
所述第二诊断回路从所述电源侧半导体开关器件的所述负载侧的主端子接收对所述第一诊断信号的响应信号,并且诊断所述负载侧半导体开关器件是否正常工作。
4.一种多轴机械手,具备根据权利要求1至3中任意一项所述的动力切断装置。
Applications Claiming Priority (3)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2013-197457 | 2013-09-24 | ||
JP2013197457A JP5552564B1 (ja) | 2013-09-24 | 2013-09-24 | 多軸ロボットの動力遮断装置及び多軸ロボット |
PCT/JP2014/004664 WO2015045300A1 (ja) | 2013-09-24 | 2014-09-10 | 多軸ロボットの動力遮断装置及び多軸ロボット |
Publications (2)
Publication Number | Publication Date |
---|---|
CN105555489A true CN105555489A (zh) | 2016-05-04 |
CN105555489B CN105555489B (zh) | 2017-10-13 |
Family
ID=51416822
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201480051270.3A Active CN105555489B (zh) | 2013-09-24 | 2014-09-10 | 多轴机械手的动力切断装置以及多轴机械手 |
Country Status (7)
Country | Link |
---|---|
US (1) | US9676103B2 (zh) |
EP (1) | EP3050683B1 (zh) |
JP (1) | JP5552564B1 (zh) |
KR (1) | KR101758773B1 (zh) |
CN (1) | CN105555489B (zh) |
TW (1) | TWI540030B (zh) |
WO (1) | WO2015045300A1 (zh) |
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108527457A (zh) * | 2018-06-26 | 2018-09-14 | 珠海格力电器股份有限公司 | 具有安全指示灯的工业机器人和安全指示灯的工作方法 |
CN110957931A (zh) * | 2018-09-27 | 2020-04-03 | 台达电子工业股份有限公司 | 机器人系统 |
CN112743536A (zh) * | 2019-10-30 | 2021-05-04 | 精工爱普生株式会社 | 机器人系统及机器人系统的控制方法 |
CN115087934A (zh) * | 2019-12-13 | 2022-09-20 | 川崎重工业株式会社 | 安全信号输出装置、安装部件、安全系统以及监视无效化方法 |
Families Citing this family (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105984077B (zh) * | 2015-01-27 | 2018-06-29 | 宁波弘讯科技股份有限公司 | 一种控制注塑机机械手的方法和注塑机机械手及其驱动器 |
JP6613849B2 (ja) * | 2015-11-26 | 2019-12-04 | 株式会社デンソーウェーブ | ロボット制御装置 |
TWI586496B (zh) * | 2016-02-23 | 2017-06-11 | 寧波弘訊科技股份有限公司 | 機器人裝置及其運動控制方法 |
KR20180001638U (ko) | 2016-11-24 | 2018-06-01 | 정좌용 | 지그헤드 채비 |
CN110678815B (zh) * | 2017-05-31 | 2022-05-31 | 松下知识产权经营株式会社 | 诊断装置 |
JP6904201B2 (ja) * | 2017-09-27 | 2021-07-14 | セイコーエプソン株式会社 | ロボット制御装置、ロボット、及びロボットシステム |
JP6964024B2 (ja) * | 2018-03-19 | 2021-11-10 | 川崎重工業株式会社 | 短絡装置及びそれを備えるロボットシステム |
EP3809583B1 (en) * | 2018-06-15 | 2023-07-05 | Panasonic Intellectual Property Management Co., Ltd. | Cut-off circuit diagnostic device |
TWI691152B (zh) * | 2018-09-27 | 2020-04-11 | 台達電子工業股份有限公司 | 機器人系統 |
JP2022119095A (ja) * | 2021-02-03 | 2022-08-16 | セイコーエプソン株式会社 | ロボット制御装置およびロボットシステム |
Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH01308200A (ja) * | 1988-06-02 | 1989-12-12 | Meidensha Corp | ロボット用ブレーキ制御装置 |
CN1743145A (zh) * | 2004-08-30 | 2006-03-08 | 本田技研工业株式会社 | 运动体控制方法、控制系统、控制程序 |
JP2008187873A (ja) * | 2007-01-31 | 2008-08-14 | Hitachi Ltd | モータ駆動制御装置 |
CN101537622A (zh) * | 2009-04-24 | 2009-09-23 | 东莞艾尔发自动化机械有限公司 | 一种操作多轴机械手臂的控制方法及全伺服控制系统 |
CN101896320A (zh) * | 2007-12-11 | 2010-11-24 | 库卡罗伯特有限公司 | 具有冗余紧急制动电路的工业机器人 |
CN102190222A (zh) * | 2010-03-19 | 2011-09-21 | 东芝电梯株式会社 | 电梯的制动控制装置 |
CN103095190A (zh) * | 2011-11-08 | 2013-05-08 | 发那科株式会社 | 驱动与旋转轴连接的伺服电动机的伺服电动机驱动装置 |
CN103348586A (zh) * | 2010-09-15 | 2013-10-09 | 日产自动车株式会社 | 逆变器装置和逆变器控制方法 |
Family Cites Families (29)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
DE3312862A1 (de) * | 1983-04-09 | 1984-10-11 | Blohm + Voss Ag, 2000 Hamburg | Freiprogrammierbare, mehrachsige betaetigungsarmeinheit, insbesondere industrieroboter |
JPH01122981A (ja) | 1987-11-05 | 1989-05-16 | Keihan Concrete Kogyo Kk | 着色コンクリートブロック |
JPH01209970A (ja) * | 1988-02-15 | 1989-08-23 | Sankyo Seiki Mfg Co Ltd | モータのダイナミックブレーキ装置 |
US5394069A (en) * | 1993-03-08 | 1995-02-28 | International Business Machines Corporation | Mechanical brake hold circuit for an electric motor |
US5822207A (en) * | 1996-05-06 | 1998-10-13 | Amadasoft America, Inc. | Apparatus and method for integrating intelligent manufacturing system with expert sheet metal planning and bending system |
JPH10210739A (ja) * | 1997-01-23 | 1998-08-07 | Ricoh Co Ltd | スイッチング電源装置 |
JP3064940B2 (ja) * | 1997-02-07 | 2000-07-12 | 松下電器産業株式会社 | ロボットの安全装置 |
JP3587428B2 (ja) | 1997-10-08 | 2004-11-10 | 本田技研工業株式会社 | 故障診断回路 |
JP3962552B2 (ja) * | 2001-03-12 | 2007-08-22 | 日産自動車株式会社 | 車体搬送装置 |
JP4320556B2 (ja) * | 2003-04-02 | 2009-08-26 | 株式会社安川電機 | 産業用ロボットの制御装置 |
JP2005122641A (ja) | 2003-10-20 | 2005-05-12 | Docomo Systems Inc | 情報提供システム |
JP4200889B2 (ja) | 2003-12-04 | 2008-12-24 | 株式会社安川電機 | ロボットシステム |
US8593768B2 (en) | 2003-12-08 | 2013-11-26 | Rockwell Automation Technologies, Inc. | Apparatus and method for disabling the operation of high power devices |
US7253577B2 (en) | 2005-05-20 | 2007-08-07 | Rockwell Automation Technologies, Inc. | Independent safety processor for disabling the operation of high power devices |
JP2008153748A (ja) | 2006-12-14 | 2008-07-03 | Matsushita Electric Ind Co Ltd | 双方向スイッチ及び双方向スイッチの駆動方法 |
JP2008261896A (ja) * | 2007-04-10 | 2008-10-30 | Sony Corp | 撮像装置、ストロボ装置、および充電制御方法 |
JP2008307618A (ja) * | 2007-06-12 | 2008-12-25 | Denso Wave Inc | ロボットの制御装置 |
JP2009095939A (ja) * | 2007-10-17 | 2009-05-07 | Yaskawa Electric Corp | ロボットおよびロボットシステム |
JP5077030B2 (ja) * | 2008-04-10 | 2012-11-21 | 株式会社デンソー | モータ駆動回路およびモータの異常判定方法 |
JP5099039B2 (ja) * | 2009-02-20 | 2012-12-12 | 株式会社デンソーウェーブ | ロボットのコントローラ |
JP5192430B2 (ja) * | 2009-03-24 | 2013-05-08 | 平田機工株式会社 | 制御装置及び制御方法 |
JP2010288318A (ja) * | 2009-06-09 | 2010-12-24 | Toyota Motor Corp | インバータ回路システム |
DE102009043404A1 (de) * | 2009-09-29 | 2011-09-22 | Kuka Roboter Gmbh | Industrieroboter mit einem Schleppanschlag |
DE202009016532U1 (de) * | 2009-10-30 | 2010-03-18 | Franz Haimer Maschinenbau Kg | Wuchtmaschine mit automatisierter Umschlagmessung |
JP5418304B2 (ja) | 2010-02-26 | 2014-02-19 | 富士電機株式会社 | 電力変換器 |
JP2012065479A (ja) * | 2010-09-17 | 2012-03-29 | Toyota Motor Corp | モータ駆動装置およびそれを搭載する車両 |
JP5267529B2 (ja) * | 2010-09-27 | 2013-08-21 | ダイキン工業株式会社 | 冷凍装置の電力制御基板 |
JP5681474B2 (ja) * | 2010-12-16 | 2015-03-11 | 川崎重工業株式会社 | ロボット制御装置およびロボット制御方法 |
US9183346B2 (en) * | 2012-03-12 | 2015-11-10 | Empire Technology Development Llc | Robotic appendages |
-
2013
- 2013-09-24 JP JP2013197457A patent/JP5552564B1/ja active Active
-
2014
- 2014-09-10 WO PCT/JP2014/004664 patent/WO2015045300A1/ja active Application Filing
- 2014-09-10 KR KR1020167000048A patent/KR101758773B1/ko active IP Right Grant
- 2014-09-10 EP EP14849938.7A patent/EP3050683B1/en active Active
- 2014-09-10 CN CN201480051270.3A patent/CN105555489B/zh active Active
- 2014-09-10 US US15/024,789 patent/US9676103B2/en active Active
- 2014-09-19 TW TW103132383A patent/TWI540030B/zh active
Patent Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH01308200A (ja) * | 1988-06-02 | 1989-12-12 | Meidensha Corp | ロボット用ブレーキ制御装置 |
CN1743145A (zh) * | 2004-08-30 | 2006-03-08 | 本田技研工业株式会社 | 运动体控制方法、控制系统、控制程序 |
JP2008187873A (ja) * | 2007-01-31 | 2008-08-14 | Hitachi Ltd | モータ駆動制御装置 |
CN101896320A (zh) * | 2007-12-11 | 2010-11-24 | 库卡罗伯特有限公司 | 具有冗余紧急制动电路的工业机器人 |
CN101537622A (zh) * | 2009-04-24 | 2009-09-23 | 东莞艾尔发自动化机械有限公司 | 一种操作多轴机械手臂的控制方法及全伺服控制系统 |
CN102190222A (zh) * | 2010-03-19 | 2011-09-21 | 东芝电梯株式会社 | 电梯的制动控制装置 |
CN103348586A (zh) * | 2010-09-15 | 2013-10-09 | 日产自动车株式会社 | 逆变器装置和逆变器控制方法 |
CN103095190A (zh) * | 2011-11-08 | 2013-05-08 | 发那科株式会社 | 驱动与旋转轴连接的伺服电动机的伺服电动机驱动装置 |
Cited By (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108527457A (zh) * | 2018-06-26 | 2018-09-14 | 珠海格力电器股份有限公司 | 具有安全指示灯的工业机器人和安全指示灯的工作方法 |
CN110957931A (zh) * | 2018-09-27 | 2020-04-03 | 台达电子工业股份有限公司 | 机器人系统 |
CN110957931B (zh) * | 2018-09-27 | 2020-11-27 | 台达电子工业股份有限公司 | 机器人系统 |
CN112743536A (zh) * | 2019-10-30 | 2021-05-04 | 精工爱普生株式会社 | 机器人系统及机器人系统的控制方法 |
CN112743536B (zh) * | 2019-10-30 | 2023-06-16 | 精工爱普生株式会社 | 机器人系统及机器人系统的控制方法 |
CN115087934A (zh) * | 2019-12-13 | 2022-09-20 | 川崎重工业株式会社 | 安全信号输出装置、安装部件、安全系统以及监视无效化方法 |
Also Published As
Publication number | Publication date |
---|---|
TW201529256A (zh) | 2015-08-01 |
EP3050683A4 (en) | 2017-07-26 |
US20160243710A1 (en) | 2016-08-25 |
JP5552564B1 (ja) | 2014-07-16 |
TWI540030B (zh) | 2016-07-01 |
KR101758773B1 (ko) | 2017-07-31 |
EP3050683A1 (en) | 2016-08-03 |
CN105555489B (zh) | 2017-10-13 |
WO2015045300A1 (ja) | 2015-04-02 |
JP2015062970A (ja) | 2015-04-09 |
KR20160015358A (ko) | 2016-02-12 |
EP3050683B1 (en) | 2022-12-07 |
US9676103B2 (en) | 2017-06-13 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN105555489A (zh) | 多轴机械手的动力切断装置以及多轴机械手 | |
KR101236083B1 (ko) | 리던던트 비상 제동 회로를 가진 산업용 로봇 | |
US6573681B2 (en) | Drive control for a three phase AC motor via an inverter using safe technology | |
US10250169B2 (en) | Robot system | |
JP2018074794A (ja) | 共通の順変換器を有するモータ駆動装置 | |
CN102771042A (zh) | 控制多相电机的方法和装置 | |
JP2015012621A (ja) | マルチレベル電力変換回路 | |
JP2017100210A (ja) | ロボットシステム | |
EP3501876B1 (en) | Control unit, inverter, assembly, vehicle and method for controlling an inverter | |
CN110784154A (zh) | 电动机驱动装置 | |
WO2015098753A1 (ja) | ロボット制御システム | |
CN104716860A (zh) | 用于单轴或多轴布置的变流器装置和运行方法 | |
CN114465526B (zh) | 电动马达用的控制装置、具备该控制装置的机器人以及电动马达的控制方法 | |
KR20200100916A (ko) | 3상 교류모터 제어 방법 및 장치 | |
RU2540959C2 (ru) | Электропривод переменного тока повышенной живучести | |
JP6641921B2 (ja) | ロボット制御装置 | |
US20230246559A1 (en) | Filter connected to pwm converter and converter system | |
CN212811588U (zh) | 电动工具及其电机控制装置 | |
CN114759524A (zh) | 一种三相交流永磁同步电机主动短路的系统及方法 | |
JPH0287985A (ja) | Acサーボモータ駆動制御回路 |
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 |