TW202107858A - Encoder system, motor system and robot - Google Patents
Encoder system, motor system and robot Download PDFInfo
- 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
Links
Images
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01D—MEASURING 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/00—Mechanical 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/12—Mechanical 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/14—Mechanical 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
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J13/00—Controls for manipulators
-
- 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/02—Sensing devices
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/10—Programme-controlled manipulators characterised by positioning means for manipulator elements
- B25J9/12—Programme-controlled manipulators characterised by positioning means for manipulator elements electric
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01D—MEASURING 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/00—Mechanical 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/12—Mechanical 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/244—Mechanical 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
-
- 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
- H02P5/00—Arrangements specially adapted for regulating or controlling the speed or torque of two or more electric motors
-
- 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
- H02P6/00—Arrangements for controlling synchronous motors or other dynamo-electric motors using electronic commutation dependent on the rotor position; Electronic commutators therefor
- H02P6/14—Electronic commutators
- H02P6/16—Circuit arrangements for detecting position
-
- 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
- H02P2203/00—Indexing scheme relating to controlling arrangements characterised by the means for detecting the position of the rotor
- H02P2203/03—Determination 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
Description
本發明是有關於一種在由馬達驅動的機器人等中包含位置的檢測中所使用的編碼器的編碼器系統、包含編碼器系統的馬達系統以及機器人。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
控制器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
來自各軸的編碼器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
本實施形態的機器人例如為用以搬送製造液晶顯示面板中所使用的玻璃基板等的機器人,包括大型機械手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-
如圖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
相對於此,於圖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
於本實施形態中,藉由控制部14逐一將開關22依次導通,而可容易地確定在與哪一編碼器52連接的配線中發生了故障,或所述發生故障的配線是個別電源配線54還是訊號配線55,即便必須藉由目視等檢查配線亦可限定檢查部位,而能夠大幅度縮短故障部位的確定或自故障修復所需的時間。In this embodiment, the
於本實施形態中,電壓檢測電路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
在為大型機械手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
圖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
於圖3所示的機器人中,可基於實際供給至各個編碼器52的電源電壓獨立地進行編碼器電源電路12、編碼器電源電路16的輸出電壓的回饋控制。儘管電壓降量不同,但於四個編碼器52中實際供給至各個編碼器52的電壓的不一致變小,而可使實際供給至所述編碼器52的電源電壓更接近適當值。In the robot shown in FIG. 3, feedback control of the output voltages of the encoder
於圖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
以上,對基於本發明的機器人進行了說明,但並不限於機器人來應用本發明。若為具有多個編碼器的編碼器系統,則無論為何者均可應用本發明。又,亦可對具有多個馬達的馬達系統且針對每一馬達而設置有編碼器的馬達系統應用本發明。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:
圖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)
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)
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)
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 |
-
2019
- 2019-08-06 JP JP2019144423A patent/JP2021025896A/en active Pending
-
2020
- 2020-07-13 KR KR1020227003465A patent/KR20220027221A/en unknown
- 2020-07-13 WO PCT/JP2020/027243 patent/WO2021024706A1/en active Application Filing
- 2020-07-13 CN CN202080053666.7A patent/CN114206564B/en active Active
- 2020-07-22 TW TW109124654A patent/TWI728874B/en active
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 |