JPH0746285B2 - Servo controller - Google Patents
Servo controllerInfo
- Publication number
- JPH0746285B2 JPH0746285B2 JP61195967A JP19596786A JPH0746285B2 JP H0746285 B2 JPH0746285 B2 JP H0746285B2 JP 61195967 A JP61195967 A JP 61195967A JP 19596786 A JP19596786 A JP 19596786A JP H0746285 B2 JPH0746285 B2 JP H0746285B2
- Authority
- JP
- Japan
- Prior art keywords
- gate circuit
- gate
- output
- circuit
- input
- 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.)
- Expired - Lifetime
Links
Landscapes
- Numerical Control (AREA)
- Manipulator (AREA)
Description
【発明の詳細な説明】 ［産業上の利用分野］ この発明は、多関節ロボツトなどにおける可動部の動作
範囲を制御するサーボ制御装置に関するものである。BACKGROUND OF THE INVENTION 1. Field of the Invention The present invention relates to a servo control device for controlling an operation range of a movable part in an articulated robot or the like.
［従来の技術］ 第３図は従来の一般的な多関節ロボツトの一例を示す。
図において、（１）はベース（２）と、このベース
（２）に立設されたポール（３）とからなる基台、
（４）は上記ポール（３）の先端部に設定されて水平周
りに旋回する旋回本体、（５）はこの旋回本体（４）に
支持されて垂直面内で旋回するアームで、このアーム
（５）は上記上アーム（６）と下アーム（７）とで構成
されている。[Prior Art] FIG. 3 shows an example of a conventional general articulated robot.
In the figure, (1) is a base consisting of a base (2) and a pole (3) erected on the base (2),
(4) is a swivel body that is set at the tip of the pole (3) and swivels horizontally, and (5) is an arm that is supported by the swivel body (4) and swivels in a vertical plane. 5) is composed of the upper arm (6) and the lower arm (7).
（８）は上アーム（６）の先端部に支持されてヘツド
（９）をユニバーサルに移動させるユニバーサルジヨイ
ント部で、このユニバーサルジヨイント部（８）は上記
上アーム（６）の軸線周りに旋回する第１のユニバーサ
ルジヨイント部（8A）と、この第１ユニバーサルジヨイ
ント部（8A）の軸線を通る平面内で旋回する第２のユニ
バーサルジヨイント部（8B）と、この第２のユニバーサ
ルジヨイント部（8B）の旋回軸に直交する軸周りに旋回
するフランジ部（8C）とから構成されている。(8) is a universal joint that is supported by the tip of the upper arm (6) and moves the head (9) universally. The universal joint (8) is arranged around the axis of the upper arm (6). The first universal joint part (8A) that swivels, the second universal joint part (8B) that swivels in a plane passing through the axis of the first universal joint part (8A), and the second universal part. It is composed of a flange portion (8C) that pivots around an axis orthogonal to the pivot axis of the joint portion (8B).
上記ユニバーサルジヨイント部（８）によつて、ヘツド
（９）はアーム（５）の先端部でユニバーサルに駆動さ
れる。そして、上記ヘツド（９）がチヤツクである場合
には、このチヤツクによつて被加工材を所定位置に移動
させることができる。The head (9) is universally driven by the tip of the arm (5) by the universal joint part (8). If the head (9) is a chuck, the chuck can move the work piece to a predetermined position.
このように、上記可動部（10）は、旋回本体（４）、ア
ーム（５）、ユニバーサルジヨイント部（８）から構成
されているが、以下、説明を簡略化するために、便宜上
たとえば上アーム（６）と下アーム（７）との間の可動
部材関係のように、１対の可動部材（11）と（11A）に
つき第４図を参照して説明する。As described above, the movable part (10) is composed of the swivel body (4), the arm (5), and the universal joint part (8). A pair of movable members (11) and (11A) will be described with reference to FIG. 4 like the movable member relationship between the arm (6) and the lower arm (7).
第４図において、一方の可動部材（11）は回転軸体（1
3）を介して他方の可動部材（11A）に対して旋回可能に
結合され、この回転軸体（13）はサーボモータ（15）と
減速機（16）からなる駆動装置（14）で回転駆動され
る。In FIG. 4, one movable member (11) is a rotary shaft (1
It is rotatably connected to the other movable member (11A) via 3), and this rotary shaft body (13) is rotationally driven by a drive device (14) composed of a servomotor (15) and a speed reducer (16). To be done.
上記回転軸体（13）には、１対のホルダ（17）、（18）
が固定され、一方のホルダ（17）には第５図に示すよう
に１対の可動ストツパ（19A），（19B）が固定され、他
方のホルダ（18）には１対の検出片（20A）、（20B）が
固定されている。一方の可動ストツパ（19A）は反時計
周りに旋回したとき、その端面（19a）が可動部材（1
1）に固定された固定ストツパ（21）の一端面（21a）に
当接し、他方の可動ストツパ（19B）は時計周りに旋回
したとき、その端面（19b）が固定ストツパ（21）の他
端面（21b）に当接して、可動部材（11）の旋回が停止
する。The rotating shaft body (13) has a pair of holders (17) and (18).
Is fixed, one pair of movable stoppers (19A), (19B) is fixed to one holder (17) as shown in FIG. 5, and one pair of detection pieces (20A) is fixed to the other holder (18). ), (20B) are fixed. When one of the movable stoppers (19A) turns counterclockwise, the end surface (19a) of the movable stopper (19A) moves toward the movable member (1A).
When contacting one end surface (21a) of the fixed stopper (21) fixed to 1) and turning the other movable stopper (19B) clockwise, the end surface (19b) of the movable stopper (19B) is the other end surface of the fixed stopper (21). The movable member (11) stops turning by coming into contact with (21b).
ホルダ（18）に固定された一方の検出片（20A）は反時
計周りに旋回したとき、その端面（20a）が可動部材（1
1A）に固定された一方の動作制限検出器（25）であるマ
イクロスイツチのアクチユエータ（25a）に当接し、他
方の検出片（20B）は時計周りに旋回したとき、その端
面（20b）が他方の動作制限検出器（26）であるマイク
ロスイツチのアクチユエータ（26a）に当接し、それぞ
れ検出信号を出力する。When one of the detection pieces (20A) fixed to the holder (18) is rotated counterclockwise, the end surface (20a) of the detection piece (20A) is movable (1).
1A) is in contact with the actuator (25a) of the micro switch, which is one of the motion limit detectors (25), and the other detection piece (20B) turns clockwise when its end face (20b) is the other. The actuators (26a) of the microswitches, which are the operation limit detectors (26) of (1), come into contact with the actuators (26a) and output detection signals.
第６図は可動部材（11）の駆動制御系を示す。図におい
て、（27）はマイクロコンピユータで、このマイクロコ
ンピユータ（27）はマイクロプロセツサ（28）、ROM（2
9）、RAM（30）、入力部（31）、出力部（32）からな
り、入力部（31）には動作制限検出器（25）、（26）が
接続され、他の可動部材（11A）〜（11N）の動作範囲の
各検出器（25A），（26A），…（25N），（26N）も上記
入力部（31）に接続されている。FIG. 6 shows a drive control system for the movable member (11). In the figure, (27) is a micro computer, and this micro computer (27) is a microprocessor (28), a ROM (2
9), a RAM (30), an input section (31), and an output section (32). The operation restriction detectors (25) and (26) are connected to the input section (31) and other movable members (11A). Each detector (25A), (26A), ... (25N), (26N) in the operating range from) to (11N) is also connected to the input section (31).
上記マイクロコンピユータ（27）の出力部（32）には切
替回路（36）が接続されている。すなわち、マイクロコ
ンピユータ（27）の出力部（32）にはフリツプフロツプ
回路（37）の入力端子（Ｃ）が接続されており、このフ
リツプフロツプ回路（37）のセツト出力端子（Ｑ）がア
ンドゲート回路（38）の一方の入力端子に接続されてい
る。A switching circuit (36) is connected to the output section (32) of the microcomputer (27). That is, the input terminal (C) of the flip-flop circuit (37) is connected to the output section (32) of the microcomputer (27), and the set output terminal (Q) of this flip-flop circuit (37) is an AND gate circuit (Q). 38) Connected to one of the input terminals.
また、上記可動部材（11），（11A）〜（11N）の動作範
囲の上下限位置を検出して、その上下限位置をマイクロ
コンピユータ（27）の入力部（31）に印加する動作制限
検出器（25），（26），（25A），（26A），…（25
N），（26N）は、オアゲート回路（39）を介してアンド
ゲート回路（38）の他方の入力端子に接続され、このゲ
ート回路（38）の出力端子が駆動制御回路（35）に接続
されており、他の可動部材（11A）〜（11N）の駆動装置
（14A）〜（14N）であるサーボモータ（15A）〜（15N）
および減速機（16A）〜（16N）を駆動制御する駆動制御
回路（35A）〜（35N）も接続されている。（特開昭60−
6375号参照） つぎに、上記構成の作動について説明する。Also, the operation limit detection for detecting the upper and lower limit positions of the movable members (11), (11A) to (11N) and applying the upper and lower limit positions to the input section (31) of the microcomputer (27). Containers (25), (26), (25A), (26A),… (25
N) and (26N) are connected to the other input terminal of the AND gate circuit (38) through the OR gate circuit (39), and the output terminal of this gate circuit (38) is connected to the drive control circuit (35). And servomotors (15A) to (15N) that are drive devices (14A) to (14N) for the other movable members (11A) to (11N).
And drive control circuits (35A) to (35N) for controlling the drive of the speed reducers (16A) to (16N) are also connected. (JP-A-60-
Next, the operation of the above configuration will be described.
動作制限検出器（25）からの検出信号がマイクロコンピ
ユータ（27）の入力部（31）に印加されると、このマイ
クロコンピユータ（27）が可動部材（11）の動作原点位
置を求め、この動作原点位置を基準にして所定のプログ
ラミングにしたがつて出力部（32）から駆動制御回路
（35）に指令信号が印加され、サーボモータ（15）およ
び減速機（16）を回転駆動させて、可動部材（11）を回
転軸の周りに時計方向へ旋回運動させる。When the detection signal from the motion limit detector (25) is applied to the input part (31) of the microcomputer (27), the microcomputer (27) determines the motion origin position of the movable member (11), and this motion A command signal is applied from the output section (32) to the drive control circuit (35) according to the predetermined programming based on the origin position, and the servo motor (15) and reduction gear (16) are rotationally driven to move. The member (11) is swiveled clockwise about the axis of rotation.
その後、この可動部材（11）は動作制限検出器（25）の
オン動作位置の手前を下限位置として、第５図に示すよ
うに、上限位置までの動作範囲L1内で旋回駆動される。Thereafter, the movable member (11) is driven to rotate within the operation range L1 up to the upper limit position, as shown in FIG. 5, with the lower limit position being before the ON operation position of the operation limit detector (25).
このように、通常の駆動においては、可動部材（11）の
動作範囲L1における上下限位置はマイクロコンピユータ
（27）によつて駆動制御されるから、動作制限検出器
（25），（26）が検出片（20A），（20B）による当接を
受けて検出信号を発生することはない。したがつて、こ
れら動作制限検出器（25），（26）が故障しにくい。As described above, in normal driving, the upper and lower limit positions in the operation range L1 of the movable member (11) are drive-controlled by the microcomputer (27), so that the operation limit detectors (25) and (26) are No detection signal is generated upon contact with the detection pieces (20A) and (20B). Therefore, the operation limit detectors (25) and (26) are less likely to fail.
他方、動作制限検出器（25）からの検出信号がマイクロ
コンピユータ（27）の入力部（31）に印加され、このマ
イクロコンピユータ（27）が可動部材（11）の動作原点
位置を求め、この動作原点位置を基準にして所定のプロ
グラミングにしたがつて出力部（32）から駆動制御回路
（35）に指令信号が印加される。On the other hand, the detection signal from the motion limit detector (25) is applied to the input part (31) of the micro computer (27), and this micro computer (27) obtains the motion origin position of the movable member (11) to perform this motion. A command signal is applied from the output section (32) to the drive control circuit (35) according to predetermined programming based on the origin position.
これと同時に、フリツプフロツプ回路（37）がセツトさ
れて、アンドゲート回路（38）のゲートを開放するか
ら、ヘツド（９）に保持された被加工物の重量変化など
により、可動部材（11）の質量が急激に増大するなどの
理由により、可動部材（11）が動作範囲L1を越えて、検
出片（20A），（20B）が動作制限検出器（25），（26）
であるマイクロスイツチのアクチユエータ（25a），（2
6a）に当接したとき、その動作制限検出器（25），（2
6）がその検出信号を発生し、この検出信号をオアゲー
ト回路（39）およびアンドゲート回路（38）より駆動制
御回路（35）に可動部材（11）の駆動停止指令信号を印
加し、サーボモータ（15）を急速停止させて可動部材
（11）の破損を防止する。At the same time, since the flip-flop circuit (37) is set to open the gate of the AND gate circuit (38), the weight of the workpiece held in the head (9) changes and the like causes the movable member (11) to move. Due to a sudden increase in mass, the movable member (11) exceeds the operating range L1, and the detection pieces (20A) and (20B) move to the operation limit detectors (25) and (26).
Micro switch actuators (25a), (2
6a), the motion limit detectors (25), (2
6) generates the detection signal, and the detection signal is applied from the OR gate circuit (39) and the AND gate circuit (38) to the drive control circuit (35) to drive the movable member (11). (15) is stopped rapidly to prevent damage to the movable member (11).
このように第１段の動作範囲L1はマイクロコンピユータ
（27）によつて駆動制御されるけれども、可動部材（1
1）の動作中に、万一このマイクロコンピユータ（27）
が暴走や故障といつた事故が発生した場合、第２段の動
作範囲L2は、動作制限検出器（25），（26）からの検出
信号により、各ゲート回路（39），（38）を介して直接
に駆動制御回路（35）に印加することによつて制御すれ
ばよいから、第３段の動作範囲L3まで可動部材（11）が
移動し、可動ストツパ（19A），（19B）が固定ストツパ
（21）に直接衝突して重大な事故を招来するおそれがな
い。As described above, although the operation range L1 of the first stage is driven and controlled by the microcomputer (27), the movable member (1
In the unlikely event that 1) is operating, this microcomputer (27)
When an accident such as a runaway or a failure occurs, the operating range L2 of the second stage is controlled by the detection signals from the operation limit detectors (25) and (26) to activate the gate circuits (39) and (38). Since it can be controlled by directly applying it to the drive control circuit (35) through the movable member (11) to the operating range L3 of the third stage, the movable stoppers (19A) and (19B) are moved. There is no risk of causing a serious accident by directly colliding with the fixed stopper (21).
また、動作原点位置検出器を動作制限検出器（25）に兼
用させたから、その部品点数が減少するばかりでなく、
通常の動作範囲であるところの第１段の動作範囲L1をそ
の部品点数の減少した間隔だけ長くすることができる。Also, since the operation origin position detector is also used as the operation limit detector (25), not only the number of parts is reduced, but also
The operating range L1 of the first stage, which is the normal operating range, can be lengthened by the interval in which the number of parts is reduced.
したがつて、この動作範囲L1を長くしても、可動部材
（11）が大型化して質量の増大を招くことがなく、この
可動部材（11）の移動に際して、これに働らく慣性力が
増大せず、マイクロコンピユータ（27）からの作業指令
信号に対するヘツド（９）の移動速度や停止速度が低下
するのを防止できる。Therefore, even if the operating range L1 is lengthened, the movable member (11) does not increase in size and the mass does not increase, and when the movable member (11) moves, the inertial force acting on the movable member (11) increases. Without this, it is possible to prevent the moving speed and the stopping speed of the head (9) from decreasing with respect to the work command signal from the microcomputer (27).
上記のことは、他の可動部材（11A）〜（11N）の動作範
囲の上下限位置を動作制限検出器（25A），（26A）〜
（25N），（26N）で検出して、その上下限位置をマイク
ロコンピユータ（27）の入力部（31）に印加し、オアゲ
ート回路（39）およびアンドゲート回路（38）を介し
て、他の可動部材（11A）〜（11N）の駆動制御回路（35
A）〜（35N）を制御する場合についても同様である。The above means that the upper and lower limit positions of the operating ranges of the other movable members (11A) to (11N) are set to the operation limit detectors (25A) and (26A).
(25N) and (26N), and the upper and lower limit positions are applied to the input section (31) of the microcomputer (27), and are passed through the OR gate circuit (39) and AND gate circuit (38). Drive control circuit (35) for movable members (11A) to (11N)
The same applies to the case of controlling A) to (35N).
［発明が解決しようとする問題点］ 上記構成において、可動部材（11），（11A）〜（11N）
の設定数、つまり動作軸数と、上記各可動部材の動作原
点位置およびその動作範囲の上下限位置を検出する動作
制限検出器（25），（26）〜（25N），（26N）の数が一
致しない場合、第７図に示す切換スイツチ（40）を開閉
して、各検出器（25），（26）〜（25N），（26N）と駆
動制御回路（35）〜（35N）との接続を新らたに設定し
なおさなければならず、上記スイツチ（40）の切り換え
がきわめて面倒である欠点があつた。[Problems to be Solved by the Invention] In the above configuration, the movable members (11), (11A) to (11N)
, The number of movement axes, and the number of movement limit detectors (25), (26) to (25N), (26N) that detect the movement origin position of each movable member and the upper and lower limit positions of its movement range. If they do not match, the switching switch (40) shown in FIG. 7 is opened and closed to connect the detectors (25), (26) to (25N), (26N) and the drive control circuits (35) to (35N). There was a drawback that the connection of the switch had to be newly set again, and switching of the switch (40) was extremely troublesome.
この発明は上記欠点を改善するためになされたもので、
動作軸数と、動作制限検出器の数が一致しない場合で
も、両者の自動的な接続を適確に達成して安全性の高い
サーボ制御装置を提供することを目的とする。The present invention has been made to remedy the above drawbacks.
An object of the present invention is to provide a highly safe servo control device by appropriately achieving automatic connection between both even when the number of operation axes and the number of operation limit detectors do not match.
［問題点を解決するための手段］ 複数の可動部材を有するロボットのそれぞれの上記可動
部材に対応して設けられたサーボモータを介して複数の
可動部材の旋回制御を行うサーボ制御装置において、上
記可動部材の旋回の動作範囲の上下限値を検出する２つ
の動作制限検出器からの検出信号の論理和をとるための
オアゲート回路を複数有する複合オアゲート回路と、上
記オアゲート回路の数と同じビット数を有するシフトレ
ジスタと、上記オアゲート回路の出力および上記シフト
レジスタの所定ビットの出力信号の論理積を出力するア
ンドゲート回路をそれぞれの上記オアゲート回路毎に有
する複合アンドゲート回路と、この複合アンドゲート回
路のそれぞれの出力の論理和を出力する多入力オアゲー
ト回路と、それぞれの上記サーボモータの駆動電流を所
定の制御信号にもとづき供給するとともに、この駆動電
流の供給が上記多入力オアゲート回路の論理和出力にも
とづき阻止される複合駆動制御回路と、通常の駆動に先
立ち上記動作制限検出器からの上記検出信号にもとづき
それぞれの上記各可動部材の旋回の動作原点位置を算出
するとともに、上記検出信号が伝えられた上記オアゲー
ト回路の出力信号が入力される上記アンドゲート回路を
開くように上記シフトレジスタの内容を設定するマイク
ロコンピュータと、を備えたことを特徴とする。[Means for Solving the Problems] In a servo control device for performing turning control of a plurality of movable members via a servo motor provided corresponding to each of the movable members of a robot having a plurality of movable members, A composite OR gate circuit having a plurality of OR gate circuits for obtaining a logical sum of detection signals from two operation limit detectors for detecting the upper and lower limit values of the operation range of the movable member, and the same bit number as the number of the OR gate circuits. And a composite AND gate circuit having an AND gate circuit for outputting the logical product of the output of the OR gate circuit and the output signal of a predetermined bit of the shift register for each OR gate circuit, and the composite AND gate circuit Multi-input OR gate circuit that outputs the logical sum of the respective outputs of the Drive current is supplied based on a predetermined control signal, and the supply of this drive current is blocked based on the logical sum output of the multi-input OR gate circuit, and the operation limit detector prior to normal driving. Based on the detection signal from, the operation origin position of the turning of each of the movable members is calculated, and the AND gate circuit to which the output signal of the OR gate circuit to which the detection signal is transmitted is input is opened. And a microcomputer for setting the contents of the shift register.
この発明によれば、通常の駆動に先立ち、可動部材の旋
回の動作範囲の上下限値を検出する動作制限検出器のい
ずれか一方からの検出信号を受けたマイクロコンピュー
タは、各可動部材の旋回の動作原点位置を演算して検出
する。このようにして、各可動部材の旋回の動作原点位
置の検出に供した検出信号はシフトレジスタに記憶され
るとともに、この検出信号が入力されるアンドゲート回
路をシフトレジスタの記憶内容により開き、その後の通
常駆動時に検出信号がこのアンドゲート回路に入力され
ると、この検出信号が上記アンドゲート回路を介して駆
動制御回路に印加され、各可動部材の駆動装置による各
可動部材の駆動を停止させることになる。According to the present invention, prior to the normal driving, the microcomputer that receives the detection signal from either one of the motion limit detectors that detect the upper and lower limit values of the movable range of the rotation of the movable member is rotated by the microcomputer. Operation origin position is calculated and detected. In this way, the detection signal used to detect the origin position of the turning motion of each movable member is stored in the shift register, and the AND gate circuit to which this detection signal is input is opened by the stored contents of the shift register. When a detection signal is input to the AND gate circuit during the normal driving of, the detection signal is applied to the drive control circuit via the AND gate circuit to stop the drive of each movable member by the drive device for each movable member. It will be.
このように、上記検出器からの検出信号は記憶回路に記
憶されているから、動作軸数と、動作制限検出器の数が
一致しない場合でも、これら両者の接続がゲート回路を
介して自動的に達成されるとともに、各可動部材の駆動
を確実に停止させて、その安全性を高めることができ
る。In this way, the detection signal from the detector is stored in the memory circuit, so even if the number of operating axes does not match the number of operation limiting detectors, the connection between these two is automatically performed via the gate circuit. In addition, it is possible to surely stop the driving of each movable member and improve the safety thereof.
［発明の実施例］ 以下、この発明の実施例を図面にしたがつて説明する。
第１図はこの発明の一実施例によるサーボ制御装置にお
ける可動部材の駆動制御系を示す。なお、以下の説明に
おいて、第６図と同一個所には同一符号を付して、その
詳しい説明を省略する。Embodiments of the Invention Hereinafter, embodiments of the present invention will be described with reference to the drawings.
FIG. 1 shows a drive control system of a movable member in a servo controller according to an embodiment of the present invention. In the following description, the same parts as those in FIG. 6 are designated by the same reference numerals, and detailed description thereof will be omitted.
第１図において、（41）は切換回路で、この切換回路
（41）はマイクロコンピユータ（27）の出力部（32）に
接続されている。すなわち、上記出力部（32）は記憶回
路、たとえばシフトレジスタ（42）の入力端子（Ｃ）に
接続されており、このシフトレジスタ（42）の各出力端
子（Q0）〜（Qn）がアンドゲート回路（43），（43A）
〜（43N）の一方の入力端子に接続されている。（Ｒ）
はシフトレジスタ（42）のリセツト端子である。In FIG. 1, (41) is a switching circuit, and this switching circuit (41) is connected to the output section (32) of the microcomputer (27). That is, the output section (32) is connected to a storage circuit, for example, the input terminal (C) of the shift register (42), and the output terminals (Q 0 ) to (Q n ) of the shift register (42) are connected to each other. AND gate circuit (43), (43A)
~ (43N) connected to one input terminal. (R)
Is a reset terminal of the shift register (42).
また、可動部材（11），（11A）〜（11N）の動作範囲の
上下限位置を検出する動作制限検出器（25），（26）お
よび（25A），（26A）〜（25N），（26N）は、対応する
各オアゲート回路（44），（44A）〜（44N）を介して、
上記各アンドゲート回路（43），（43A）〜（43N）の他
方の入力端子に接続されている。さらに、上記各アンド
ゲート回路（43），（43A）〜（43N）の出力端子は、多
入力オアゲート回路、たとえばオアゲート回路（45）を
介して駆動制御回路（35），（35A）〜（35N）に接続さ
れている。Further, the motion limit detectors (25), (26) and (25A), (26A) to (25N), (which detect the upper and lower limit positions of the movable members (11), (11A) to (11N) in the operating range. 26N) through the corresponding OR gate circuits (44), (44A) to (44N),
It is connected to the other input terminal of each of the AND gate circuits (43), (43A) to (43N). Further, the output terminals of the AND gate circuits (43), (43A) to (43N) have drive control circuits (35), (35A) to (35N) via a multi-input OR gate circuit, for example, an OR gate circuit (45). )It is connected to the.
なお、アンドゲート回路（43），（43A）〜（43N）を総
称して複合アンドゲート回路、オアゲート回路（44），
（44A）〜（44N）を総称して複合オアゲート回路、駆動
制御回路（35），（35A）〜（35N）を総称して複合駆動
制御回路と称する。The AND gate circuits (43), (43A) to (43N) are collectively referred to as a composite AND gate circuit, an OR gate circuit (44),
(44A) to (44N) are collectively referred to as a composite OR gate circuit, and drive control circuits (35) and (35A) to (35N) are collectively referred to as a composite drive control circuit.
つぎに、上記構成の作動について説明する。Next, the operation of the above configuration will be described.
動作制限検出器（25）からの検出信号ａが第２図（ａ）
に示すように出力されてマイクロコンピユータ（27）の
入力部（31）に印加されると、このマイクロコンピユー
タ（27）が可動部材（11）の動作原点位置を求める。同
様にして、他の検出器（25A）〜（25N）からの検出信号
b,cが第２図（ｂ），（ｃ）に示すように出力され、マ
イクロコンピユータ（27）の入力部（31）に印加され
て、他の可動部材（11A）〜（11N）の動作原点位置を求
める。The detection signal a from the motion limit detector (25) is shown in Fig. 2 (a).
When it is output as shown in (1) and applied to the input section (31) of the micro computer (27), the micro computer (27) obtains the operation origin position of the movable member (11). Similarly, detection signals from other detectors (25A) to (25N)
b and c are output as shown in FIGS. 2 (b) and 2 (c) and applied to the input section (31) of the microcomputer (27) to operate the other movable members (11A) to (11N). Find the origin position.
以下、説明を簡略化するために、動作軸数が２軸、つま
り可動部材（11），（11A）のみが設定されている場合
において、これら２軸の駆動制御について説明する。Hereinafter, in order to simplify the description, drive control of these two axes will be described when the number of operating axes is two, that is, when only the movable members (11) and (11A) are set.
上記各可動部材（11），（11A）の動作原点位置を求め
たのち、マイクロコンピユータ（27）の出力部（32）か
ら出力信号ｄが、第２図（ｄ）で示すように生起され
る。すなわち、上記出力信号ｄは各検出器（25），（25
A）からの検出信号a1,b1に対応する信号d1,d2からな
る。After obtaining the operation origin positions of the movable members (11) and (11A), an output signal d is generated from the output section (32) of the microcomputer (27) as shown in FIG. 2 (d). . That is, the output signal d is output to each detector (25), (25
A) consists of signals d1 and d2 corresponding to detection signals a1 and b1.
上記各出力信号d1,d2はシフトレジスタ（42）に記憶さ
れ、このシフトレジスタ（42）の各出力端子（Q0），
（Q1）には出力信号e,fが第２図（ｅ），（ｆ）で示す
ように生起され、アンドゲート回路（43），（43A）の
一方の入力端子に印加されて、このアンドゲート回路
（43），（43A）のゲートを開き、このサーボ制御装置
を監視状態に保持している。The output signals d1 and d2 are stored in the shift register (42), and the output terminals (Q 0 ) of the shift register (42),
Output signals e and f are generated at (Q1) as shown in FIGS. 2 (e) and (f), and are applied to one input terminal of AND gate circuits (43) and (43A) to generate the AND signal. The gates of the gate circuits (43) and (43A) are opened to keep this servo control device in the monitoring state.
この監視状態において、第２図（ａ），（ｂ）で示すよ
うに、検出器（25）もしくは（25A）から検出信号a2,b2
が生起された場合、各オアゲート回路（44），（44A）
を介して、アンドゲート回路（43）もしくは（43A）の
他方の入力端子に印加し、上記検出信号a2,b2に対応す
る出力信号g1,g2をオアゲート回路（45）より駆動制御
回路（35），（35A）に印加する。In this monitoring state, as shown in FIGS. 2 (a) and 2 (b), the detection signals a2 and b2 from the detector (25) or (25A) are detected.
Or is generated, each OR gate circuit (44), (44A)
Is applied to the other input terminal of the AND gate circuit (43) or (43A), and output signals g1 and g2 corresponding to the detection signals a2 and b2 are supplied from the OR gate circuit (45) to the drive control circuit (35). , (35A).
すなわち、上記出力信号g1,g2は可動部材（11），（11
A）の駆動停止指令信号となつて、サーボモータ（15）
を急速停止させ、可動部材（11），（11A）の破損を有
効に防止する。That is, the output signals g1 and g2 are transmitted to the movable members (11) and (11
Servo motor (15) as the drive stop command signal of A)
To stop the movable members (11) and (11A) effectively.
また、可動部材（11），（11A）の動作中に、万一この
マイクロコンピユータ（27）が暴走した場合、その出力
部（32）から出力信号d3が、第２図（ｄ）で示すように
生起されるけれども、シフトレジスタ（42）の記憶状態
に変動がないから、アンドゲート回路（43），（43A）
のゲートは開放されたままであり、このサーボ制御装置
の監視状態を保持している。If the microcomputer (27) runs away while the movable members (11) and (11A) are operating, the output signal d3 from the output section (32) of the microcomputer (27) is as shown in FIG. 2 (d). However, since the storage state of the shift register (42) does not change, the AND gate circuits (43), (43A)
The gate remains open and holds the monitoring state of this servo control device.
したがつて、上記コンピユータ（27）の暴走で、第１段
の動作範囲L1を越えて第２段の動作範囲L2に突入する
と、動作制限検出器（25），（26）または（25A），（2
6A）からの検出信号によつて、上記と同様の制御動作で
可動部材（11），（11A）に対するサーボモータ（1
5），（15A）の急速停止制御を達成することができる。Therefore, when the above-mentioned computer (27) runs out of control and enters the operating range L2 of the second stage beyond the operating range L1 of the first stage, the operating limit detectors (25), (26) or (25A), (2
6A), the servo motor (1) for the movable members (11), (11A) is controlled by the same control operation as above.
5), (15A) quick stop control can be achieved.
このように、上記検出器（25），（25A）からの検出信
号はシフトレジスタ（42）に記憶されているから、動作
軸数が２軸であるのに対して、動作制限検出器の数が２
以上の複数個であつて、これら両者の数が一致しない場
合でも、これら両者の接続がゲート回路（43），（43
A）を介して自動的に達成されるとともに、各可動部材
（11），（11A）の駆動を確実に停止させて、その安全
性を高めることができる。As described above, since the detection signals from the detectors (25) and (25A) are stored in the shift register (42), the number of operation axes is two, while the number of operation limit detectors is two. Is 2
Even if the numbers of the above two or more do not match, the connection between the two is not limited to the gate circuits (43), (43).
A) is automatically achieved, and the driving of each movable member (11), (11A) can be reliably stopped to enhance the safety.
［発明の効果］ 以上説明したように、この発明によれば、マイクロコン
ピユータが各可動部材の動作原点位置を動作制限検出器
からの検出信号で検出したのち、上記各検出器からの検
出信号は記憶回路に記憶されているから、可動部材の設
定数、つまりは、動作軸数と、動作制限検出器の数とが
一致しない場合でも、新たに接続を設定し直すといった
面倒を要することなく、通常の駆動に先立つ動作制限検
出器からの検出信号にもとづき動作異常を正しく検出す
るように自動的に内部設定がなされ、各可動部材の駆動
停止を確実に達成することができ、所期のサーボ制御動
作の安全性を確保することができるという効果を奏す
る。[Effects of the Invention] As described above, according to the present invention, after the micro computer detects the operation origin position of each movable member by the detection signal from the operation limit detector, the detection signal from each detector is Since it is stored in the memory circuit, even if the set number of movable members, that is, the number of operation axes and the number of operation limit detectors do not match, without the trouble of newly setting the connection, The internal setting is automatically made based on the detection signal from the motion limit detector prior to normal driving to automatically detect abnormal operation, and it is possible to reliably stop the driving of each movable member. It is possible to ensure the safety of the control operation.
【図面の簡単な説明】 第１図はこの発明の一実施例によるサーボ制御装置にお
ける可動部材の駆動制御系を示すブロツク図、第２図は
第１図の動作を説明するためのタイムチヤート、第３図
はサーボ制御装置の一例を多関節ロボツトについて示す
斜視図、第４図は可動部材における駆動制御装置の側面
図、第５図は同駆動制御装置の要部の平面図、第６図は
従来のサーボ制御装置の可動部における駆動制御系を示
すブロツク図、第７図は従来のサーボ制御装置の可動部
における駆動制御系の他の例を示すブロツク図である。 （11）〜（11N）…可動部材、（14）…駆動装置、（2
5），（26）〜（25N），（26N）…動作制限検出器、（2
7）…マイクロコンピユータ、（35）〜（35N）…駆動制
御回路、（42）…記憶回路、（43）〜（43N）…アンド
ゲート回路。 なお、図中、同一符号は同一または相当部分をす。BRIEF DESCRIPTION OF THE DRAWINGS FIG. 1 is a block diagram showing a drive control system of a movable member in a servo controller according to an embodiment of the present invention, and FIG. 2 is a time chart for explaining the operation of FIG. FIG. 3 is a perspective view showing an example of a servo control device for an articulated robot, FIG. 4 is a side view of a drive control device for a movable member, FIG. 5 is a plan view of a main part of the drive control device, and FIG. Is a block diagram showing a drive control system in a movable part of a conventional servo controller, and FIG. 7 is a block diagram showing another example of a drive control system in a movable part of a conventional servo controller. (11) to (11N) ... Movable member, (14) ... Drive device, (2
5), (26) to (25N), (26N) ... Motion limit detector, (2
7) Microcomputer, (35) to (35N) ... Drive control circuit, (42) ... Memory circuit, (43) to (43N) ... AND gate circuit. In the drawings, the same reference numerals indicate the same or corresponding parts.
Claims (1)
れの上記可動部材に対応して設けられたサーボモータを
介して複数の可動部材の旋回制御を行うサーボ制御装置
において、上記可動部材の旋回の動作範囲の上下限値を
検出する２つの動作制限検出器からの検出信号の論理和
をとるためのオアゲート回路を複数有する複合オアゲー
ト回路と、上記オアゲート回路の数と同じビット数を有
するシフトレジスタと、上記オアゲート回路の出力およ
び上記シフトレジスタの所定ビットの出力信号の論理積
を出力するアンドゲート回路をそれぞれの上記オアゲー
ト回路毎に有する複合アンドゲート回路と、この複合ア
ンドゲート回路のそれぞれの出力の論理和を出力する多
入力オアゲート回路と、それぞれの上記サーボモータの
駆動電流を所定の制御信号にもとづき供給するととも
に、この駆動電流の供給が上記多入力オアゲート回路の
論理和出力にもとづき阻止される複合駆動制御回路と、
通常の駆動に先立ち上記動作制限検出器からの上記検出
信号にもとづきそれぞれの上記各可動部材の旋回の動作
原点位置を算出するとともに、上記検出信号が伝えられ
た上記オアゲート回路の出力信号が入力される上記アン
ドゲート回路を開くように上記シフトレジスタの内容を
設定するマイクロコンピュータと、を備えたことを特徴
とするサーボ制御装置。1. A servo control device for controlling the turning of a plurality of movable members via a servo motor provided corresponding to each of the moving members of a robot having a plurality of moving members. A composite OR gate circuit having a plurality of OR gate circuits for ORing detection signals from two operation limit detectors for detecting upper and lower limit values of an operation range, and a shift register having the same number of bits as the number of the OR gate circuits. A composite AND gate circuit having an AND gate circuit for outputting the logical product of the output of the OR gate circuit and the output signal of a predetermined bit of the shift register for each OR gate circuit, and the output of each of the composite AND gate circuits. The multi-input OR gate circuit that outputs a logical sum and the drive current of each servo motor Supplies based on the control signal, and a composite drive control circuit supplies the drive current is blocked based on the logical sum output of the multi-input OR gate circuit,
Prior to normal driving, the operation origin position of turning of each of the movable members is calculated based on the detection signal from the operation limit detector, and the output signal of the OR gate circuit to which the detection signal is transmitted is input. And a microcomputer which sets the contents of the shift register so as to open the AND gate circuit.
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP61195967A JPH0746285B2 (en) | 1986-08-21 | 1986-08-21 | Servo controller |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP61195967A JPH0746285B2 (en) | 1986-08-21 | 1986-08-21 | Servo controller |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| JPS6352206A JPS6352206A (en) | 1988-03-05 |
| JPH0746285B2 true JPH0746285B2 (en) | 1995-05-17 |
Family
ID=16349968
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| JP61195967A Expired - Lifetime JPH0746285B2 (en) | 1986-08-21 | 1986-08-21 | Servo controller |
Country Status (1)
| Country | Link |
|---|---|
| JP (1) | JPH0746285B2 (en) |
Families Citing this family (1)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| WO2017042878A1 (en) * | 2015-09-08 | 2017-03-16 | 富士機械製造株式会社 | Multi-joint robot arm |
Family Cites Families (2)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JPS5311457A (en) * | 1976-07-15 | 1978-02-01 | Hitachi Ltd | Device for detecting approached double arms of robot |
| JPS606375A (en) * | 1983-06-20 | 1985-01-14 | 三菱電機株式会社 | Controller for drive of robot |
-
1986
- 1986-08-21 JP JP61195967A patent/JPH0746285B2/en not_active Expired - Lifetime
Also Published As
| Publication number | Publication date |
|---|---|
| JPS6352206A (en) | 1988-03-05 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| JP2608161B2 (en) | Industrial robot stop control method | |
| KR101644758B1 (en) | Event-based redundancy angle configuration for jointed arm robot | |
| JPH103308A (en) | Industrial robot interference avoidance method | |
| WO2004009303A1 (en) | Robot controller and robot system | |
| EP3481602B1 (en) | Movable hardstop for a robotic component | |
| JPS61143803A (en) | Control device of robot | |
| JPWO2017081792A1 (en) | Detection device abnormality determination system, detection device, detection device abnormality determination device, and detection device abnormality determination method | |
| US20050104549A1 (en) | Drive control method and drive controller | |
| KR101675172B1 (en) | Method and device for controlling a manipulator system | |
| JP4240517B2 (en) | Servo motor and abnormal load detection control method for articulated robot | |
| JP2017164864A (en) | Robot control device and robot control method | |
| JPH11239945A (en) | Workpiece chucking method by loader hand | |
| KR960012702B1 (en) | Play back robot | |
| JPS6352206A (en) | Servo controller | |
| JPS6140612A (en) | Industrial robot | |
| JPH0283185A (en) | Method and device for teaching industrial robot | |
| JPS6025677A (en) | Driving controller for robot | |
| JP7634357B2 (en) | Industrial robot control device | |
| JPS6250906A (en) | Control device for industrial robot | |
| JP2008253132A (en) | Servo motor and abnormal load detection control method for articulated robot | |
| JPS606375A (en) | Controller for drive of robot | |
| JPH11336996A (en) | Safety device | |
| JPH04289086A (en) | Manipulator controller | |
| JPS61206007A (en) | Servomotor control system | |
| JPS6336918B2 (en) |