TW202107858A - Encoder system, motor system and robot - Google Patents

Encoder system, motor system and robot Download PDF

Info

Publication number
TW202107858A
TW202107858A TW109124654A TW109124654A TW202107858A TW 202107858 A TW202107858 A TW 202107858A TW 109124654 A TW109124654 A TW 109124654A TW 109124654 A TW109124654 A TW 109124654A TW 202107858 A TW202107858 A TW 202107858A
Authority
TW
Taiwan
Prior art keywords
encoder
power supply
wiring
voltage
circuit
Prior art date
Application number
TW109124654A
Other languages
Chinese (zh)
Other versions
TWI728874B (en
Inventor
永田宏明
上甲均
Original Assignee
日商日本電產三協股份有限公司
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 日商日本電產三協股份有限公司 filed Critical 日商日本電產三協股份有限公司
Publication of TW202107858A publication Critical patent/TW202107858A/en
Application granted granted Critical
Publication of TWI728874B publication Critical patent/TWI728874B/en

Links

Images

Classifications

    • GPHYSICS
    • G01MEASURING; TESTING
    • G01DMEASURING NOT SPECIALLY ADAPTED FOR A SPECIFIC VARIABLE; ARRANGEMENTS FOR MEASURING TWO OR MORE VARIABLES NOT COVERED IN A SINGLE OTHER SUBCLASS; TARIFF METERING APPARATUS; MEASURING OR TESTING NOT OTHERWISE PROVIDED FOR
    • G01D5/00Mechanical means for transferring the output of a sensing member; Means for converting the output of a sensing member to another variable where the form or nature of the sensing member does not constrain the means for converting; Transducers not specially adapted for a specific variable
    • G01D5/12Mechanical means for transferring the output of a sensing member; Means for converting the output of a sensing member to another variable where the form or nature of the sensing member does not constrain the means for converting; Transducers not specially adapted for a specific variable using electric or magnetic means
    • G01D5/14Mechanical means for transferring the output of a sensing member; Means for converting the output of a sensing member to another variable where the form or nature of the sensing member does not constrain the means for converting; Transducers not specially adapted for a specific variable using electric or magnetic means influencing the magnitude of a current or voltage
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J13/00Controls for manipulators
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J19/00Accessories fitted to manipulators, e.g. for monitoring, for viewing; Safety devices combined with or specially adapted for use in connection with manipulators
    • B25J19/02Sensing devices
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00Programme-controlled manipulators
    • B25J9/10Programme-controlled manipulators characterised by positioning means for manipulator elements
    • B25J9/12Programme-controlled manipulators characterised by positioning means for manipulator elements electric
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01DMEASURING NOT SPECIALLY ADAPTED FOR A SPECIFIC VARIABLE; ARRANGEMENTS FOR MEASURING TWO OR MORE VARIABLES NOT COVERED IN A SINGLE OTHER SUBCLASS; TARIFF METERING APPARATUS; MEASURING OR TESTING NOT OTHERWISE PROVIDED FOR
    • G01D5/00Mechanical means for transferring the output of a sensing member; Means for converting the output of a sensing member to another variable where the form or nature of the sensing member does not constrain the means for converting; Transducers not specially adapted for a specific variable
    • G01D5/12Mechanical means for transferring the output of a sensing member; Means for converting the output of a sensing member to another variable where the form or nature of the sensing member does not constrain the means for converting; Transducers not specially adapted for a specific variable using electric or magnetic means
    • G01D5/244Mechanical means for transferring the output of a sensing member; Means for converting the output of a sensing member to another variable where the form or nature of the sensing member does not constrain the means for converting; Transducers not specially adapted for a specific variable using electric or magnetic means influencing characteristics of pulses or pulse trains; generating pulses or pulse trains
    • HELECTRICITY
    • H02GENERATION; CONVERSION OR DISTRIBUTION OF ELECTRIC POWER
    • H02PCONTROL OR REGULATION OF ELECTRIC MOTORS, ELECTRIC GENERATORS OR DYNAMO-ELECTRIC CONVERTERS; CONTROLLING TRANSFORMERS, REACTORS OR CHOKE COILS
    • H02P5/00Arrangements specially adapted for regulating or controlling the speed or torque of two or more electric motors
    • HELECTRICITY
    • H02GENERATION; CONVERSION OR DISTRIBUTION OF ELECTRIC POWER
    • H02PCONTROL OR REGULATION OF ELECTRIC MOTORS, ELECTRIC GENERATORS OR DYNAMO-ELECTRIC CONVERTERS; CONTROLLING TRANSFORMERS, REACTORS OR CHOKE COILS
    • H02P6/00Arrangements for controlling synchronous motors or other dynamo-electric motors using electronic commutation dependent on the rotor position; Electronic commutators therefor
    • H02P6/14Electronic commutators
    • H02P6/16Circuit arrangements for detecting position
    • HELECTRICITY
    • H02GENERATION; CONVERSION OR DISTRIBUTION OF ELECTRIC POWER
    • H02PCONTROL OR REGULATION OF ELECTRIC MOTORS, ELECTRIC GENERATORS OR DYNAMO-ELECTRIC CONVERTERS; CONTROLLING TRANSFORMERS, REACTORS OR CHOKE COILS
    • H02P2203/00Indexing scheme relating to controlling arrangements characterised by the means for detecting the position of the rotor
    • H02P2203/03Determination of the rotor position, e.g. initial rotor position, during standstill or low speed operation

Landscapes

  • Engineering & Computer Science (AREA)
  • Robotics (AREA)
  • Mechanical Engineering (AREA)
  • Power Engineering (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Manipulator (AREA)
  • Transmission And Conversion Of Sensor Element Output (AREA)
  • Control Of Multiple Motors (AREA)

Abstract

A system in which a power supply voltage is supplied from a common power supply circuit to a plurality of encoders is configured such that a fault location in power supply wiring can be easily identified. The system is provided with: an encoder power supply circuit 12 for generating a power supply voltage; individual power supply wires 54 each provided for each encoder 52 to supply the power supply voltage and having one end connected to the encoder; switches 22 each provided for each individual power supply wire 54 on the other end side of the individual power supply wire 54 to switch between connection to and disconnection from the encoder power supply circuit 12; and voltage detection circuits 23 each provided for each individual power supply wire 54 and disposed closer to the encoder 52 than the switch 22 at the other end side of the individual power supply wire.

Description

編碼器系統、馬達系統以及機器人Encoder system, motor system and robot

本發明是有關於一種在由馬達驅動的機器人等中包含位置的檢測中所使用的編碼器的編碼器系統、包含編碼器系統的馬達系統以及機器人。The present invention relates to an encoder system including an encoder used for position detection in a robot or the like driven by a motor, a motor system including the encoder system, and a robot.

包括機械手(manipulator)與控制器(controller)的機器人藉由針對機械手的每一軸而設置的馬達而驅動,各軸的馬達被控制器基於所述軸的位置而控制。為了檢測各軸的位置而使用編碼器。若編碼器不正常運作,則無法使設置有所述編碼器的機械手正常運作。編碼器針對機械手的每一軸而連接於所述軸的馬達的旋轉軸,檢測所述馬達的旋轉位置。編碼器於其內部包含電子電路等,被供給電源電壓而對機器人的控制裝置等輸出表示軸位置等的訊號。因此,於編碼器處連接有電源供給用的配線即電源配線及用於傳遞訊號的訊號配線。於機械手中,通常設置多個軸並設置多個編碼器,但一般而言對多個編碼器以自共用的配線分支的形態供給電源電壓。再者,作為設置於機械手的編碼器,一般而言使用絕對值編碼器。在停止供給來自外部的電源電壓時,絕對值編碼器需要轉移至備用模態(backup mode)等而保持資料,且進行將停止期間的旋轉位置的變化等予以儲存等最小限度的運作。A robot including a manipulator and a controller is driven by a motor provided for each axis of the manipulator, and the motor of each axis is controlled by the controller based on the position of the axis. To detect the position of each axis, an encoder is used. If the encoder does not operate normally, the manipulator provided with the encoder cannot be operated normally. The encoder is connected to the rotation shaft of the motor of the shaft for each shaft of the manipulator, and detects the rotation position of the motor. The encoder includes an electronic circuit and the like inside, and is supplied with a power supply voltage to output a signal indicating the position of the axis and the like to the control device of the robot. Therefore, the encoder is connected with wiring for power supply, that is, power wiring and signal wiring for transmitting signals. In a manipulator, multiple shafts and multiple encoders are usually installed, but generally, the power supply voltage is supplied to multiple encoders in a form of branching from a common wiring. In addition, as the encoder installed in the manipulator, an absolute encoder is generally used. When the supply of external power supply voltage is stopped, the absolute encoder needs to shift to a backup mode, etc., to retain data, and to perform minimal operations such as storing changes in the rotational position during the stop period.

在搬送製造液晶顯示面板中所使用的玻璃基板的機器人等近年來的機器人中,有機械手部分大、而軸的移動距離長的機器人。隨著機械手運作而編碼器在三維空間內位置亦變化即編碼器亦移動,故設置於機械手內且連接於編碼器的配線用纜線亦移動會被彎折或扭轉。將配線被彎折或扭轉稱為配線變形。配線變形的結果為,在纜線內的配線中有可能產生短路或接地。當連接於編碼器的配線中於訊號配線發生故障的情形下,原本訊號配線是針對每一軸而設置而發送位置資料,故即便發生故障,所述故障亦會作為針對每一軸而言的通訊異常被檢測出,而可容易地確定具有不良狀況的軸。相對於此,當於電源配線發生故障的情形下,由於是共用配線,故全部編碼器的電源同時變為異常,從而難以基於發生有電源異常的軸的資訊而確定是哪一軸的電源配線發生了故障。因此,需要藉由目視而調查機械手內所設置的全部電源配線,在大型機械手的情形下確定故障部位需要大量時間。確定此種故障部位需要大量時間的課題並非是機器人固有的課題,於具有多個編碼器的編碼器系統、包括多個馬達且針對每一馬達而設置有編碼器的馬達系統中亦為共同的課題。Among recent robots such as robots that transport glass substrates used in the manufacture of liquid crystal display panels, there are robots that have a large manipulator and a long axis of movement. As the manipulator operates, the position of the encoder in the three-dimensional space changes, that is, the encoder also moves. Therefore, the wiring cable installed in the manipulator and connected to the encoder will also move and be bent or twisted. The bending or twisting of the wiring is referred to as wiring deformation. As a result of the deformation of the wiring, a short circuit or grounding may occur in the wiring in the cable. When the wiring connected to the encoder fails in the signal wiring, the original signal wiring is set for each axis to send position data, so even if there is a failure, the failure will also be regarded as a communication abnormality for each axis Is detected, and the shaft with a bad condition can be easily identified. In contrast, in the case of a power wiring failure, the power supply of all encoders becomes abnormal at the same time due to the common wiring, and it is difficult to determine which axis power wiring has occurred based on the information of the axis where the power supply is abnormal. Fault. Therefore, it is necessary to visually investigate all the power supply wiring installed in the robot, and in the case of a large robot, it takes a lot of time to identify the faulty location. The problem that requires a lot of time to determine the fault location is not a problem inherent to robots, and it is also common in an encoder system with multiple encoders, and a motor system that includes multiple motors and is equipped with an encoder for each motor. Subject.

作為用於確定與編碼器相關聯的故障原因的技術的一例,專利文獻1揭示一種編碼器,包括:異常檢測部,基於與編碼器或馬達的狀態相關的狀態資訊而檢測異常;原因解析部,在檢測出異常的情形下基於狀態資訊解析異常的發生原因;以及非揮發性記憶體控制部,將由原因解析部解析的解析結果儲存於非揮發性記憶體。作為應對自控制器側對編碼器的電力供給不足的技術,專利文獻2揭示:針對每一編碼器設置輔助電源,且設置電源電壓檢測電路,所述電源電壓檢測電路在自控制器側被供給的電源電壓的值為臨限值以下時,將來自輔助電源的電力供給至編碼器。然而,專利文獻1、專利文獻2所揭示的技術,無法使用於進行連接於編碼器的電源配線的故障部位的確定。雖然並不與編碼器相關聯,但作為檢測電源電壓的降低並確定故障部位的技術,專利文獻3揭示:在自共用電源對多個外部設備供給電源電壓的情形下,對自共用電源針對每一外部設備而分支的各條電源線設置連接/斷開電路,在檢測出共用電源的電壓降低時,針對每一電源線依序將所述電源線自共用電源斷開,藉此檢測在與哪一外部設備對應的電源線中產生了故障。 [現有技術文獻] [專利文獻]As an example of a technique for determining the cause of a malfunction associated with an encoder, Patent Document 1 discloses an encoder including: an abnormality detection unit that detects abnormality based on state information related to the state of the encoder or motor; and a cause analysis unit , When an abnormality is detected, analyze the cause of the abnormality based on the status information; and the non-volatile memory control unit stores the analysis result analyzed by the cause analysis unit in the non-volatile memory. As a technique for coping with insufficient power supply to the encoder from the controller side, Patent Document 2 discloses that an auxiliary power supply is provided for each encoder, and a power supply voltage detection circuit is provided, and the power supply voltage detection circuit is supplied from the controller side When the value of the power supply voltage is below the threshold value, the power from the auxiliary power supply is supplied to the encoder. However, the techniques disclosed in Patent Document 1 and Patent Document 2 cannot be used to identify the faulty part of the power supply wiring connected to the encoder. Although it is not associated with an encoder, as a technique for detecting a decrease in power supply voltage and identifying a fault location, Patent Document 3 discloses that when the power supply voltage is supplied to a plurality of external devices from a common power supply, the common power supply is Each power line branched by an external device is provided with a connection/disconnection circuit. When the voltage drop of the common power supply is detected, the power line is sequentially disconnected from the common power supply for each power line, thereby detecting the Which external device has a fault in the corresponding power cord. [Prior Art Literature] [Patent Literature]

[專利文獻1]日本專利特開2015-90307號公報 [專利文獻2]日本專利特開平8-251817號公報 [專利文獻3]日本專利特開平10-203740號公報[Patent Document 1] Japanese Patent Laid-Open No. 2015-90307 [Patent Document 2] Japanese Patent Laid-Open No. 8-251817 [Patent Document 3] Japanese Patent Laid-Open No. 10-203740

[發明所欲解決之課題][The problem to be solved by the invention]

專利文獻3所揭示的技術中,若故障為完全接地或短路則可檢測出在與哪一外部設備對應的電源線中產生了故障,但在應用於檢測編碼器的電源配線的故障的情形下,對於進行電源配線的故障與訊號配線的故障的區分或發現故障來臨前的預兆而言不充分。In the technique disclosed in Patent Document 3, if the fault is a complete grounding or short-circuit, it can be detected that the power line corresponding to which external device has the fault has occurred, but when it is applied to the detection of a fault in the power wiring of an encoder , It is not sufficient to distinguish the fault of power wiring from the fault of signal wiring or to discover the signs before the failure.

本發明的目的在於提供一種可容易地確定與編碼器對應的電源配線的故障部位的編碼器系統、包括此種編碼器系統的馬達系統以及機器人。 [解決課題之手段]The object of the present invention is to provide an encoder system that can easily identify a faulty part of the power supply wiring corresponding to the encoder, a motor system including such an encoder system, and a robot. [Means to solve the problem]

本發明的編碼器系統具有:多個編碼器;編碼器電源電路,產生電源電壓;個別電源配線,為了供給電源電壓而針對每一編碼器而設置,且一端連接於所述編碼器;開關,針對每一個別電源配線而設置於所述個別電源配線的另一端側,切換與編碼器電源電路的連接與斷開;以及第一電壓檢測電路,針對每一個別電源配線而於所述個別電源配線的另一端側設置於較開關更靠編碼器側。The encoder system of the present invention has: a plurality of encoders; an encoder power supply circuit that generates a power supply voltage; individual power supply wiring is provided for each encoder for supplying the power supply voltage, and one end is connected to the encoder; a switch, For each individual power supply wiring, it is provided on the other end side of the individual power supply wiring to switch the connection and disconnection of the encoder power supply circuit; and the first voltage detection circuit is connected to the individual power supply for each individual power supply wiring. The other end of the wiring is located closer to the encoder side than the switch.

於本發明的編碼器系統中,可藉由開關而將個別電源配線逐條獨立地與編碼器電源電路連接或斷開,且可針對每一個別電源配線而測定電壓,故在個別電源配線中產生接地或短路等故障時,可迅速地判定是哪一個別電源配線的故障,且可自訊號配線等的故障區分而判定,從而可在短時間內進行不良部位的確定。In the encoder system of the present invention, individual power wiring can be independently connected to or disconnected from the encoder power circuit one by one by a switch, and the voltage can be measured for each individual power wiring, so in the individual power wiring When a fault such as grounding or short-circuit occurs, it can be quickly determined which individual power wiring is faulty, and can be determined from the fault classification of signal wiring, etc., so that the defective part can be identified in a short time.

於本發明的編碼器系統中,較佳的是使第一電壓檢測電路輸出電壓值,且使編碼器具備檢測所述被供給的電源電壓並作為電壓值而輸出的第二電壓檢測電路。根據所述構成,可根據由第一電壓檢測電路檢測出的電壓值與由第二電壓檢測電路檢測出的電壓值的差,來算出個別電源配線中的電壓降或配線阻抗(impedance),而容易地發現個別電源配線中的異常或異常前的徵兆。在編碼器具備藉由檢測電壓降而轉移至備用模態的功能的情形下,可容易地進行異常時向備用模態的轉移。In the encoder system of the present invention, it is preferable that the first voltage detection circuit output a voltage value, and the encoder is provided with a second voltage detection circuit that detects the supplied power supply voltage and outputs it as the voltage value. According to the above configuration, the voltage drop or wiring impedance (impedance) in individual power wiring can be calculated based on the difference between the voltage value detected by the first voltage detection circuit and the voltage value detected by the second voltage detection circuit, and Easily find abnormalities or pre-abnormal signs in individual power wiring. When the encoder has a function of shifting to the standby mode by detecting a voltage drop, the shift to the standby mode in the event of an abnormality can be easily performed.

當在編碼器設置第二電壓檢測電路的情形下,進而,可設置運算機構,所述運算機構運算由第一電壓檢測電路檢測出的電壓值與由第二電壓檢測電路檢測出的電壓值的差。藉由在運算機構中運算差,而可自動算出電壓降或配線阻抗,而更容易發現異常或異常前的徵兆。運算機構亦可將與差相應的電源控制訊號輸出至編碼器電源電路。藉由將電源控制訊號發送至編碼器電源電路,即便於電壓降或配線阻抗發生變化,亦可將供給至編碼器的電源電壓維持為適當值。When a second voltage detection circuit is provided in the encoder, an arithmetic mechanism may be provided for calculating the difference between the voltage value detected by the first voltage detection circuit and the voltage value detected by the second voltage detection circuit. difference. By calculating the difference in the arithmetic mechanism, the voltage drop or wiring impedance can be automatically calculated, making it easier to find abnormalities or signs before the abnormalities. The arithmetic mechanism can also output the power control signal corresponding to the difference to the encoder power circuit. By sending the power supply control signal to the encoder power supply circuit, the power supply voltage supplied to the encoder can be maintained at an appropriate value even if the voltage drop or wiring impedance changes.

於本發明中,亦可根據個別電源配線的長度而將多個編碼器分類為多個系統,針對每一系統而設置編碼器電源電路。若個別電源配線的長度不同則電壓降量亦不同,故基於個別電源配線的長度而分類為多個系統,針對每一系統設置編碼器電源電路,藉此可預見電壓降量而設定編碼器電源電路的輸出電壓,從而能夠使實際供給至各編碼器的電源電壓的值更接近適當值。In the present invention, a plurality of encoders may be classified into a plurality of systems according to the length of individual power supply wiring, and an encoder power supply circuit may be provided for each system. If the length of the individual power wiring is different, the voltage drop is also different. Therefore, it is classified into multiple systems based on the length of the individual power wiring. An encoder power supply circuit is provided for each system to predict the voltage drop to set the encoder power supply. The output voltage of the circuit can thereby bring the value of the power supply voltage actually supplied to each encoder closer to an appropriate value.

本發明的馬達系統包括多個馬達,且所述馬達系統包括本發明的編碼器系統,針對每一馬達而設置有編碼器系統的編碼器。根據本發明的馬達系統,藉由包括本發明的編碼器系統,在針對每一編碼器而設置的個別電源配線中產生接地或短路等故障時,可迅速地判定是哪一個別電源配線的故障,從而可在短時間內進行不良部位的確定。The motor system of the present invention includes a plurality of motors, and the motor system includes the encoder system of the present invention, and an encoder of the encoder system is provided for each motor. According to the motor system of the present invention, by including the encoder system of the present invention, when a fault such as grounding or short circuit occurs in the individual power wiring provided for each encoder, it is possible to quickly determine which individual power wiring is faulty , So that the defective part can be identified in a short time.

本發明的機器人具有:機械手,包括多個馬達;以及控制器,控制機械手,且所述機器人包括本發明的編碼器系統,針對每一馬達而設置有編碼器系統的編碼器。根據本發明的機器人,在針對每一編碼器而設置的個別電源配線中產生接地或短路等故障時,可迅速地判定是哪一個別電源配線的故障,從而可在短時間內進行不良部位的確定。The robot of the present invention has: a manipulator including a plurality of motors; and a controller to control the manipulator, and the robot includes the encoder system of the present invention, and an encoder of the encoder system is provided for each motor. According to the robot of the present invention, when a fault such as grounding or short-circuit occurs in the individual power wiring provided for each encoder, it can be quickly determined which individual power wiring is faulty, so that the defective part can be repaired in a short time. determine.

特別是,於本發明的機器人中,較佳的是於每一個別電源配線的第一電壓檢測電路與編碼器之間的區間,包含有所述個別電源配線伴隨著機械手的移動而變形的區間。一般而言,在機器人中一部分配線伴隨著機械手的移動而變形,於此種變形的區間中容易發生配線的短路或接地、斷線等故障。因此,於個別電源配線中,在因機械手的移動而伴隨的變形的區間包含於設置在另一端側的開關及第一電壓檢測電路與一端側的編碼器之間的區間,藉此可對於預想為發生頻度為高的不良狀況,在短時間內進行所述不良狀況的發生部位的確定,從而能夠大幅度削減機器人的停機時間(downtime)。In particular, in the robot of the present invention, it is preferable that the interval between the first voltage detection circuit and the encoder of each individual power supply wiring includes the deformation of the individual power supply wiring accompanying the movement of the manipulator. Interval. In general, a part of the wiring in a robot is deformed with the movement of the manipulator, and faults such as a short circuit of the wiring, grounding, and disconnection are likely to occur in such a deformed section. Therefore, in the individual power wiring, the section of deformation caused by the movement of the manipulator is included in the section between the switch provided on the other end and the first voltage detection circuit and the encoder on the one end. It is expected that the occurrence frequency of the failure is high, and the location of the occurrence of the failure is determined in a short time, so that the downtime of the robot can be greatly reduced.

於本發明的機器人中,開關及第一電壓檢測電路可配置於控制器。藉由配置於控制器,可無需對機械手側進行改造而將本發明應用於現有的機器人。或者是,於本發明的機器人中,開關及第一電壓檢測電路可配置於機械手。若配置於機械手,則在控制器與機械手之間僅準備一條與編碼器相關的電源配線即可,故可簡單地進行配線的引繞等。 [發明的效果]In the robot of the present invention, the switch and the first voltage detection circuit can be configured in the controller. By being arranged in the controller, the present invention can be applied to existing robots without modifying the manipulator side. Alternatively, in the robot of the present invention, the switch and the first voltage detection circuit may be configured in the manipulator. If it is placed in a robot, only one power supply wiring related to the encoder can be prepared between the controller and the robot, so the wiring can be easily routed. [Effects of the invention]

根據本發明,在自共用的電源電路對多個編碼器供給電源電壓的情形下,可容易地確定電源配線的故障部位。According to the present invention, when the power supply voltage is supplied to a plurality of encoders from a shared power supply circuit, the faulty part of the power supply wiring can be easily identified.

接著,參照圖式對本發明的較佳的實施形態進行說明。圖1表示實施本發明的一形態的機器人。所述機器人包含控制器10以及機械手50,機械手50包括多個軸。於機械手50中,針對每一軸設置有馬達51及與所述軸的馬達51機械性連接的編碼器52。在圖示中將軸的數目設為四個且繪製四組馬達51與編碼器52的組合,但機械手50中的軸的數目亦可為五個以上。Next, a preferred embodiment of the present invention will be described with reference to the drawings. Fig. 1 shows a robot according to one aspect of the present invention. The robot includes a controller 10 and a manipulator 50, and the manipulator 50 includes a plurality of axes. In the manipulator 50, a motor 51 and an encoder 52 mechanically connected to the motor 51 of the shaft are provided for each axis. In the figure, the number of shafts is set to four and four sets of combinations of motors 51 and encoders 52 are drawn, but the number of shafts in the manipulator 50 may also be five or more.

控制器10包括:驅動器電路11,驅動機械手50內的各軸的馬達51;編碼器電源電路12,產生供給至各軸的編碼器52的電源電壓;編碼器接收電路13,自各軸的編碼器52接收表示馬達位置等的訊號;以及控制部14,藉由微處理器(microprocessor)等而構成,執行用於進行機器人整體的控制所需的運算等。圖式中為了便於說明,而以虛線表示與控制部14相關的配線。各軸的馬達51藉由針對每一馬達51而設置的馬達配線53與驅動器電路11連接,由驅動器電路11針對每一軸而獨立地驅動。為了對各軸的編碼器52供給電源電壓,至少在機械手50內針對每一編碼器52而設置個別電源配線54。個別電源配線54亦延伸至控制器10內。另一方面,自編碼器電源電路12經由共用電源配線21而輸出電源電壓。於控制器10內,對於共用電源配線21經由每一軸的開關22而連接有每一軸的個別電源配線54。而且,於控制器10,針對每一個別電源配線54,設置有與所述對應的個別電源配線54連接而檢測電壓的電壓檢測電路23。於個別電源配線54中供設置電壓檢測電路23的位置雖然接近開關22,但較開關22更靠編碼器52側。因此,個別電源配線54的一端與編碼器52連接,且於另一端側設置有開關22及電壓檢測電路23。於所述機器人中,針對各軸的編碼器52的電源電壓自以共用的方式設置於編碼器52的共用電源配線21,經由針對每一編碼器52而設置的開關22及個別電源配線54而供給。開關22針對每一編碼器52而實現與編碼器電源電路12的連接及斷開。The controller 10 includes: a driver circuit 11, which drives the motor 51 of each axis in the manipulator 50; an encoder power supply circuit 12, which generates a power supply voltage supplied to the encoder 52 of each axis; and an encoder receiving circuit 13, which encodes each axis The device 52 receives a signal indicating the position of the motor and the like; and the control unit 14 is constituted by a microprocessor or the like, and executes calculations and the like necessary for controlling the entire robot. In the drawings, for convenience of explanation, the wiring related to the control unit 14 is indicated by a broken line. The motor 51 of each axis is connected to the driver circuit 11 by the motor wiring 53 provided for each motor 51, and is independently driven by the driver circuit 11 for each axis. In order to supply the power supply voltage to the encoder 52 of each axis, an individual power supply wiring 54 is provided for each encoder 52 at least in the robot 50. The individual power wiring 54 also extends into the controller 10. On the other hand, the self-encoder power supply circuit 12 outputs a power supply voltage via the common power supply wiring 21. In the controller 10, an individual power supply wiring 54 for each axis is connected to the common power supply wiring 21 via a switch 22 for each axis. In addition, the controller 10 is provided with a voltage detection circuit 23 that is connected to the corresponding individual power supply wiring 54 and detects voltage for each individual power supply wiring 54. Although the position where the voltage detection circuit 23 is installed in the individual power wiring 54 is close to the switch 22, it is closer to the encoder 52 side than the switch 22. Therefore, one end of the individual power supply wiring 54 is connected to the encoder 52, and a switch 22 and a voltage detection circuit 23 are provided on the other end side. In the robot, the power supply voltage of the encoder 52 for each axis is shared from the common power supply wiring 21 of the encoder 52, and is connected to the switch 22 and the individual power supply wiring 54 provided for each encoder 52. supply. The switch 22 is connected to and disconnected from the encoder power circuit 12 for each encoder 52.

來自各軸的編碼器52的訊號經由針對每一編碼器52設置的訊號配線55輸入至編碼器接收電路13。於控制器10,亦設置斷線檢測電路15,所述設置斷線檢測電路15藉由檢測各訊號配線55的訊號電壓等而檢測訊號配線55的斷線。控制部14例如執行以下控制,即:基於自外部輸入的位置指令與自各編碼器52輸入的位置資料,以機械手50的位置成為藉由位置指令而指定的位置的方式經由驅動器電路11驅動各軸的馬達51,進而,控制各開關22的導通(ON)/關斷(OFF)或編碼器電源電路12,基於來自斷線檢測電路15的輸入或各電壓檢測電路23的檢測值進行有無發生故障或故障部位的確定。為了能夠進行來自控制部14的控制,開關22例如包括機械式繼電器(mechanical relay)或半導體開關。The signal from the encoder 52 of each axis is input to the encoder receiving circuit 13 via the signal wiring 55 provided for each encoder 52. The controller 10 is also provided with a disconnection detection circuit 15 which detects the disconnection of the signal wiring 55 by detecting the signal voltage of each signal wiring 55 and the like. The control unit 14 executes, for example, the following control: based on the position command input from the outside and the position data input from each encoder 52, the position of the manipulator 50 becomes the position specified by the position command and drives each of them via the driver circuit 11 The shaft motor 51, in turn, controls the on/off (OFF) of each switch 22 or the encoder power supply circuit 12, based on the input from the disconnection detection circuit 15 or the detection value of each voltage detection circuit 23 to determine whether there is any occurrence Determination of the fault or fault location. In order to enable control from the control unit 14, the switch 22 includes, for example, a mechanical relay (mechanical relay) or a semiconductor switch.

本實施形態的機器人例如為用以搬送製造液晶顯示面板中所使用的玻璃基板等的機器人,包括大型機械手50,且機械手50的移動距離亦長。因此,機械手50內的馬達配線53、個別電源配線54及訊號配線55的長度例如亦長達數十米(m)。藉由機械手50運作並移動,馬達配線53、個別電源配線54及訊號配線55亦與機械手50一起移動,其結果為,被彎折或被扭轉即變形而承受各種應力(stress)。此種應力亦可能成為配線接地、短路、或斷線的原因。The robot of the present embodiment is, for example, a robot for transporting glass substrates used in the manufacture of liquid crystal display panels and the like, and includes a large-scale robot 50, and the robot 50 has a long moving distance. Therefore, the length of the motor wiring 53, the individual power wiring 54 and the signal wiring 55 in the robot 50 is also as long as several tens of meters (m), for example. As the manipulator 50 operates and moves, the motor wiring 53, the individual power wiring 54 and the signal wiring 55 also move together with the manipulator 50. As a result, the manipulator 50 is bent or twisted or deformed and bears various stresses. This kind of stress may also cause wiring grounding, short circuit, or disconnection.

如圖2所示般,於現有的機器人中,來自編碼器電源電路12的共用電源配線21自控制器10延伸至機械手50,且對於共用電源配線21的末端而直接連接有來自各編碼器52的個別電源配線54。其結果為,當在任一軸的個別電源配線54中發生接地等故障時,編碼器電源電路12的輸出因過電流而遮斷或輸出電壓降低,而停止對全部編碼器52的電源供給。即便在各編碼器52具備檢測電源電壓中的異常的功能的情況下,亦無法根據來自編碼器52的訊號而確定在與哪一編碼器52連接的個別電源配線54中發生了故障。為了確定故障部位,而不得不藉由目視而檢查機械手50內的全部個別電源配線54。在為搬送液晶顯示面板用的玻璃基板的機器人的情形下,機械手50大型化且機械手50本身配置於無塵室(clean room)或減壓環境下,故檢查機械手50內的全部個別電源配線54並使機器人自故障修復需要大量的時間。As shown in FIG. 2, in the existing robot, the common power supply wiring 21 from the encoder power supply circuit 12 extends from the controller 10 to the manipulator 50, and the end of the common power supply wiring 21 is directly connected from each encoder 52 individual power wiring 54. As a result, when a fault such as a ground fault occurs in the individual power supply wiring 54 of any axis, the output of the encoder power supply circuit 12 is interrupted by overcurrent or the output voltage is reduced, and the power supply to all the encoders 52 is stopped. Even when each encoder 52 has a function of detecting an abnormality in the power supply voltage, it cannot be determined from the signal from the encoder 52 which encoder 52 is connected to the individual power supply wiring 54 that a failure has occurred. In order to identify the fault location, all the individual power supply wirings 54 in the manipulator 50 have to be inspected visually. In the case of a robot that transports glass substrates for liquid crystal display panels, the robot hand 50 is enlarged and the robot hand 50 itself is placed in a clean room or under a reduced pressure environment. Therefore, all individual parts in the robot hand 50 are inspected. It takes a lot of time to wire the power supply 54 and make the robot self-repair.

相對於此,於圖1所示的本實施形態的機器人中,在與各個編碼器52連接的個別電源配線54上,在自與連接於編碼器電源電路12的共用電源配線21連接的位置稍許偏靠編碼器52的位置設置開關22。所述開關22可藉由控制部14針對每一個別電源配線54即每一編碼器52個別地進行導通/關斷控制。因此,在剛接通控制器10的電源之後等的時間點,對各編碼器52依次執行將每一編碼器52的開關22個別地導通然後關斷。此時,若於編碼器接收電路13中可準確地接收來自與被導通的開關22對應的編碼器52的訊號,則可判斷為與所述編碼器52對應的個別電源配線54及訊號配線55均為正常。相對於此,在無法準確地接收來自與被導通的開關22對應的編碼器52的訊號的情形下,可判定為於與所述編碼器52對應的個別電源配線54及訊號配線55的至少一者發生接地等故障。此時,若在與對應的個別電源配線54連接的電壓檢測電路23中可準確地檢測電源電壓,則可判斷為於來自對應的編碼器52的訊號配線55產生故障。反之,若僅將一個開關22導通,且在與所述開關相鄰而設置的電壓檢測電路23中無法檢測出電源電壓,則可判斷為在與所述開關22連接的個別電源配線54中發生了接地或短路。In contrast, in the robot of the present embodiment shown in FIG. 1, the individual power wiring 54 connected to each encoder 52 is slightly connected to the common power wiring 21 connected to the encoder power supply circuit 12. The switch 22 is set biased toward the position of the encoder 52. The switch 22 can be individually turned on/off controlled by the control unit 14 for each individual power supply wiring 54, that is, each encoder 52. Therefore, at a time point immediately after the power supply of the controller 10 is turned on, the switch 22 of each encoder 52 is individually turned on and then turned off for each encoder 52 in sequence. At this time, if the encoder receiving circuit 13 can accurately receive the signal from the encoder 52 corresponding to the turned-on switch 22, it can be determined that the individual power wiring 54 and the signal wiring 55 corresponding to the encoder 52 All are normal. In contrast, when the signal from the encoder 52 corresponding to the turned-on switch 22 cannot be accurately received, it can be determined that at least one of the individual power supply wiring 54 and the signal wiring 55 corresponding to the encoder 52 Otherwise, a fault such as grounding occurs. At this time, if the voltage detection circuit 23 connected to the corresponding individual power supply wiring 54 can accurately detect the power supply voltage, it can be determined that the signal wiring 55 from the corresponding encoder 52 has a fault. Conversely, if only one switch 22 is turned on, and the power supply voltage cannot be detected in the voltage detection circuit 23 provided adjacent to the switch, it can be determined that the occurrence of the power supply is in the individual power supply wiring 54 connected to the switch 22. Ground or short circuit.

於本實施形態中,藉由控制部14逐一將開關22依次導通,而可容易地確定在與哪一編碼器52連接的配線中發生了故障,或所述發生故障的配線是個別電源配線54還是訊號配線55,即便必須藉由目視等檢查配線亦可限定檢查部位,而能夠大幅度縮短故障部位的確定或自故障修復所需的時間。In this embodiment, the control unit 14 turns on the switches 22 one by one, so that it can be easily determined which encoder 52 has a fault, or the faulty wiring is the individual power supply wiring 54. As for the signal wiring 55, even if the wiring must be inspected visually, the inspection location can be limited, and the time required to determine the fault location or repair the fault can be greatly shortened.

於本實施形態中,電壓檢測電路23可包含僅判別輸入電壓是正常還是非正常的電壓比較器電路。然而,關於電壓檢測電路23,與輸出表示好壞的二值訊號的情況相比,較佳為將所測定的電壓作為電壓值而輸出。此處所言的電壓值既可為類比值,亦可為藉由類比/數位(Analog/digital,A/D)轉換功能等而表示為多值資料的數位值。電壓檢測電路23為檢測類比值或作為多值資料的電壓值的電路,若於編碼器52亦設置有檢測所述被供給的電源電壓的電路,則可根據由電壓檢測電路23檢測出的電壓值與在編碼器52中檢測出的電壓值,求得個別電源配線54中的電壓降量。若為大型機械手50,則個別電源配線54亦長,而無法忽略藉由個別電源配線54而供給的電源電壓的電壓降。由於編碼器52中的消耗電流為已知且不會大幅度變動,故可根據個別電源配線54的電壓降量與編碼器52的消耗電流而算出個別電源配線54的配線阻抗,從而容易地進行保養或設計餘裕(margin)的確認。藉由追蹤電壓降量或配線阻抗的變化,可容易地發現配線中發生異常或異常前的徵兆。將在編碼器52中實際測定的電源電壓回饋(feedback)給控制部14,而控制部14控制編碼器電源電路12,藉此可不依賴於個別電源配線54的電壓降量而將實際供給至編碼器52的電源電壓值設為適當值。例如控制部14求得由電壓檢測電路23檢測出的電壓值與在編碼器52中檢測出的電壓值的差,將與所述差相應的電壓控制訊號輸出至編碼器電源電路12。In this embodiment, the voltage detection circuit 23 may include a voltage comparator circuit that only judges whether the input voltage is normal or abnormal. However, with regard to the voltage detection circuit 23, it is better to output the measured voltage as a voltage value than in the case of outputting a binary signal indicating good or bad. The voltage value mentioned here can be either an analog value or a digital value expressed as multi-valued data by the analog/digital (A/D) conversion function. The voltage detection circuit 23 is a circuit that detects the analog value or the voltage value as a multi-value data. If the encoder 52 is also provided with a circuit for detecting the supplied power voltage, it can be based on the voltage detected by the voltage detection circuit 23 Value and the voltage value detected in the encoder 52, the voltage drop amount in the individual power supply wiring 54 is obtained. In the case of a large manipulator 50, the individual power supply wiring 54 is also long, and the voltage drop of the power supply voltage supplied by the individual power supply wiring 54 cannot be ignored. Since the current consumption in the encoder 52 is known and does not vary significantly, the wiring impedance of the individual power supply wiring 54 can be calculated from the voltage drop of the individual power supply wiring 54 and the current consumption of the encoder 52, so that it is easy to perform Confirmation of maintenance or design margin. By tracking the amount of voltage drop or the change in wiring impedance, it is easy to find abnormalities in the wiring or the signs before the abnormality. The power supply voltage actually measured in the encoder 52 is fed back to the control unit 14, and the control unit 14 controls the encoder power supply circuit 12, so that the actual power supply voltage can be supplied to the encoder independently of the amount of voltage drop of the individual power supply wiring 54 The power supply voltage value of the device 52 is set to an appropriate value. For example, the control unit 14 obtains the difference between the voltage value detected by the voltage detection circuit 23 and the voltage value detected in the encoder 52, and outputs a voltage control signal corresponding to the difference to the encoder power supply circuit 12.

在為大型機械手50的情形下,有時根據馬達51或編碼器52為機械手50的哪一軸的馬達或編碼器,而馬達配線53、個別電源配線54及訊號配線55的長度大不相同。若個別電源配線54的長度不同,則個別電源配線54中的電壓降量亦不同,而對編碼器52實際供給的電源電壓亦不同。在個別電源配線54的電壓降量不同的情形下,在自同一個編碼器電源電路12對多個編碼器52供給電源電壓的情形下對每一編碼器52實際供給的電源電壓不同,即便如上文所述般回饋電源電壓的測定值而控制編碼器電源電路12,亦難以在全部編碼器52中進行如將實際的電源電壓設為適當值般的控制。另一方面,對應於編碼器52的數目來準備編碼器電源電路12且自編碼器電源電路12一對一地對編碼器52供給電源電壓,會使控制器10超出所需地為大規模。In the case of a large manipulator 50, the length of the motor wiring 53, individual power wiring 54 and signal wiring 55 may be quite different depending on which axis of the manipulator 50 the motor 51 or encoder 52 is. . If the length of the individual power wiring 54 is different, the amount of voltage drop in the individual power wiring 54 is also different, and the power supply voltage actually supplied to the encoder 52 is also different. In the case where the voltage drop amount of the individual power supply wiring 54 is different, the power supply voltage actually supplied to each encoder 52 is different when the power supply voltage is supplied from the same encoder power supply circuit 12 to a plurality of encoders 52. It is also difficult to control the encoder power supply circuit 12 by feeding back the measured value of the power supply voltage as described above, and it is also difficult to perform control such as setting the actual power supply voltage to an appropriate value in all the encoders 52. On the other hand, preparing the encoder power supply circuit 12 corresponding to the number of the encoders 52 and supplying the power supply voltage to the encoder 52 from the encoder power supply circuit 12 one-to-one makes the controller 10 larger than necessary.

圖3所示的本發明的另一實施形態的機器人為與圖1所示的機器人同樣的機器人,但為了減輕根據個別電源配線54的長度而實際供給至編碼器52的電源電壓不一致,而根據個別電源配線54的長度將多個編碼器52分類為幾個系統,針對每一系統而設置編碼器電源電路12、編碼器電源電路16。在圖示中設置有兩個編碼器電源電路12、16,對四個編碼器52中的、個別電源配線54的長度相對較短的兩個編碼器52,自編碼器電源電路12供給電源電壓,對於個別電源配線54的長度相對較長的兩個編碼器52自編碼器電源電路16供給電源電壓。編碼器電源電路12、編碼器電源電路16分別可藉由來自控制部14的控制而調整輸出電壓,但基本上所述編碼器電源電路的輸出電壓已加上個別電源配線54的電壓降量。藉此,無關於個別電源配線54的長度的不同,而可將各編碼器52以更接近適當值的電源電壓而驅動。下述情形與圖1所示的內容相同,即:針對每一編碼器電源電路12、編碼器電源電路16而設置有共用電源配線21;自各共用電源配線21分支有多個個別電源配線54;針對每一個別電源配線54設置有開關22與電壓檢測電路23。The robot of another embodiment of the present invention shown in FIG. 3 is the same robot as the robot shown in FIG. 1, but in order to reduce the inconsistency of the power supply voltage actually supplied to the encoder 52 depending on the length of the individual power supply wiring 54, The length of the individual power supply wiring 54 classifies the plurality of encoders 52 into several systems, and the encoder power supply circuit 12 and the encoder power supply circuit 16 are provided for each system. In the figure, two encoder power supply circuits 12 and 16 are provided. Among the four encoders 52, the two encoders 52 with relatively short lengths of individual power supply wires 54 are supplied with power supply voltage from the encoder power supply circuit 12 For the two encoders 52 with relatively long lengths of individual power supply wirings 54, the power supply voltage is supplied from the encoder power supply circuit 16. The encoder power supply circuit 12 and the encoder power supply circuit 16 can respectively adjust the output voltage under the control from the control unit 14, but basically the output voltage of the encoder power supply circuit has been added to the voltage drop of the individual power supply wiring 54. In this way, regardless of the difference in the length of the individual power supply wiring 54, each encoder 52 can be driven with a power supply voltage closer to an appropriate value. The following situation is the same as the content shown in FIG. 1, namely: a common power supply wiring 21 is provided for each encoder power supply circuit 12 and encoder power supply circuit 16; a plurality of individual power supply wirings 54 are branched from each common power supply wiring 21; A switch 22 and a voltage detection circuit 23 are provided for each individual power supply wiring 54.

於圖3所示的機器人中,可基於實際供給至各個編碼器52的電源電壓獨立地進行編碼器電源電路12、編碼器電源電路16的輸出電壓的回饋控制。儘管電壓降量不同,但於四個編碼器52中實際供給至各個編碼器52的電壓的不一致變小,而可使實際供給至所述編碼器52的電源電壓更接近適當值。In the robot shown in FIG. 3, feedback control of the output voltages of the encoder power supply circuit 12 and the encoder power supply circuit 16 can be independently performed based on the power supply voltage actually supplied to each encoder 52. Although the amount of voltage drop is different, the inconsistency of the voltage actually supplied to each encoder 52 among the four encoders 52 becomes smaller, and the power supply voltage actually supplied to the encoder 52 can be made closer to an appropriate value.

於圖1所示的機器人中是將開關22及電壓檢測電路23設置於控制器10內,但亦可將開關22及電壓檢測電路23設置於機械手50內。圖4所示的又一實施形態的機器人是於圖1所示的機器人中,將共用電源配線21延伸至機械手50,且將來自共用電源配線21的朝個別電源配線54的分支點與開關22及電壓檢測電路23設置於機械手50內,進而,設置控制開關22且自電壓檢測電路23接收檢測結果的控制部60。控制部60與設置於控制器10內的控制部14協作來進行機器人的控制。考慮到在所述配線變形的部位特別容易發生配線的故障,故為了可更確實地檢測故障,較佳的是將開關22及電壓檢測電路23在個別電源配線54上設置於較伴隨著機械手50的移動而移動的部分更接近控制器10之側。具體而言,較佳的是於機械手50內在與控制器10進行連接的部位的附近,使個別電源配線54自共用電源配線21分支且設置開關22及電壓檢測電路23。In the robot shown in FIG. 1, the switch 22 and the voltage detection circuit 23 are provided in the controller 10, but the switch 22 and the voltage detection circuit 23 may also be provided in the manipulator 50. The robot of another embodiment shown in FIG. 4 is in the robot shown in FIG. 1, the common power supply wiring 21 is extended to the manipulator 50, and the branch point from the common power supply wiring 21 toward the individual power supply wiring 54 is switched 22 and the voltage detection circuit 23 are provided in the manipulator 50, and further, a control unit 60 that controls the switch 22 and receives the detection result from the voltage detection circuit 23 is provided. The control unit 60 cooperates with the control unit 14 provided in the controller 10 to control the robot. Considering that wiring failures are particularly likely to occur at the locations where the wiring is deformed, in order to detect failures more reliably, it is preferable to install the switch 22 and the voltage detection circuit 23 on the individual power supply wiring 54 where the robot arm The part moved by the movement of 50 is closer to the side of the controller 10. Specifically, it is preferable that the individual power supply wiring 54 be branched from the common power supply wiring 21 and the switch 22 and the voltage detection circuit 23 are provided in the vicinity of the part connected to the controller 10 in the manipulator 50.

以上,對基於本發明的機器人進行了說明,但並不限於機器人來應用本發明。若為具有多個編碼器的編碼器系統,則無論為何者均可應用本發明。又,亦可對具有多個馬達的馬達系統且針對每一馬達而設置有編碼器的馬達系統應用本發明。The robot based on the present invention has been described above, but the present invention is not limited to robots. If it is an encoder system with multiple encoders, the present invention can be applied to any one. In addition, the present invention can also be applied to a motor system having a plurality of motors and an encoder provided for each motor.

10:控制器 11:驅動器電路 12、16:編碼器電源電路 13:編碼器接收電路 14、60:控制部 15:斷線檢測電路 21:共用電源配線 22:開關 23:電壓檢測電路 50:機械手 51:馬達 52:編碼器 53:馬達配線 54:個別電源配線 55:訊號配線10: Controller 11: Driver circuit 12.16: Encoder power supply circuit 13: Encoder receiving circuit 14, 60: Control Department 15: Disconnection detection circuit 21: Shared power supply wiring 22: switch 23: Voltage detection circuit 50: Manipulator 51: Motor 52: encoder 53: Motor wiring 54: Individual power supply wiring 55: Signal Wiring

圖1是表示實施本發明的一形態的機器人的框圖。 圖2是表示對編碼器供給電力的現有形態的框圖。 圖3是表示另一實施形態的機器人的框圖。 圖4是表示又一實施形態的機器人的框圖。Fig. 1 is a block diagram showing an embodiment of the robot according to the present invention. Fig. 2 is a block diagram showing a conventional mode of supplying electric power to an encoder. Fig. 3 is a block diagram showing a robot according to another embodiment. Fig. 4 is a block diagram showing a robot according to another embodiment.

10:控制器 10: Controller

11:驅動器電路 11: Driver circuit

12:編碼器電源電路 12: Encoder power supply circuit

13:編碼器接收電路 13: Encoder receiving circuit

14:控制部 14: Control Department

15:斷線檢測電路 15: Disconnection detection circuit

21:共用電源配線 21: Shared power supply wiring

22:開關 22: switch

23:電壓檢測電路 23: Voltage detection circuit

50:機械手 50: Manipulator

51:馬達 51: Motor

52:編碼器 52: encoder

53:馬達配線 53: Motor wiring

54:個別電源配線 54: Individual power supply wiring

55:訊號配線 55: Signal Wiring

Claims (10)

一種編碼器系統,具有: 多個編碼器; 編碼器電源電路,產生電源電壓; 個別電源配線,為了供給所述電源電壓而設置於每一所述編碼器,且一端連接於所述編碼器; 開關,設置於每一所述個別電源配線的另一端側,切換與所述編碼器電源電路的連接與斷開;以及 第一電壓檢測電路,設置於每一所述個別電源配線的所述另一端側的較所述開關更靠編碼器側的位置。An encoder system with: Multiple encoders; Encoder power supply circuit to generate power supply voltage; Individual power wiring is provided in each of the encoders in order to supply the power supply voltage, and one end is connected to the encoder; A switch is arranged on the other end side of each of the individual power wirings, and switches the connection and disconnection with the encoder power circuit; and The first voltage detection circuit is arranged at a position closer to the encoder side than the switch on the other end side of each of the individual power supply wires. 如請求項1所述的編碼器系統,其中所述第一電壓檢測電路輸出電壓值,且 所述編碼器包括第二電壓檢測電路,所述第二電壓檢測電路檢測被供給的電源電壓並作為電壓值輸出。The encoder system according to claim 1, wherein the first voltage detection circuit outputs a voltage value, and The encoder includes a second voltage detection circuit that detects the supplied power supply voltage and outputs it as a voltage value. 如請求項2所述的編碼器系統,具有運算機構,所述運算機構運算由所述第一電壓檢測電路檢測出的電壓值與由所述第二電壓檢測電路檢測出的電壓值的差。The encoder system according to claim 2 has an arithmetic unit that calculates the difference between the voltage value detected by the first voltage detection circuit and the voltage value detected by the second voltage detection circuit. 如請求項3所述的編碼器系統,其中所述運算機構將與所述差相應的電源控制訊號輸出至所述編碼器電源電路。The encoder system according to claim 3, wherein the arithmetic mechanism outputs a power control signal corresponding to the difference to the encoder power circuit. 如請求項1至請求項4中任一項所述的編碼器系統,所述多個編碼器根據所述個別電源配線的長度分類為多個系統,每一系統設置有所述編碼器電源電路。The encoder system according to any one of claim 1 to claim 4, wherein the plurality of encoders are classified into a plurality of systems according to the length of the individual power supply wiring, and each system is provided with the encoder power supply circuit . 一種馬達系統,包括多個馬達,且 包括如請求項1至請求項5中任一項所述的編碼器系統,每一所述馬達設置有所述編碼器系統的所述編碼器。A motor system includes a plurality of motors, and It includes the encoder system according to any one of claim 1 to claim 5, and each of the motors is provided with the encoder of the encoder system. 一種機器人,具有包括多個馬達的機械手及控制所述機械手的控制器,且 包括如請求項1至請求項5中任一項所述的編碼器系統,每一所述馬達設置有所述編碼器系統的所述編碼器。A robot having a manipulator including a plurality of motors and a controller for controlling the manipulator, and It includes the encoder system according to any one of claim 1 to claim 5, and each of the motors is provided with the encoder of the encoder system. 如請求項7所述的機器人,其中每一所述個別電源配線的所述第一電壓檢測電路與所述編碼器之間的區間,包含有所述個別電源配線伴隨著所述機械手的移動變形的區間。The robot according to claim 7, wherein the interval between the first voltage detection circuit and the encoder of each of the individual power supply wiring includes the individual power supply wiring accompanying the movement of the manipulator Deformation interval. 如請求項7所述的機器人,其中所述開關及所述第一電壓檢測電路配置於所述控制器。The robot according to claim 7, wherein the switch and the first voltage detection circuit are arranged in the controller. 如請求項7所述的機器人,其中所述開關及所述第一電壓檢測電路配置於所述機械手。The robot according to claim 7, wherein the switch and the first voltage detection circuit are arranged in the manipulator.
TW109124654A 2019-08-06 2020-07-22 Encoder system, motor system and robot TWI728874B (en)

Applications Claiming Priority (2)

Application Number Priority Date Filing Date Title
JP2019-144423 2019-08-06
JP2019144423A JP2021025896A (en) 2019-08-06 2019-08-06 Encoder system, motor system, and robot

Publications (2)

Publication Number Publication Date
TW202107858A true TW202107858A (en) 2021-02-16
TWI728874B TWI728874B (en) 2021-05-21

Family

ID=74504009

Family Applications (1)

Application Number Title Priority Date Filing Date
TW109124654A TWI728874B (en) 2019-08-06 2020-07-22 Encoder system, motor system and robot

Country Status (5)

Country Link
JP (1) JP2021025896A (en)
KR (1) KR20220027221A (en)
CN (1) CN114206564B (en)
TW (1) TWI728874B (en)
WO (1) WO2021024706A1 (en)

Families Citing this family (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN115514084B (en) * 2022-11-03 2023-03-21 广东隆崎机器人有限公司 Multi-power-supply safety module of six-axis robot and control method thereof

Family Cites Families (23)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS618302U (en) * 1984-06-20 1986-01-18 トキコ株式会社 industrial robot
JPH0647239B2 (en) * 1985-09-11 1994-06-22 フアナツク株式会社 Power supply for robot encoders
JPH02292197A (en) * 1989-04-28 1990-12-03 Mitsubishi Electric Corp Industrial robot
JPH08251817A (en) 1995-03-13 1996-09-27 Yaskawa Electric Corp Auxiliary power-supply system for encoder
JP3022656U (en) * 1995-09-13 1996-03-26 廣 小林 Positioning motor controller for bookbinding machine
JPH10203740A (en) * 1997-01-27 1998-08-04 Mitsubishi Electric Corp Abnormal time control device for elevator
JP4175377B2 (en) * 1997-10-08 2008-11-05 株式会社デンソーウェーブ Robot controller
JP2000210891A (en) * 1999-01-19 2000-08-02 Yaskawa Electric Corp Safety protective device of robot driving device
JP2001150374A (en) * 1999-11-25 2001-06-05 Sony Corp Failure diagnostic system for robot
CN101657377A (en) * 2007-02-14 2010-02-24 株式会社五合 Movement control method, movement operating device, and method for operating movement of moving body
JP2010206951A (en) * 2009-03-04 2010-09-16 Yaskawa Electric Corp Motor controller
JP2010284746A (en) * 2009-06-11 2010-12-24 Nitta Ind Corp Joint and automatic tool changer
WO2011126574A1 (en) * 2010-04-09 2011-10-13 William Howard Speegle Methods and systems for controlling devices via power lines
JP5601105B2 (en) * 2010-09-10 2014-10-08 株式会社デンソーウェーブ Robot system
JP3164700U (en) * 2010-09-30 2010-12-09 株式会社石川鉄工所 Pipe inspection device
JP2013052475A (en) * 2011-09-05 2013-03-21 Denso Wave Inc Robot system
US8854475B2 (en) * 2013-02-08 2014-10-07 Omnivision Technologies, Inc. System and method for sensor failure detection
JP5945973B2 (en) 2013-11-05 2016-07-05 株式会社安川電機 Encoder, motor with encoder, servo system, encoder signal processing method
JP2016052223A (en) * 2014-09-02 2016-04-11 ソムフィ株式会社 Motor drive device
JP6525637B2 (en) * 2015-02-26 2019-06-05 キヤノン株式会社 Robot device and control method of robot device
JP6441469B2 (en) * 2015-04-29 2018-12-19 株式会社Fuji Motor drive device
JP2017196700A (en) * 2016-04-27 2017-11-02 ライフロボティクス株式会社 Robot device and electronic apparatus
WO2019116551A1 (en) * 2017-12-15 2019-06-20 三菱電機株式会社 Motor drive system and inverter device

Also Published As

Publication number Publication date
JP2021025896A (en) 2021-02-22
WO2021024706A1 (en) 2021-02-11
CN114206564A (en) 2022-03-18
KR20220027221A (en) 2022-03-07
TWI728874B (en) 2021-05-21
CN114206564B (en) 2024-02-02

Similar Documents

Publication Publication Date Title
US6871115B2 (en) Method and apparatus for monitoring the operation of a wafer handling robot
JP4835842B2 (en) IO unit in a building block type safety controller
JP3896237B2 (en) Control system
US7208899B2 (en) Emergency-stop device
US7631204B2 (en) Power supply device having communication channels with different types of communication connections
KR101517646B1 (en) Fault situation processing arrangement of a load distribution system of a local electric power transmission network
KR100885425B1 (en) Monitoring system for point machine and methods thereof
KR101270288B1 (en) Stage device control system
TWI728874B (en) Encoder system, motor system and robot
CA3098559A1 (en) Electromagnetic valve system
US10579558B1 (en) Flexible redundant input/output (I/O) schemes for I/O channels
JP2014059800A (en) Facility control system, connector connection failure detecting method, and i/o module
JP2001157381A (en) Device for controlling and monitoring transformers
GB2277814A (en) Fault tolerant programmable logic controller
WO2020149153A1 (en) Environment control system and air conditioner or air-conditioning system
JP6856416B2 (en) Process control system
WO2015092915A1 (en) Line switching device, line switching system, and line switching method
KR200484231Y1 (en) Apparatus for detecting a connection error of Remote Terminal Unit And Supervisory Control And Data Acquisition System Including the Same
KR20200063547A (en) Apparatus for fault detection and recovery device in underground distribution lines with no effect open length
JP2014059802A (en) Facility control system and connector connection failure detecting method
JP5333838B2 (en) FA equipment
JP4236822B2 (en) Test method for automatic accident recovery equipment
KR100840613B1 (en) Aircraft Automatic Rudder Trim Control System Test Device
KR20200092048A (en) Failure prediction system of facility
JP2006003929A (en) Process controller and diagnosis method of control data of the same