JPH07129210A - Mass distribution determining method for multi-axial mechanism, acceleration/deceleration feature parameter determining method, mass distribution and acceleration/ deceleration feature parameter simultaneous determining method, and additional mass mounted robot and specific mass distribution equipped robot having mass distribution based on the same mass distribution determining method - Google Patents

Mass distribution determining method for multi-axial mechanism, acceleration/deceleration feature parameter determining method, mass distribution and acceleration/ deceleration feature parameter simultaneous determining method, and additional mass mounted robot and specific mass distribution equipped robot having mass distribution based on the same mass distribution determining method

Info

Publication number
JPH07129210A
JPH07129210A JP27644893A JP27644893A JPH07129210A JP H07129210 A JPH07129210 A JP H07129210A JP 27644893 A JP27644893 A JP 27644893A JP 27644893 A JP27644893 A JP 27644893A JP H07129210 A JPH07129210 A JP H07129210A
Authority
JP
Japan
Prior art keywords
arm
motor
acceleration
mass
tip
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Pending
Application number
JP27644893A
Other languages
Japanese (ja)
Inventor
Toshio Ogiso
敏夫 小木曽
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Hitachi Ltd
Original Assignee
Hitachi Ltd
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 Hitachi Ltd filed Critical Hitachi Ltd
Priority to JP27644893A priority Critical patent/JPH07129210A/en
Publication of JPH07129210A publication Critical patent/JPH07129210A/en
Pending legal-status Critical Current

Links

Landscapes

  • Control Of Position Or Direction (AREA)
  • Numerical Control (AREA)
  • Manipulator (AREA)

Abstract

PURPOSE:To provide the mass distribution determining method for the multi-axial mechanism having optimum additional mass parameters for motor characteristics, robot arm mass distribution, and operation conditions when operation conditions of the multi-axial mechanism having inter-axis interference are given. CONSTITUTION:Dynamic interference between robot arms 2 and 4 is reduced by determining the mass distribution and acceleration/deceleration feature parameters of the robot so that restriction conditions are met with basic parameters and operation conditions and an evaluation function expressed with the restriction condition margin is maximized. Additional mass parameters can be determined unconditionally so as to consider speed variation characteristics of maximum torque which can be generated by a motor 3 and temperature rise characteristics of a motor 3 as the restriction condition evaluation function; and additional mass can be made smaller than that of conventional technology, so there is the advantage that the robot body can be reduced in weight.

Description

【発明の詳細な説明】Detailed Description of the Invention

【0001】[0001]

【産業上の利用分野】本発明は,水平多関節型もしく
は,垂直多関節型のア−ム機構を有する産業用ロボット
に関する。
BACKGROUND OF THE INVENTION 1. Field of the Invention The present invention relates to an industrial robot having a horizontal multi-joint type or a vertical multi-joint type arm mechanism.

【0002】[0002]

【従来の技術】従来,ロボットア−ムの質量配分を決め
る規範として,従来技術(1)(計測自動制御学会論文
集第20巻12号第1161ペ−ジ〜第1168ペ−
ジ,昭59−12)に記載のように,第1ア−ム以外の
ア−ム全体(手先負荷質量含む)の質量中心を第1ア−
ムの長手方向中心線上とする方式が,制御性を向上させ
ることが述べられている。
2. Description of the Related Art Conventionally, as a standard for determining the mass distribution of a robot arm, the prior art (1) (Proceedings of the Society of Instrument and Control Engineers, Vol. 20, No. 12, No. 1161 to No. 1168).
Pp. 59-12), the center of mass of the entire arm (including hand load mass) other than the first arm is set to the first arm.
It is stated that the method of setting it on the longitudinal centerline of the frame improves the controllability.

【0003】また,従来技術(2)(日本ロボット学会
誌5巻1号第67ペ−ジ〜第71ペ−ジ,昭62−2)
に記載のように,従来技術(1)で述べられている質量
配分を水平多関節型ロボットに適用することにより高速
動作が実現可能であることが述べられている。
Prior art (2) (Journal of the Robotics Society of Japan, Vol. 5, No. 1, pages 67 to 71, Sho 62-2)
It is stated that high speed operation can be realized by applying the mass distribution described in the prior art (1) to the horizontal articulated robot as described in (1).

【0004】また,従来技術(3)(特開平3−245
978号)に記載のように従来技術(1),(2)を実
現するために付加質量を移動させる駆動機構を有する水
平多関節型ロボットの構成について述べられている。
Further, the prior art (3) (Japanese Patent Laid-Open No. 3-245)
No. 978), a configuration of a horizontal articulated robot having a drive mechanism for moving an additional mass in order to realize the prior arts (1) and (2) is described.

【0005】また,従来技術(4)(特開平3−245
208号)に記載のように,軸間干渉のある多軸機構に
カウンタウエイトを設けることにより,駆動モ−タ特
性,加減速パタ−ンと機構系質量配分のマッチングを図
ることができることが述べられている。
Further, the prior art (4) (Japanese Patent Laid-Open No. 3-245)
No. 208), it is possible to achieve matching of drive motor characteristics, acceleration / deceleration patterns, and mechanism mass distribution by providing a counterweight in a multi-axis mechanism with inter-axis interference. Has been.

【0006】また,移動体の高速動作を実現するための
加減速制御技術としては,従来,加減速曲線の決め方,
その最適化方式,動吸振器装着による制振,可変構造制
御系の積分項初期値の与え方,などが提案されている。
Further, as an acceleration / deceleration control technique for realizing a high-speed operation of a moving body, the conventional method of determining an acceleration / deceleration curve,
The optimization method, vibration suppression by mounting a dynamic vibration absorber, and method of giving initial value of integral term of variable structure control system have been proposed.

【0007】[0007]

【発明が解決しようとする課題】ロボットの質量配分の
規範に関する従来技術(1)〜(3)は,第1ア−ム以
外のア−ムの質量中心を第1ア−ムの長手方向中心線上
とするものであるが,問題点は,第1ア−ム以外のア−
ムの集中質量と前記第1ア−ムの長手方向中心線からの
距離の積の値のみ定まるため,ア−ムの集中質量と,第
1ア−ムの長手方向中心線からの距離を一意に定めるこ
とができないという欠点がある。
In the prior arts (1) to (3) relating to the norm of mass distribution of a robot, the center of mass of an arm other than the first arm is set to the longitudinal center of the first arm. Although it is shown on the line, the problem is that it is not the first arm.
Since only the value of the product of the lumped mass of the arm and the distance from the longitudinal centerline of the first arm is determined, the lumped mass of the arm and the distance from the longitudinal centerline of the first arm are unique. There is a drawback that it cannot be specified in.

【0008】また,この方式により求められる集中質量
はかなり大きい値となり,高速動作実現の上で最適では
ないのではないかという疑問があり,またロボット本体
の軽量化を図りたいという課題もあった。
Further, the lumped mass required by this method has a considerably large value, and there is a question that it may not be optimal for realizing high-speed operation, and there is also a problem to reduce the weight of the robot body. .

【0009】また,従来技術(4)は,カウンタウエイ
トの質量・設置位置をいかに決定するのかに関する指針
が述べられていない問題があった。
Further, the prior art (4) has a problem that a guideline regarding how to determine the mass and installation position of the counterweight is not described.

【0010】また,移動体の高速動作を実現するための
従来の加減速制御技術は,いずれも加減速制御技術単独
での最適化が検討されており,ロボットア−ムの質量配
分とともに最適化が図られていないという問題があっ
た。
Further, with regard to the conventional acceleration / deceleration control technology for realizing high-speed operation of the moving body, optimization by the acceleration / deceleration control technology alone has been studied, and it is optimized together with the mass distribution of the robot arm. There was a problem that it was not planned.

【0011】本発明の目的は、ロボットの質量配分を最
適化することにある。
An object of the present invention is to optimize the mass distribution of robots.

【0012】[0012]

【課題を解決するための手段】本発明は,ロボットの質
量配分を最適化するために,先端ア−ムに付加質量を設
けるとした場合の付加質量パラメ−タ(付加質量・付加
質量設置位置)を,動作条件が与えられた場合に,速度
の関数として与えられるモ−タの最大発生可能トルクに
対するトルク余裕とモ−タの所要平均トルク・所要平均
速度とモ−タ温度上昇によりネックとなる部位の温度上
昇しきい値に対する余裕が極値をとるように決定する,
更には,付加質量パラメ−タと各軸駆動モ−タの加減速
パタ−ンの加減速パラメ−タを同時最適化することによ
り実現する。
According to the present invention, in order to optimize the mass distribution of a robot, an additional mass parameter (added mass / additional mass installation position) is provided when an additional mass is provided in the tip arm. ) Is a neck due to the torque margin, the required average torque of the motor, the required average speed of the motor, and the temperature rise of the motor when the operating conditions are given. , The margin for the temperature rise threshold of
Further, it is realized by simultaneously optimizing the additional mass parameter and the acceleration / deceleration parameters of the acceleration / deceleration pattern of each axis drive motor.

【0013】[0013]

【作用】本発明の軸間干渉ある多軸機構の質量配分決定
法は,ロボットの動作条件に対して,ロボットの各軸モ
−タ間の動力学的干渉,各軸モ−タの発生可能な最大駆
動力(トルク),各軸モ−タの温度上昇特性を考慮し,
その余裕が極値をとるように設計されているため質量配
分が一意に定めることができ,結果として付加質量を従
来技術の理論値より小さくすることができる。
The mass distribution determination method of the multi-axis mechanism with inter-axis interference according to the present invention is capable of generating dynamic interference between each axis motor of the robot and generation of each axis motor depending on the operating conditions of the robot. Considering the maximum driving force (torque) and temperature rise characteristics of each axis motor,
Since the margin is designed to have an extreme value, the mass distribution can be uniquely determined, and as a result, the additional mass can be made smaller than the theoretical value of the conventional technique.

【0014】更に,本発明の質量配分決定法に基づき設
計された付加質量装着ロボットは,駆動モ−タの加減速
パタ−ンに追従するように駆動モ−タの制御系を構成す
ることにより,良好な加減速パタ−ンへの追従と動作時
間の短縮をはかることができる。
Further, in the additional mass mounting robot designed based on the mass distribution determining method of the present invention, the control system of the drive motor is configured so as to follow the acceleration / deceleration pattern of the drive motor. , It is possible to follow good acceleration / deceleration pattern and shorten the operation time.

【0015】[0015]

【実施例】本発明の軸間干渉のある多軸機構の質量配分
決定法について実施例を,図1〜図12を用いて説明す
る。図1は本発明の質量配分決定法のフロ−であり,図
2は付加質量装着ロボットの一例として直列機構水平多
関節型ロボットの外観を示し,図3は図2のロボットの
剛体モデルを示し,図4はモ−タの発生可能最大トルク
・速度関係例を示し,図5はモ−タ直結エンコ−ダ部の
温度上昇特性例を示し,図6は動作パタ−ン例を示し,
図7はモ−タの加減速パタ−ンの一例を示し,図8はモ
−タの動作デュ−ティを示し,図9,図10は質量配分
決定前の図2のロボットの1,2軸モ−タ所要トルクの
時間変化を示し,図11,図12は本発明の質量配分決
定法を用いた図2のロボットの1,2軸モ−タ所要トル
クの時間変化を示している。
DETAILED DESCRIPTION OF THE PREFERRED EMBODIMENTS An embodiment of the mass distribution determining method for a multi-axis mechanism with inter-axis interference according to the present invention will be described with reference to FIGS. FIG. 1 is a flow chart of the mass distribution determination method of the present invention, FIG. 2 shows the appearance of a series mechanism horizontal articulated robot as an example of an additional mass mounting robot, and FIG. 3 shows a rigid body model of the robot of FIG. Fig. 4 shows an example of the maximum torque / speed that can be generated by the motor, Fig. 5 shows an example of the temperature rise characteristics of the motor direct-connection encoder part, and Fig. 6 shows an example of the operation pattern.
FIG. 7 shows an example of the motor acceleration / deceleration pattern, FIG. 8 shows the operation duty of the motor, and FIGS. 9 and 10 show the robot 1 and 2 of FIG. 2 before the mass distribution is determined. FIG. 11 and FIG. 12 show the time changes of the required torque of the 1 and 2 axis motors of the robot of FIG. 2 using the mass distribution determining method of the present invention.

【0016】ここで扱う問題は,軸間干渉のある多軸機
構の高速位置決め動作を実現するために,その機構(動
力学)パラメ−タ,モ−タ諸元,加減速パタ−ンにおけ
る加減速曲線の特徴パラメ−タ(一定値),動力学式に
おける干渉項の絶対値を低減することのできる付加質量
装着を想定した場合の付加質量パラメ−タ(質量,設置
位置)初期値(0でもよい)があらかじめわかってい
て,動作条件{動作開始点,動作終了点,動作デュ−テ
ィ(図8参照,後述),手先負荷質量}が与えられた場
合に,下記の制約条件を満足し,かつ評価関数が極値を
とるように付加質量パラメ−タを決定することにより質
量配分を決定するものである。
The problem to be dealt with here is that in order to realize a high-speed positioning operation of a multi-axis mechanism having inter-axis interference, the mechanism (dynamics) parameters, motor specifications, and acceleration / deceleration pattern acceleration / deceleration patterns are used. Deceleration curve characteristic parameter (constant value), additional mass parameter (mass, installation position) initial value (0 when assuming additional mass attachment that can reduce the absolute value of the interference term in the dynamic equation) However, if the operating conditions {operation start point, operation end point, operation duty (see FIG. 8, later described), hand load mass} are given, the following constraint conditions are satisfied. , And the mass distribution is determined by determining the additional mass parameters so that the evaluation function takes the extreme value.

【0017】制約条件: 各軸モ−タトルク余裕が正 各軸モ−タ温度上昇ネック部位温度上昇しきい値に対
する余裕が正 付加質量パラメ−タ設定可能最大値より小さい 評価関数: ,の余裕値の重み付け二乗和 この質量配分決定法を軸間干渉のある多軸機構の一例と
して,図2に示す直接駆動型(D・D型)直列機構水平
多関節型ロボットに適用した例を以下説明する。図2の
ロボットは,1軸モ−タ1により回転駆動される第1ア
−ム2,第1ア−ム先端に設けられた2軸モ−タ3によ
り回転駆動される第2ア−ム4,第2ア−ム4先端に設
けられ上下方向(3軸),回転方向(4軸)に駆動され
る手首軸5からなっている。図では,2軸モ−タ3近傍
に3,4軸モ−タが設けられており,ベルトで第2ア−
ム先端まで動力伝達し,ボ−ルネジで上下方向動作を実
現し,ボ−ルスプラインで回転方向動作を実現する。第
2ア−ム4の2軸モ−タ3に対して手首軸5とは反対側
の距離lmの位置に固定されたもしくは着脱可能な付加
質量6(質量Δm)が装着されている。これは,後述す
るがモ−タの動力学式において,干渉成分,遠心トルク
・コリオリトルク成分を低減する役割をはたし,高速動
作を実現する。このロボットで,上下方向動作は3軸の
みの独立動作であり,4軸は手首軸5下端の姿勢決めに
寄与することから,分離して扱うことができる。一方,
1・2軸はその合成動作により水平方向位置決め動作を
実現するが,互いに動力学的干渉があり,機構モ−タ所
要トルクはロボットア−ムの質量配分の影響を強く受け
る。そこで,ここでは,1・2軸の合成動作による水平
方向位置決め動作に着目し,モ−タトルク余裕の最大化
を図る。
Constraint conditions: Motor torque margin of each axis is positive. Margin for temperature increase of neck temperature of each axis motor is positive. The margin is smaller than the maximum value of additional mass parameter setting. Weighted square sum of ## EQU1 ## An example in which this mass distribution determination method is applied to a direct drive type (D / D type) series mechanism horizontal articulated robot shown in FIG. . The robot shown in FIG. 2 has a first arm 2 which is rotationally driven by a single-axis motor 1 and a second arm which is rotationally driven by a biaxial motor 3 provided at the tip of the first arm. 4, a wrist shaft 5 provided at the tip of the second arm 4 and driven in the vertical direction (3 axes) and the rotating direction (4 axes). In the figure, three- and four-axis motors are provided in the vicinity of the two-axis motor 3, and the belt is used as the second motor.
Power is transmitted to the tip of the shaft, the ball screw enables vertical movement, and the ball spline enables rotational movement. A fixed or detachable additional mass 6 (mass Δm) is attached to the biaxial motor 3 of the second arm 4 at a position of a distance lm on the side opposite to the wrist shaft 5. As will be described later, this serves to reduce interference components, centrifugal torque and Coriolis torque components in the motor dynamic equation, and realizes high-speed operation. In this robot, the vertical movement is independent movement of only three axes, and since the four axes contribute to the posture determination of the lower end of the wrist axis 5, they can be handled separately. on the other hand,
Although the 1st and 2nd axes realize horizontal positioning operation by their combined operation, they have dynamic interference with each other, and the required torque of the mechanism motor is strongly influenced by the mass distribution of the robot arm. Therefore, here, we focus on the horizontal positioning operation by the combined operation of the 1 and 2 axes to maximize the motor torque margin.

【0018】図3は,図2のロボットのロボットア−ム
を剛体でモデル化したときの動力学パラメ−タを示して
いる。このモデルに基づく動力学式は次式で示される。
FIG. 3 shows dynamic parameters when the robot arm of the robot of FIG. 2 is modeled by a rigid body. The kinetic equation based on this model is shown by the following equation.

【0019】[0019]

【数1】 [Equation 1]

【0020】ここで,慣性モ−メントJijは次式で示
される。
Here, the inertia moment Jij is expressed by the following equation.

【0021】[0021]

【数2】 [Equation 2]

【0022】ここで,Tj:j軸モ−タトルク,Ji
j:慣性モ−メント,θj:j軸加速度,θj:j軸速
度,θj:j軸角度,である。
Where Tj: j-axis motor torque, Ji
j: inertial moment, θj: j-axis acceleration, θj: j-axis velocity, θj: j-axis angle.

【0023】ここで,従来技術の理論では,m22+m
02−Δmlm=0である。
Here, according to the theory of the prior art, m 2 l 2 + m
0 a 2 −Δmlm = 0.

【0024】また,j軸出力部でみた(モ−タ駆動増幅
器の特性も含んだ)モ−タの発生可能最大トルクと速度
の関係は次式のように示される(式中sgn(a)は,
a>0のとき+1,a=0のとき0,a<0のとき−1
をとる記号であり,関数gは速度絶対値の関数であ
る)。
The relationship between the maximum torque that can be generated by the motor (including the characteristics of the motor drive amplifier) and the speed as seen at the j-axis output section is expressed by the following equation (in the equation, sgn (a)). Is
+1 when a> 0, 0 when a = 0, -1 when a <0
, And the function g is a function of the absolute velocity value).

【0025】[0025]

【数3】 [Equation 3]

【0026】以上の仮定の下で,動作条件{1,2軸動
作開始点座標・動作終了点座標,動作デュ−ティ(モ−
タの通電時間とロボットの総動作時間の比),手先負荷
質量}が与えられ,付加質量パラメ−タを決定する方法
として,次式で示される制約条件の下で評価関数を最大
化する最適化処理を行う。
Under the above assumptions, the motion condition {1,2 axis motion start point coordinates / motion end point coordinates, motion duty (mode
The ratio of the energization time of the robot to the total operation time of the robot) and the load mass of the hand} are given, and as a method of determining the additional mass parameter, the optimum evaluation function is maximized under the constraint condition shown by the following formula Process.

【0027】[0027]

【数4】 [Equation 4]

【0028】ここで,モ−タの発生可能最大トルクと速
度の関係の例を図4に示し,モ−タの発熱によりその温
度上昇がネックとなるモ−タ直結エンコ−ダ内部温度と
モ−タ所要二乗平均トルクTavg,モ−タ所要速度θ
avgとモ−タ定格トルクTr,モ−タ定格速度θrの
比(比定格トルク,比定格速度と呼称する)の関係例を
図5に示した。ここで,温度上昇しきい値は,ロボット
の保証温度を0〜45(℃)とした場合にモ−タの温度
上昇により耐熱温度が80(℃)程度と最低なモ−タ直
結エンコ−ダ部の温度上昇を考慮して,35(deg)
とした。また,付加質量パラメ−タ上限値Δm0,lm
0はア−ム長さ,ア−ム質量を考慮して決めた。ここで
は,動作パタ−ンの例として,図6に示すものに対し
て,各軸モ−タを図7に例を示すように加減速パタ−ン
として指数乗正弦波速度パタ−ン(後述)で駆動するケ
−スを示す。モ−タの動作デュ−ティDは図8に示すよ
うにモ−タの通電時間とロボット総動作時間の比であ
り,繰返し動作の場合は図8のようにt3/Tで示され
る。
An example of the relationship between the maximum torque that can be generated by the motor and the speed is shown in FIG. 4, in which the temperature inside the motor is directly linked to the temperature of the motor, which is a bottleneck due to the temperature rise of the motor. -Required root mean square torque Tavg, required motor speed θ
An example of the relationship between the ratio of avg to the motor rated torque Tr and the motor rated speed θr (referred to as a specific rated torque or a specific rated speed) is shown in FIG. Here, the temperature rise threshold value is the lowest motor direct connection encoder with a heat resistant temperature of about 80 (° C) due to the temperature rise of the motor when the guaranteed temperature of the robot is 0 to 45 (° C). 35 (deg), considering the temperature rise of the part
And Further, the upper limit values of the additional mass parameters Δm 0 , lm
0 was determined in consideration of arm length and arm mass. Here, as an example of the motion pattern, in contrast to the one shown in FIG. 6, each axis motor is used as an acceleration / deceleration pattern as shown in FIG. 7 as an exponential sine wave velocity pattern (described later). ) Shows the case driven by. The operation duty D of the motor is the ratio of the energization time of the motor to the total operation time of the robot as shown in FIG. 8. In the case of repetitive operation, it is represented by t 3 / T as shown in FIG.

【0029】この動作条件で,質量配分決定前の1,2
軸の所要モ−タトルクとモ−タ発生可能トルクの時間変
化特性例を図9,図10に示した。これから,1軸では
減速部でトルク不足を起こしている。これを本発明の質
量配分決定法に基づき付加質量を装着した場合の1,2
軸の所要モ−タトルクとモ−タ発生可能トルクの時間変
化特性例を図11,図12に示した。これから,1,2
軸のトルク余裕が均等化され,トルク不足を起こさない
良好な加減速動作が実現できる。しかしながら,加減速
特徴パラメ−タが一定のため,モ−タのトルク余裕が十
分あるにもかかわらず動作時間を短縮できない問題があ
る。
Under this operating condition, 1, 2 before the mass distribution is determined
9 and 10 show examples of time-varying characteristics of the required motor torque of the shaft and the torque that can be generated by the motor. From now on, the torque is insufficient in the reduction section for one axis. 1, 2 when the additional mass is attached based on the mass distribution determination method of the present invention.
11 and 12 show examples of time-varying characteristics of the required motor torque of the shaft and the torque that can be generated by the motor. From now on, 1, 2
The torque margin of the shaft is equalized, and good acceleration / deceleration operation without torque shortage can be realized. However, since the acceleration / deceleration characteristic parameters are constant, there is a problem that the operating time cannot be shortened even though the motor torque margin is sufficient.

【0030】次に,本発明の軸間干渉のある多軸機構の
加減速特徴パラメ−タ決定法についての実施例を図13
〜図17を用いて説明する。図13は本発明の加減速特
徴パラメ−タ決定法のフロ−を示し,図14,図15は
加減速パタ−ンとして,台形速度パタ−ン,指数乗正弦
波速度パタ−ンを用いた場合の加減速特徴パラメ−タを
示しており,図16,図17は本発明の加減速特徴パラ
メ−タ決定法を用いた場合の図2のロボットの1,2軸
モ−タ所要トルクとモ−タ発生可能最大トルクの時間変
化特性を示している。
Next, an embodiment of the method for determining the acceleration / deceleration characteristic parameter of the multi-axis mechanism with inter-axis interference according to the present invention will be described with reference to FIG.
~ It demonstrates using FIG. FIG. 13 shows the flow of the acceleration / deceleration characteristic parameter determination method of the present invention, and FIGS. 14 and 15 use a trapezoidal velocity pattern and an exponential sine wave velocity pattern as the acceleration / deceleration pattern. FIG. 16 and FIG. 17 show the acceleration / deceleration characteristic parameters in the case, and FIGS. 16 and 17 show the required torque for the 1 and 2 axis motors of the robot of FIG. 2 when the acceleration / deceleration characteristic parameter determination method of the present invention is used. The time change characteristic of the maximum torque that can be generated by the motor is shown.

【0031】ここで扱う問題は,軸間干渉のある多軸機
構の高速位置決め動作を実現するために,その機構(動
力学)パラメ−タ,モ−タ諸元,加減速パタ−ンにおけ
る加減速曲線の特徴パラメ−タ初期値,動力学式におけ
る干渉項の絶対値を低減することのできる付加質量装着
を想定した場合の付加質量パラメ−タ(質量,設置位
置)(一定値,0でもよい)があらかじめわかってい
て,動作条件{動作開始点,動作終了点,動作デュ−テ
ィ,手先負荷質量}が与えられた場合に,下記の制約条
件を満足し,制約条件余裕値と評価関数(動作時間)が
極小値をとるように加減速特徴パラメ−タを決定するも
のである(図13参照)。
The problem to be dealt with here is that in order to realize a high-speed positioning operation of a multi-axis mechanism having inter-axis interference, the mechanism (dynamics) parameters, motor specifications, and acceleration / deceleration pattern acceleration / deceleration patterns are used. Deceleration curve characteristic parameters Initial value, additional mass parameter (mass, installation position) (constant value, even at 0) assuming additional mass mounting that can reduce the absolute value of the interference term in the dynamic equation If the motion conditions {motion start point, motion end point, motion duty, hand load mass} are given, the following constraint conditions are satisfied, and the constraint margin value and evaluation function are satisfied. The acceleration / deceleration characteristic parameters are determined so that the (operating time) takes a minimum value (see FIG. 13).

【0032】制約条件: 各軸モ−タトルク余裕が正 各軸モ−タ温度上昇ネック部位温度上昇しきい値に対
する余裕が正 加速距離と減速距離の和が総動作距離より小さい 動作開始時の加速度が無限大にならず,動作終了時の
跳躍(加速度の時間微分値)が零となるような加減速特
徴パラメ−タをとる モ−タ速度がトルク発生可能最大速度より小さい 評価関数:動作時間 具体的な式は次式に示した。
Constraint condition: Each motor torque margin is positive. Each motor temperature rise is positive with respect to the neck temperature rise threshold. The sum of the acceleration distance and deceleration distance is smaller than the total operating distance. Does not become infinite and the acceleration / deceleration characteristic parameter is taken so that the jump (time derivative of acceleration) at the end of the operation becomes zero. The motor speed is smaller than the maximum speed at which torque can be generated Evaluation function: Operating time The specific formula is shown in the following formula.

【0033】[0033]

【数5】 [Equation 5]

【0034】加減速パタ−ンとしては,等加速度(台
形)速度パタ−ン,指数関数型速度パタ−ン,スプライ
ン関数型速度パタ−ン,指数乗正弦波速度パタ−ンなど
が知られている。ここでは,台形速度パタ−ンと指数乗
正弦波速度パタ−ンを例にとり,図14,図15を用い
て加減速特徴パラメ−タについて説明する。
As the acceleration / deceleration pattern, uniform acceleration (trapezoidal) speed pattern, exponential function type speed pattern, spline function type speed pattern, exponential sine wave speed pattern, etc. are known. There is. Here, the trapezoidal velocity pattern and the exponential sine wave velocity pattern are taken as an example to describe the acceleration / deceleration characteristic parameter with reference to FIGS. 14 and 15.

【0035】各々の速度パタ−ン及び動作時間t3は次
式で示される。
Each speed pattern and operation time t 3 are represented by the following equations.

【0036】(1)台形速度パタ−ン(1) Trapezoidal speed pattern

【0037】[0037]

【数6】 [Equation 6]

【0038】(2)台形速度パタ−ン動作時間(2) Trapezoidal speed pattern operating time

【0039】[0039]

【数7】 [Equation 7]

【0040】(3)指数乗正弦波速度パタ−ン(3) Exponential sine wave velocity pattern

【0041】[0041]

【数8】 [Equation 8]

【0042】(4)指数乗正弦波速度パタ−ン動作時間(4) Exponential sine wave velocity pattern operating time

【0043】[0043]

【数9】 [Equation 9]

【0044】ここで,θj:軸速度,m1:加速指数,
2:減速指数:th1:加速周期,th2:減速周
期,θmj:j軸最大速度,である。各軸動作距離Δθ
jとする。
Where θj: axis velocity, m 1 : acceleration index,
m 2 : deceleration index: th1: acceleration period, th2: deceleration period, θmj: j-axis maximum speed. Working distance of each axis Δθ
j.

【0045】これから,台形速度パタ−ンは最大速
度:θm,無次元加速距離(加速距離と総動作距離の
比,加速時間に対応):α,無次元減速距離(減速距
離と総動作距離の比,減速時間に対応):β,の3ケの
加減速特徴パラメ−タがあり,指数乗正弦波速度パタ−
ンは,最大速度:θm,加速指数:m1,減速指
数:m2,無次元加速距離:α,無次元減速距離:
β,の5ケの加減速特徴パラメ−タがある。このうち,
加速指数,減速指数は加速曲線,減速曲線の膨らみに対
応するパラメ−タで,台形速度パタ−ンでは表現できな
い曲線を表現可能とする。従って,以下指数乗正弦波速
度パタ−ンを用いた検討を示す。速度パタ−ンは指数に
より大きく変化するが,加速開始時はモ−タに無限のト
ルクが要求されないように加速度が無限大とはならず,
減速終了時に著しい残留振動が発生しないように跳躍
(加速度の時間微分値)が零となるという観点下記のと
りうる値の範囲が得られる。
From this, the trapezoidal velocity pattern has a maximum velocity: θm, a dimensionless acceleration distance (corresponding to the ratio of the acceleration distance to the total operation distance, and the acceleration time): α, a dimensionless deceleration distance (of the deceleration distance and the total operation distance). Ratio, deceleration time): β, there are three acceleration / deceleration characteristic parameters, and exponential sine wave velocity pattern
The maximum speed: θm, acceleration index: m 1 , deceleration index: m 2 , dimensionless acceleration distance: α, dimensionless deceleration distance:
There are 5 acceleration / deceleration feature parameters of β and β. this house,
The acceleration index and deceleration index are parameters corresponding to the bulge of the acceleration curve and deceleration curve, and can express curves that cannot be expressed by the trapezoidal speed pattern. Therefore, the following discussion is based on the exponential sine wave velocity pattern. The speed pattern changes greatly with the exponent, but at the start of acceleration, the acceleration does not become infinite so that the motor does not require infinite torque.
The following range of possible values is obtained from the viewpoint that the jump (time differential value of acceleration) becomes zero so that no significant residual vibration occurs at the end of deceleration.

【0046】(1)加速区間:指数m1≧1が望まし
い。
(1) Acceleration section: It is desirable that the index m 1 ≧ 1.

【0047】(2)減速区間:指数m2≧2が望まし
い。
(2) Deceleration section: Exponent m 2 ≧ 2 is desirable.

【0048】ここで,指数は小さいほど動作時間を短縮
できるため,上記のとりうる範囲をみたしつつ,できる
だけ小さい値をとるようにm1,m2を決定する。
Here, the smaller the index, the shorter the operating time. Therefore, m 1 and m 2 are determined so as to take the smallest possible values while satisfying the above range.

【0049】以下,この加減速特徴パラメ−タに関する
知見を生かしてロボットのモ−タの加減速パタ−ンの決
定を行う方式を説明する。
A method for determining the acceleration / deceleration pattern of the motor of the robot by making use of the knowledge about the acceleration / deceleration characteristic parameters will be described below.

【0050】ここで,動作軌道を問わない同時動作開始
・動作終了動作では,比Δθj/θmjは(数10)で
示される値ξをとるように全軸(全てのjに対して)同
一の値をとる。従って,最大速度パラメ−タとしては1
軸値θm1を用いることにする。2軸最大速度θm2
は,θm2=γθm1と置く(γ=Δθ2/Δθ1)。こ
こで,θm1=ξΔθ1,θm2=ξγΔθ1,で示され
る。
Here, in the simultaneous motion start / motion end motions regardless of motion trajectories, the ratio Δθj / θmj is the same for all axes (for all j) so as to take the value ξ shown in (Equation 10). Takes a value. Therefore, the maximum speed parameter is 1
The axis value θm1 will be used. 2-axis maximum speed θm2
Is set as θm2 = γθm1 (γ = Δθ 2 / Δθ 1 ). Here, θm1 = ξΔθ 1 and θm2 = ξγΔθ 1 are represented.

【0051】[0051]

【数10】 [Equation 10]

【0052】ここで,min(a,b)はa,bの最小
値を選択する記号である。加減速パタ−ンの加減速特徴
パラメ−タとしては,加速指数m1,減速指数m2
1軸最大速度θm1,無次元加速距離α,無次元
減速距離β,の5ケを用いる。
Here, min (a, b) is a symbol for selecting the minimum value of a and b. The acceleration / deceleration characteristic parameters of the acceleration / deceleration pattern are acceleration index m 1 , deceleration index m 2 ,
5 speeds of 1 axis maximum velocity θm1, dimensionless acceleration distance α, dimensionless deceleration distance β are used.

【0053】この場合の図2のロボットについて,加減
速特徴パラメ−タ決定前は1,2軸のモ−タ所要トルク
とモ−タ発生可能トルクの関係が図9,図10のようで
あった対象に,本発明の加減速特徴パラメ−タ決定法を
適用した結果を図16,図17に示した。これから,
1,2軸ともにトルク不足を起こさぬ動作実現を可能に
しており,動作時間も2%程度の短縮が図られている。
しかしながら,1軸はモ−タのトルク発生性能を十分使
っているのに対して,2軸はモ−タのトルク発生性能を
その半分程度しか使っておらず,モ−タと機構系のマッ
チングが十分とれていない問題がある。
Regarding the robot of FIG. 2 in this case, the relationship between the motor required torque for the first and second axes and the motor-producible torque is as shown in FIGS. 9 and 10 before the acceleration / deceleration characteristic parameters are determined. The results of applying the acceleration / deceleration characteristic parameter determination method of the present invention to the target are shown in FIGS. 16 and 17. from now on,
It is possible to realize an operation that does not cause torque shortage for both the 1st and 2nd axes, and the operation time is also shortened by about 2%.
However, while the 1-axis uses the motor's torque generation performance sufficiently, the 2-axis uses only about half of the motor's torque generation performance. There is a problem that is not taken enough.

【0054】次に,本発明の軸間干渉のある多軸機構の
質量配分・加減速特徴パラメ−タ同時決定法についての
実施例を図18〜図30を用いて説明する。図18は本
発明の軸間干渉のある多軸機構の質量配分・加減速特徴
パラメ−タ同時決定法のフロ−を示し,図19,図20
は図2のロボットに本決定法を適用した場合の1,2軸
のモ−タ所要トルクとモ−タ発生可能最大トルクの時間
変化特性を示し,図21は図2のロボットに本決定法を
適用した場合のモ−タの加減速パタ−ンを示し,図22
は付加質量パラメ−タと動作時間収束値の関係を示し,
図23〜図30は動作条件(動作デュ−ティ,手先負荷
質量)可変時の動作時間ならびに各パラメ−タの収束値
を示している。
Next, an embodiment of the method for simultaneously determining the mass distribution / acceleration / deceleration characteristic parameters of the multi-axis mechanism with inter-axis interference according to the present invention will be described with reference to FIGS. FIG. 18 shows a flow of a method for simultaneously determining mass distribution / acceleration / deceleration characteristic parameters of a multi-axis mechanism with inter-axis interference according to the present invention.
2 shows the time-varying characteristics of the required motor torque and the maximum torque that can be generated by the motor for 1 and 2 axes when the present determination method is applied to the robot of FIG. 2, and FIG. 22 shows the acceleration / deceleration pattern of the motor when
Indicates the relationship between the added mass parameter and the operating time convergence value,
23 to 30 show the operating time and the converged value of each parameter when the operating conditions (operating duty, hand load mass) are variable.

【0055】ここで扱う問題は,軸間干渉のある多軸機
構の高速位置決め動作を実現するために,その機構(動
力学)パラメ−タ,モ−タ諸元,加減速パタ−ンにおけ
る加減速曲線の特徴パラメ−タ初期値,動力学式におけ
る干渉項の絶対値を低減することのできる付加質量装着
を想定した場合の付加質量パラメ−タ(質量,設置位
置)初期値があらかじめわかっていて,動作条件{動作
開始点,動作終了点,動作デュ−ティ,手先負荷質量}
が与えられた場合に,下記の制約条件を満足し,制約条
件余裕値と評価関数(動作時間)が極小値をとるように
付加質量パラメ−タ・加減速特徴パラメ−タを決定する
ものである(図18参照)。
The problem to be dealt with here is that in order to realize high-speed positioning operation of a multi-axis mechanism having inter-axis interference, the mechanism (dynamics) parameters, motor specifications, and acceleration / deceleration pattern acceleration / deceleration patterns are used. The initial values of the characteristic parameters of the deceleration curve and the initial values of the additional mass parameters (mass, installation position) when assuming the additional mass attachment that can reduce the absolute value of the interference term in the dynamic equation are known in advance. Operating conditions {operation start point, operation end point, operation duty, hand load mass}
Is given, the additional mass parameter / acceleration / deceleration feature parameter is determined so that the constraint condition margin value and the evaluation function (operating time) take the minimum value when the following constraint condition is satisfied. Yes (see FIG. 18).

【0056】制約条件: 各軸モ−タトルク余裕が正 各軸モ−タ温度上昇ネック部位温度上昇しきい値に対
する余裕が正 加速距離と減速距離の和が総動作距離より小さい 動作開始時の加速度が無限大にならず,動作終了時の
跳躍(加速度の時間微分値)が零となるような加減速特
徴パラメ−タをとる モ−タ速度がトルク発生可能最大速度より小さい 付加質量パラメ−タが設定可能な最大値より小さい 評価関数:動作時間 具体的な式は次式に示した。
Restriction condition: Each motor torque margin is positive. Each motor temperature rise is positive for the neck temperature rise threshold. The sum of the acceleration distance and deceleration distance is smaller than the total operating distance. Does not become infinite, and the acceleration / deceleration characteristic parameter is taken so that the jump (time derivative of acceleration) at the end of operation becomes zero. Additional mass parameter where the motor speed is smaller than the maximum speed at which torque can be generated. Is smaller than the maximum value that can be set. Evaluation function: Operating time The concrete formula is shown in the following formula.

【0057】[0057]

【数11】 [Equation 11]

【0058】ここで,制約条件満足化処理・制約条件余
裕最小化処理は,付加質量・加減速パラメ−タ微小変化
量と制約条件余裕微小変化量の関係を線形化した伝達関
数で表現し,その一般化逆行列を用いて所望の付加質量
・加減速パラメ−タ微小変化量を算出し,パラメ−タを
変化させることにより実現される。また,評価関数最小
化処理は最急降下法などの手法により実現されるが,こ
の処理の後,制約条件を満足しなくなる場合もあるので
制約条件に関する処理と評価関数に関する処理をパラメ
−タが収束するまで繰返し行うことにより実現される。
Here, in the constraint condition satisfaction process / constraint margin minimization process, the relation between the added mass / acceleration / deceleration parameter minute change amount and the constraint condition margin minute change amount is expressed by a linearized transfer function, This is realized by calculating the desired additional mass / acceleration / deceleration parameter minute change amount using the generalized inverse matrix and changing the parameter. Also, the evaluation function minimization process is realized by a method such as the steepest descent method, but after this process, the constraint conditions may not be satisfied, so the parameters converge between the process related to the constraint condition and the process related to the evaluation function. It is realized by repeatedly performing until.

【0059】次に図2で示すロボットを対象とし,図
9,図10の初期条件のロボットに本発明の図11質量
配分・加減速特徴パラメ−タ同時決定法を適用したとこ
ろ,1,2軸のモ−タ所要トルクとモ−タ発生可能最大
トルクの時間変化特性は図19,図20のようになり,
加減速パタ−ンが図21のようになった。これから,動
作時間は初期条件と比較して7%短縮されており,1,
2モ−タは2軸の減速部を除いて,加減速時にモ−タの
発生可能最大トルクを利用している。次に,上記質量配
分・加減速特徴パラメ−タ同時決定法に基づくパラメ−
タ間の関係について示す。
When the mass distribution / acceleration / deceleration characteristic parameter simultaneous determination method of FIG. 11 of the present invention is applied to the robot having the initial conditions shown in FIGS. 9 and 10, the robot shown in FIG. The time variation characteristics of the required motor torque of the shaft and the maximum torque that can be generated by the motor are as shown in Figs.
The acceleration / deceleration pattern is as shown in Fig. 21. From this, the operating time is reduced by 7% compared to the initial condition.
The 2-motor uses the maximum torque that can be generated by the motor during acceleration / deceleration, except for the 2-axis deceleration part. Next, the parameters based on the mass distribution / acceleration / deceleration feature parameter simultaneous determination method described above.
The relationship between the data is shown below.

【0060】図22は付加質量パラメ−タと動作時間の
関係を示したものであるが,Δm=3。0(kg),l
m=0。214(m),θm1=5。658(rad/
s),α=0。44,β=0。49,の場合に動作時間
3=0。7499(s)となり最小値を示しており,
最適値が一意に求められることを示している。また,従
来技術(1)〜(3)の理論値を破線で示したが,最適
値は破線より下にあり,より小さい質量で最適な高速動
作を実現可能なことを示している。この条件において,
実験的に探索した付加質量パラメ−タ最適値はΔm=
3。0(kg),lm=0。23(m)であり,計算値
とよく合致している。
FIG. 22 shows the relationship between the added mass parameter and the operating time. Δm = 3.0 (kg), l
m = 0.214 (m), θm1 = 5.658 (rad /
s), α = 0.44, β = 0.49, the operating time t 3 = 0.7499 (s), which is the minimum value.
It indicates that the optimum value can be uniquely obtained. Further, the theoretical values of the prior arts (1) to (3) are shown by broken lines, but the optimum values are below the broken lines, and it is shown that optimum high-speed operation can be realized with a smaller mass. In this condition,
The optimum value of the added mass parameter experimentally searched is Δm =
The values are 3.0 (kg) and lm = 0.23 (m), which are in good agreement with the calculated values.

【0061】動作条件のうち,手先付加質量m0,動作
デュ−ティDを変化させた場合の動作時間ならびに各パ
ラメ−タ最適値は図23〜図30のようになり,動作条
件により大幅に変化している。
Among the operating conditions, the operating time and the optimum parameter values when the hand added mass m 0 and the operating duty D are changed are as shown in FIGS. Is changing.

【0062】動作条件によってパラメ−タ最適値は大き
く異なるが,ロボットで実現される作業は同一動作の繰
返しが多いことから,典型的な動作条件に対してパラメ
−タ最適値を選ぶことによりロボットの最短時間位置決
め動作が動作停止時に著しい残留振動を伴うことなく実
現できる。
Although the optimum parameter values greatly differ depending on the operating conditions, the work realized by the robot often involves repeating the same operation. Therefore, by selecting the optimum parameter values for typical operating conditions, the robot can be selected. The shortest time positioning operation can be realized without significant residual vibration when the operation is stopped.

【0063】次に,本発明の付加質量装着ロボットの実
施例を図31〜図33を用いて説明する。図31,図3
2は付加質量装着水平多関節型ロボットの構造を示し,
図33は付加質量装着垂直多関節型ロボットの構造を示
している。図31,図32では,付加質量装着水平多関
節型ロボットを水平動作機構及び上下動作機構(含4軸
モ−タ配置)により分類して示し,図33では,付加質
量装着垂直多関節型ロボットを垂直面内動作機構により
分類して示したものである。図中Miはi軸モ−タ(減
速機直結の場合もある)の位置を示している。図中6は
付加質量を示している。これらのロボットは付加質量パ
ラメ−タ及び加減速パラメ−タがロボットの典型的な動
作に対して前述の手法により定められた値となってい
る。このうち,付加質量パラメ−タは各機構の動力学式
における動的干渉項,遠心トルク項,コリオリトルク項
を完全に打ち消す値よりも小さい特徴を有する。図中で
は,水平多関節型ロボットについては4自由度の場合,
垂直多関節型ロボットについては6自由度の場合を示し
たが,手首の姿勢決め自由度が不足した場合すなわち水
平多関節型ロボットについてはひねり軸のない3自由度
の場合,垂直多関節型ロボットについては3自由度,4
自由度,5自由度の場合,及び姿勢決め自由度がより多
い場合についても同様のことが成り立つ。
Next, an embodiment of the additional mass mounting robot of the present invention will be described with reference to FIGS. 31 and 3
2 shows the structure of a horizontal articulated robot equipped with an additional mass,
FIG. 33 shows the structure of a vertical articulated robot equipped with an additional mass. 31 and 32, horizontal mass articulated robots with additional mass are classified according to horizontal motion mechanism and vertical motion mechanism (including 4-axis motor arrangement), and in FIG. Are classified according to the vertical in-plane motion mechanism. In the figure, Mi indicates the position of the i-axis motor (which may be directly connected to the speed reducer). In the figure, 6 indicates the added mass. In these robots, the additional mass parameter and the acceleration / deceleration parameter have values determined by the above-described method with respect to the typical operation of the robot. Among these, the added mass parameter has a feature that it is smaller than the value that completely cancels the dynamic interference term, centrifugal torque term, and Coriolis torque term in the dynamic equation of each mechanism. In the figure, the horizontal articulated robot has 4 degrees of freedom,
The vertical articulated robot has 6 degrees of freedom, but the wrist articulation has insufficient degrees of freedom, that is, the horizontal articulated robot has 3 degrees of freedom without a twist axis. For 3 degrees of freedom, 4
The same holds for the case of five degrees of freedom, and the case of more posture determination degrees of freedom.

【0064】次に,本発明の特定質量配分具備ロボット
の実施例を図34及び図35を用いて説明する。図34
は特定質量配分具備水平多関節型ロボットの構造を示
し,図35は特定質量配分具備垂直多関節型ロボットの
構造を示している。図34では,特定質量配分具備水平
多関節型ロボットを水平動作機構及び上下動作機構によ
り分類して示し,図35では,特定質量配分具備垂直多
関節型ロボットを垂直面内動作機構により分類して示し
たものである。図中Miはi軸モ−タ(減速機直結の場
合もある)の位置を示している。手首駆動モ−タを付加
質量装着時の相当位置に設置することにより同様の効果
を実現している。これらのロボットは付加質量相当効果
を実現するロボットア−ムの質量配分及び加減速パラメ
−タがロボットの典型的な動作に対して前述の手法によ
り定められた値となっている。このうち,ロボットア−
ムの質量配分は各機構の動力学式における動的干渉項,
遠心トルク項,コリオリトルク項を完全に打ち消す値よ
りも小さい特徴を有する。図中では,水平多関節型ロボ
ットについては4自由度の場合,垂直多関節型ロボット
については6自由度の場合を示したが,手首の姿勢決め
自由度が不足した場合すなわち水平多関節型ロボットに
ついてはひねり軸のない3自由度の場合,垂直多関節型
ロボットについては3自由度,4自由度,5自由度の場
合,及び手首の姿勢決め自由度がより多い場合について
も同様のことが成り立つ。
Next, an embodiment of the robot with specific mass distribution according to the present invention will be described with reference to FIGS. 34 and 35. FIG. 34
Shows the structure of a horizontal articulated robot with specific mass distribution, and FIG. 35 shows the structure of a vertical articulated robot with specific mass distribution. In FIG. 34, horizontal articulated robots with specific mass distribution are shown classified by the horizontal motion mechanism and vertical motion mechanism, and in FIG. 35, vertical articulated robots with specific mass distribution are classified by the vertical in-plane motion mechanism. It is shown. In the figure, Mi indicates the position of the i-axis motor (which may be directly connected to the speed reducer). The same effect is realized by installing the wrist drive motor at a position corresponding to when the additional mass is attached. In these robots, the mass distribution and the acceleration / deceleration parameters of the robot arm that realizes the effect equivalent to the added mass have the values determined by the above-described method with respect to the typical operation of the robot. Of these, the robot arm
The mass distribution of the system is the dynamic interference term in the dynamic equation of each mechanism,
It is smaller than the value that completely cancels the centrifugal torque term and Coriolis torque term. In the figure, the horizontal articulated robot has four degrees of freedom and the vertical articulated robot has six degrees of freedom. For 3 degrees of freedom with no twist axis, 3 degrees of freedom, 4 degrees of freedom, 5 degrees of freedom for vertical articulated robots, and more degrees of freedom for posture determination of the wrist. It holds.

【0065】[0065]

【発明の効果】本発明の軸間干渉のある多軸機構の質量
配分決定法はは上記実施例で述べたように下記のような
効果を奏する。
The mass distribution determining method for a multi-axis mechanism having inter-axis interference according to the present invention has the following effects as described in the above embodiments.

【0066】(1)ロボットの高速動作を実現するため
に付加質量を含むロボットア−ムの質量配分を一意に決
めることができる。
(1) The mass distribution of the robot arm including the additional mass can be uniquely determined in order to realize the high speed operation of the robot.

【0067】(2)ロボットア−ムの付加質量を従来技
術の理論値より小さくすることにより,ロボット本体全
体の軽量化を図ることができる。
(2) By making the added mass of the robot arm smaller than the theoretical value of the prior art, the weight of the entire robot body can be reduced.

【0068】(3)ロボットの典型的な動作条件{動作
開始点座標,動作終了点座標,動作デュ−ティ,手先負
荷質量}に対して付加質量パラメ−タ,加減速パラメ−
タを同時に決めることにより,ロボットの最短時間動作
を著しい残留振動を発生することなく実現できる。
(3) Additional mass parameters and acceleration / deceleration parameters for typical robot operating conditions {motion start point coordinates, motion end point coordinates, motion duty, hand load mass}
By simultaneously determining the parameters, the robot can be operated in the shortest time without generating significant residual vibration.

【図面の簡単な説明】[Brief description of drawings]

【図1】本発明の軸間干渉のある多軸機構の質量配分決
定法のフロ−チャ−ト図である。
FIG. 1 is a flowchart of a method for determining mass distribution of a multi-axis mechanism with inter-axis interference according to the present invention.

【図2】本発明の付加質量装着ロボットの外観図を示す
斜視図である。
FIG. 2 is a perspective view showing an external view of the additional mass mounting robot of the present invention.

【図3】図2に示すロボットの剛体モデルを示す図であ
る。
FIG. 3 is a diagram showing a rigid body model of the robot shown in FIG.

【図4】モ−タの発生可能最大トルク・速度の関係例を
示す特性図である。
FIG. 4 is a characteristic diagram showing an example of the relationship between the maximum torque and speed at which a motor can be generated.

【図5】モ−タ直結エンコ−ダ部の温度上昇特性例を示
す特性図である。
FIG. 5 is a characteristic diagram showing an example of a temperature rise characteristic of a motor direct connection encoder section.

【図6】本発明の動作パタ−ン例を示す図である。FIG. 6 is a diagram showing an example of an operation pattern of the present invention.

【図7】モ−タの加減速パタ−ン例を示す図である。FIG. 7 is a diagram showing an example of a motor acceleration / deceleration pattern.

【図8】モ−タの動作デュ−ティを説明する特性図であ
る。
FIG. 8 is a characteristic diagram for explaining the operation duty of the motor.

【図9】本発明の質量配分決定法適用前の図2のロボッ
トの1軸モ−タ所要トルクの時間変化の例を示す特性図
である。
FIG. 9 is a characteristic diagram showing an example of a time change of the required torque of the uniaxial motor of the robot of FIG. 2 before applying the mass distribution determining method of the present invention.

【図10】本発明の質量配分決定法適用前の図2のロボ
ットの2軸モ−タ所要トルクの時間変化の例を示す特性
図である。
FIG. 10 is a characteristic diagram showing an example of a change over time in the required torque of the biaxial motor of the robot of FIG. 2 before applying the mass distribution determination method of the present invention.

【図11】本発明の質量配分決定法適用後の図2のロボ
ットの1軸モ−タ所要トルクの時間変化の例を示す特性
図である。
11 is a characteristic diagram showing an example of a change over time in the required torque of the uniaxial motor of the robot of FIG. 2 after applying the mass distribution determination method of the present invention.

【図12】本発明の質量配分決定法適用後の図2のロボ
ットの2軸モ−タ所要トルクの時間変化の例を示す特性
図である。
FIG. 12 is a characteristic diagram showing an example of a temporal change in required torque of the biaxial motor of the robot of FIG. 2 after applying the mass distribution determining method of the present invention.

【図13】本発明の軸間干渉のある多軸機構の加減速特
徴パラメ−タ決定法のフロ−チャ−ト図である。
FIG. 13 is a flowchart of the method for determining the acceleration / deceleration characteristic parameter of the multi-axis mechanism with inter-axis interference according to the present invention.

【図14】モ−タの加減速パタ−ンの一例としての台形
速度パタ−ンを示す特性図である。
FIG. 14 is a characteristic diagram showing a trapezoidal speed pattern as an example of a motor acceleration / deceleration pattern.

【図15】モ−タの加減速パタ−ンの一例としての指数
乗正弦波速度パタ−ンを示す特性図である。
FIG. 15 is a characteristic diagram showing an exponential sine wave velocity pattern as an example of a motor acceleration / deceleration pattern.

【図16】本発明の加減速特徴パラメ−タ決定法適用後
の図2のロボットの1軸モ−タ所要トルクの時間変化の
例を示す特性図である。
16 is a characteristic diagram showing an example of a time change of the required torque of the uniaxial motor of the robot of FIG. 2 after applying the acceleration / deceleration characteristic parameter determination method of the present invention.

【図17】本発明の加減速特徴パラメ−タ決定法適用後
の図2のロボットの2軸モ−タ所要トルクの時間変化の
例を示す特性図である。
FIG. 17 is a characteristic diagram showing an example of a temporal change in required torque of the biaxial motor of the robot of FIG. 2 after applying the acceleration / deceleration characteristic parameter determination method of the present invention.

【図18】本発明の軸間干渉のある多軸機構の加減速特
徴パラメ−タ決定法のフロ−チャ−ト図である。
FIG. 18 is a flowchart of the acceleration / deceleration characteristic parameter determination method for a multi-axis mechanism with inter-axis interference according to the present invention.

【図19】本発明の質量配分・加減速特徴パラメ−タ同
時決定法適用後の図2のロボットの1軸モ−タ所要トル
クの時間変化の例を示す特性図である。
FIG. 19 is a characteristic diagram showing an example of a change over time in torque required for the uniaxial motor of the robot of FIG. 2 after applying the method for simultaneously determining mass distribution / acceleration / deceleration characteristic parameters of the present invention.

【図20】本発明の質量配分・加減速特徴パラメ−タ同
時決定法適用後の図2のロボットの2軸モ−タ所要トル
クの時間変化の例を示す特性図である。
FIG. 20 is a characteristic diagram showing an example of a change over time in the required torque of the biaxial motor of the robot of FIG. 2 after applying the method for simultaneously determining mass distribution / acceleration / deceleration characteristic parameters of the present invention.

【図21】本発明の質量配分・加減速特徴パラメ−タ同
時決定法適用後の図2のロボットの1軸・2軸モ−タ所
要速度の時間変化の例を示す特性図である。
FIG. 21 is a characteristic diagram showing an example of a change over time in the required speeds of the 1-axis and 2-axis motors of the robot of FIG. 2 after applying the method for simultaneously determining the mass distribution / acceleration / deceleration characteristic parameters of the present invention.

【図22】本発明の質量配分・加減速特徴パラメ−タ同
時決定法適用後の図2のロボットの付加質量パラメ−タ
と動作時間の関係を示す図である。
22 is a diagram showing the relationship between the additional mass parameter and the operation time of the robot of FIG. 2 after applying the method for simultaneously determining the mass distribution / acceleration / deceleration characteristic parameters of the present invention.

【図23】本発明の質量配分・加減速特徴パラメ−タ同
時決定法適用後の図2のロボットの動作時間と動作デュ
−ティの関係を示す特性図である。
FIG. 23 is a characteristic diagram showing the relationship between the operating time and the operating duty of the robot of FIG. 2 after applying the method for simultaneously determining mass distribution / acceleration / deceleration characteristic parameters of the present invention.

【図24】本発明の質量配分・加減速特徴パラメ−タ同
時決定法適用後の図2のロボットの1軸最大速度と動作
デュ−ティの関係を示す特性図である。
FIG. 24 is a characteristic diagram showing the relationship between the maximum speed of one axis and the operation duty of the robot of FIG. 2 after the method for simultaneously determining mass distribution / acceleration / deceleration characteristic parameters of the present invention is applied.

【図25】本発明の質量配分・加減速特徴パラメ−タ同
時決定法適用後の図2のロボットの加速指数と動作デュ
−ティの関係を示す特性図である。
FIG. 25 is a characteristic diagram showing the relationship between the acceleration index and the motion duty of the robot of FIG. 2 after applying the method for simultaneously determining mass distribution / acceleration / deceleration characteristic parameters of the present invention.

【図26】本発明の質量配分・加減速特徴パラメ−タ同
時決定法適用後の図2のロボットの減速指数と動作デュ
−ティの関係を示す特性図である。
FIG. 26 is a characteristic diagram showing the relationship between the deceleration index and the operation duty of the robot of FIG. 2 after applying the method for simultaneously determining mass distribution / acceleration / deceleration characteristic parameters of the present invention.

【図27】本発明の質量配分・加減速特徴パラメ−タ同
時決定法適用後の図2のロボットの無次元加速距離と動
作デュ−ティの関係を示す特性図である。
FIG. 27 is a characteristic diagram showing the relationship between the dimensionless acceleration distance and the operation duty of the robot of FIG. 2 after applying the method for simultaneously determining mass distribution / acceleration / deceleration characteristic parameters of the present invention.

【図28】本発明の質量配分・加減速特徴パラメ−タ同
時決定法適用後の図2のロボットの無次元減速距離と動
作デュ−ティの関係を示す特性図である。
28 is a characteristic diagram showing the relationship between the dimensionless deceleration distance and the motion duty of the robot of FIG. 2 after applying the method for simultaneously determining mass distribution / acceleration / deceleration feature parameters of the present invention.

【図29】本発明の質量配分・加減速特徴パラメ−タ同
時決定法適用後の図2のロボットの付加質量と動作デュ
−ティの関係を示す特性図である。
FIG. 29 is a characteristic diagram showing the relationship between the added mass and the operation duty of the robot of FIG. 2 after applying the method for simultaneously determining mass distribution / acceleration / deceleration characteristic parameters of the present invention.

【図30】本発明の質量配分・加減速特徴パラメ−タ同
時決定法適用後の図2のロボットの付加質量設置位置と
動作デュ−ティの関係を示す特性図である。
FIG. 30 is a characteristic diagram showing a relationship between an additional mass installation position and an operation duty of the robot of FIG. 2 after applying the method for simultaneously determining mass distribution / acceleration / deceleration characteristic parameters of the present invention.

【図31】本発明の付加質量装着水平多関節型ロボット
の構造を示す図である。
FIG. 31 is a diagram showing a structure of a horizontal articulated robot equipped with an additional mass according to the present invention.

【図32】本発明の付加質量装着水平多関節型ロボット
の構造を示す図である。
FIG. 32 is a diagram showing the structure of a horizontal articulated robot equipped with an additional mass according to the present invention.

【図33】本発明の付加質量装着垂直多関節型ロボット
の構造を示す図である。
FIG. 33 is a diagram showing the structure of a vertical articulated robot equipped with an additional mass according to the present invention.

【図34】本発明の特定質量配分具備水平多関節型ロボ
ットの構造を示す図である。
FIG. 34 is a view showing the structure of a horizontal articulated robot with specific mass distribution according to the present invention.

【図35】本発明の特定質量配分具備垂直多関節型ロボ
ットの構造を示す図である。
FIG. 35 is a view showing the structure of a vertical articulated robot with specific mass distribution according to the present invention.

【符号の説明】[Explanation of symbols]

1…1軸モ−タ,2…第1ア−ム,3…2軸モ−タ,4
…第2ア−ム,5…手首軸,6…付加質量。
1 ... 1-axis motor, 2 ... 1st arm, 3 ... 2-axis motor, 4
... 2nd arm, 5 ... Wrist shaft, 6 ... Additional mass.

───────────────────────────────────────────────────── フロントページの続き (51)Int.Cl.6 識別記号 庁内整理番号 FI 技術表示箇所 G05D 3/12 305 V 9179−3H 306 R 9179−3H (54)【発明の名称】 多軸機構の質量配分決定法,加減速特徴パラメ−タ決定法,質量配分・加減速特徴パラメ−タ同 時決定法,前記質量配分決定法に基づく質量配分を有する付加質量装着ロボット及び特定質量配 分具備ロボット─────────────────────────────────────────────────── ─── Continuation of the front page (51) Int.Cl. 6 Identification code Internal reference number FI Technical indication location G05D 3/12 305 V 9179-3H 306 R 9179-3H (54) [Title of invention] Multi-axis mechanism Mass distribution determination method, acceleration / deceleration characteristic parameter determination method, mass distribution / acceleration / deceleration characteristic parameter simultaneous determination method, additional mass mounting robot having mass distribution based on the mass distribution determination method, and specific mass distribution robot

Claims (63)

【特許請求の範囲】[Claims] 【請求項1】軸間干渉のある多軸機構の質量配分決定法
において,多軸機構の機構諸元,モ−タ特性関数,動作
条件(動作開始点,動作終了点,動作デュ−ティ,手先
負荷質量),及び加減速特徴パラメ−タの与えられた駆
動モ−タの加減速パタ−ンに対して,動力学式干渉項の
加速度に対する係数の絶対値を低減可能な付加質量装着
を想定した付加質量パラメ−タ(質量及び設置位置)を
モ−タの最大トルク−速度特性及びモ−タの温度上昇が
ネックとなる部位の温度上昇許容値とモ−タ所要平均ト
ルク・所要平均速度の関係を考慮してそれらの余裕が最
大となるように決定し,そのような質量配分とすること
を特徴とする軸間干渉のある多軸機構の質量配分決定
法。
1. A mass distribution determination method for a multi-axis mechanism having inter-axis interference, wherein the mechanical specifications of the multi-axis mechanism, a motor characteristic function, and operating conditions (starting point, end point, operating duty, Load mass) and acceleration / deceleration pattern of the drive motor to which the acceleration / deceleration characteristic parameters are given, with additional mass attachment that can reduce the absolute value of the coefficient of the dynamic interference term to the acceleration. Assuming the additional mass parameters (mass and installation position), the maximum torque-speed characteristics of the motor and the allowable temperature rise of the part where the temperature rise of the motor becomes a bottleneck, and the required average torque and required average of the motor A method for determining the mass distribution of a multi-axis mechanism with inter-axis interference, characterized in that the margins are determined in consideration of the speed relationship so as to maximize the margin, and such mass distribution is adopted.
【請求項2】軸間干渉のある多軸機構の加減速特徴パラ
メ−タ決定法において,多軸機構の機構諸元,モ−タ特
性関数,及び動作条件(動作開始点,動作終了点,動作
デュ−ティ,手先負荷質量)に対して,駆動モ−タの加
減速パタ−ンの加減速特徴パラメ−タを,モ−タの最大
トルク−速度特性及びモ−タの温度上昇がネックとなる
部位の温度上昇許容値とモ−タ所要平均トルク・所要平
均速度の関係を考慮してそれらの余裕が最小となり,動
作時間を最短とできるように決定することを特徴とする
軸間干渉のある多軸機構の加減速特徴パラメ−タ決定
法。
2. A method for determining acceleration / deceleration characteristic parameters of a multi-axis mechanism having inter-axis interference, wherein the mechanical specifications of the multi-axis mechanism, a motor characteristic function, and operating conditions (starting point, end point of operation, Acceleration / deceleration characteristic parameters of the drive motor, the maximum torque-speed characteristic of the motor and the temperature rise of the motor The inter-axis interference is characterized in that the margins are minimized by taking into consideration the relationship between the allowable temperature rise value of the part to be controlled and the required average torque and required average speed of the motor, and the operating time is minimized. Acceleration / deceleration characteristic parameter determination method for multi-axis mechanism.
【請求項3】軸間干渉のある多軸機構の質量配分・加減
速特徴パラメ−タ同時決定法において,多軸機構の機構
諸元,モ−タ特性関数,及び動作条件(動作開始点,動
作終了点,動作デュ−ティ,手先負荷質量)に対して,
動力学式干渉項の加速度に対する係数の絶対値を低減可
能な付加質量装着を想定した付加質量パラメ−タ(質量
及び設置位置)及び駆動モ−タの加減速パタ−ンの加減
速特徴パラメ−タを,モ−タの最大トルク−速度特性及
びモ−タの温度上昇がネックとなる部位の温度上昇許容
値とモ−タ所要平均トルク・所要平均速度の関係を考慮
してそれらの余裕が最小となり,動作時間を最短とでき
るように決定することを特徴とする軸間干渉のある多軸
機構の質量配分・加減速特徴パラメ−タ同時決定法。
3. A mass distribution / acceleration / deceleration characteristic parameter simultaneous determination method for a multi-axis mechanism having inter-axis interference, in which the mechanical specifications of the multi-axis mechanism, a motor characteristic function, and operating conditions (starting point, End point, operation duty, hand load mass)
Additional mass parameters (mass and installation position) and additional acceleration / deceleration characteristic parameters of the drive motor acceleration / deceleration pattern assuming the installation of an additional mass that can reduce the absolute value of the coefficient of the dynamical interference term for acceleration Considering the relationship between the maximum torque-speed characteristics of the motor and the allowable temperature rise of the motor where the temperature rise of the motor becomes a bottleneck, and the required average torque and required average speed of the motor, their margins are set. A method for simultaneous determination of mass distribution / acceleration / deceleration characteristic parameters of a multi-axis mechanism with inter-axis interference, which is characterized by minimizing the operation time.
【請求項4】ベ−スに設置された1軸モ−タより直接も
しくは減速機を介して連結された第1ア−ムを鉛直方向
軸まわりに回転駆動し,第1ア−ム先端に設置された2
軸モ−タより直接もしくは減速機を介して連結された第
2ア−ムを鉛直方向軸まわりに回転駆動し,第2ア−ム
先端に設けられた手首軸の上下動作のみもしくは上下・
ひねり動作を実現する手首駆動機構を有する水平多関節
型ロボットにおいて,機構諸元,モ−タ特性関数,動作
条件(動作開始点,動作終了点,動作デュ−ティ,手先
負荷質量),及び加減速特徴パラメ−タの与えられた駆
動モ−タの加減速パタ−ンに対して,動力学式干渉項の
加速度に対する係数の絶対値を低減可能な付加質量装着
を想定した付加質量パラメ−タ(質量及び設置位置)を
モ−タの最大トルク−速度特性及びモ−タの温度上昇が
ネックとなる部位の温度上昇許容値とモ−タ所要平均ト
ルク・所要平均速度の関係を考慮してそれらの余裕が最
大となるように,第2ア−ムの2軸出力軸に対して手首
軸とは反対側に固定型もしくは着脱可能な付加質量を設
けて構成したことを特徴とする付加質量装着ロボット。
4. A first arm connected directly from a single-axis motor installed on a base or via a speed reducer is rotationally driven about a vertical axis, and is attached to the tip of the first arm. Installed 2
A second arm connected directly from the shaft motor or via a speed reducer is driven to rotate about a vertical axis, and only the vertical movement of the wrist shaft provided at the tip of the second arm or vertical movement
In a horizontal articulated robot with a wrist drive mechanism that realizes a twisting motion, the mechanical specifications, motor characteristic function, motion condition (motion start point, motion end point, motion duty, hand load mass), and An additional mass parameter assuming an additional mass attachment that can reduce the absolute value of the coefficient of the dynamical interference term for acceleration with respect to the acceleration / deceleration pattern of the drive motor to which the deceleration characteristic parameter is given. (Mass and installation position) should be considered in consideration of the maximum torque-speed characteristics of the motor and the allowable temperature rise value of the part where the temperature rise of the motor becomes a bottleneck and the required average torque and required average speed of the motor. The additional mass is characterized in that a fixed type or a removable additional mass is provided on the side opposite to the wrist shaft with respect to the biaxial output shaft of the second arm so that these margins are maximized. Wearing robot.
【請求項5】ベ−スに設置された1軸モ−タより直接も
しくは減速機を介して連結された第1ア−ムを鉛直方向
軸まわりに回転駆動し,第1ア−ム先端に設置された2
軸モ−タより直接もしくは減速機を介して連結された第
2ア−ムを鉛直方向軸まわりに回転駆動し,第2ア−ム
先端に設けられた手首軸の上下動作のみもしくは上下・
ひねり動作を実現する手首駆動機構を有する水平多関節
型ロボットにおいて,機構諸元,モ−タ特性関数,及び
動作条件(動作開始点,動作終了点,動作デュ−ティ,
手先負荷質量)に対して,動力学式干渉項の加速度に対
する係数の絶対値を低減可能な付加質量装着を想定した
付加質量パラメ−タ(質量及び設置位置)及び駆動モ−
タの加減速パタ−ンの加減速特徴パラメ−タを,モ−タ
の最大トルク−速度特性及びモ−タの温度上昇がネック
となる部位の温度上昇許容値とモ−タ所要平均トルク・
所要平均速度の関係を考慮してそれらの余裕が最小とな
り,動作時間を最短とできるように,第2ア−ムの2軸
出力軸に対して手首軸とは反対側に固定型もしくは着脱
可能な付加質量を設けて構成したことを特徴とする付加
質量装着ロボット。
5. A first arm connected directly from a single-axis motor installed on a base or via a speed reducer is rotationally driven about a vertical axis, and is attached to the tip of the first arm. Installed 2
A second arm connected directly from the shaft motor or via a speed reducer is driven to rotate about a vertical axis, and only the vertical movement of the wrist shaft provided at the tip of the second arm or vertical movement
In a horizontal articulated robot with a wrist drive mechanism that realizes a twisting motion, mechanical specifications, motor characteristic functions, and motion conditions (motion start point, motion end point, motion duty,
Load mass parameters (mass and installation position) and drive mode assuming additional mass attachment that can reduce the absolute value of the coefficient of the dynamical interference term for the acceleration
Acceleration / deceleration pattern of the motor The parameter parameters are the maximum torque-speed characteristics of the motor and the allowable temperature rise of the part where the temperature rise of the motor becomes a bottleneck and the average torque required for the motor.
In consideration of the relationship between the required average speeds, their margins are minimized, and the operation time can be minimized, so that it can be fixed or detached on the side opposite to the wrist axis with respect to the 2 axis output axis of the 2nd arm. An additional mass mounting robot characterized by being configured with various additional masses.
【請求項6】ベ−スに設置された上下軸駆動モ−タによ
り直接もしくは減速機を介して連結された非回転ベ−ス
に設置された1軸モ−タより直接もしくは減速機を介し
て連結された第1ア−ムを鉛直方向軸まわりに回転駆動
し,第1ア−ム先端に設置された2軸モ−タより直接も
しくは減速機を介して連結された第2ア−ムを鉛直方向
軸まわりに回転駆動し,第2ア−ム先端に設けられた固
定構造もしくはひねり動作を実現する手首駆動機構を有
する手首からなる水平多関節型ロボットにおいて,機構
諸元,モ−タ特性関数,動作条件(動作開始点,動作終
了点,動作デュ−ティ,手先負荷質量),及び加減速特
徴パラメ−タの与えられた駆動モ−タの加減速パタ−ン
に対して,動力学式干渉項の加速度に対する係数の絶対
値を低減可能な付加質量装着を想定した付加質量パラメ
−タ(質量及び設置位置)をモ−タの最大トルク−速度
特性及びモ−タの温度上昇がネックとなる部位の温度上
昇許容値とモ−タ所要平均トルク・所要平均速度の関係
を考慮してそれらの余裕が最大となるように,第2ア−
ムの2軸出力軸に対して手首とは反対側に固定型もしく
は着脱可能な付加質量を設けて構成したことを特徴とす
る付加質量装着ロボット。
6. A single-axis motor installed on a non-rotating base directly or via a speed reducer, which is connected directly or via a speed reducer to a vertical shaft drive motor installed on the base. The second arm connected to the first arm connected to the first arm is rotated about a vertical axis and connected directly from a two-axis motor installed at the tip of the first arm or via a speed reducer. In a horizontal articulated robot consisting of a wrist with a wrist drive mechanism that realizes a fixed structure provided at the tip of the second arm or a twisting motion by rotating the arm around a vertical axis, the mechanical specifications and motor Characteristic function, operating condition (start point, end point, duty, hand load mass), and acceleration / deceleration pattern of the drive motor with acceleration / deceleration characteristic parameters It is possible to reduce the absolute value of the coefficient of the scientific term for the acceleration. Additional mass parameters (mass and installation position) assuming mass mounting are used as the maximum torque-speed characteristics of the motor and the allowable temperature rise of the part where the temperature rise of the motor becomes a bottleneck and the average torque required by the motor.・ Consider the relationship between the required average speeds so that the margins are maximized.
An additional mass mounting robot characterized in that a fixed type or a removable additional mass is provided on the side opposite to the wrist with respect to the biaxial output shaft of the robot.
【請求項7】ベ−スに設置された上下軸駆動モ−タによ
り直接もしくは減速機を介して連結された非回転ベ−ス
に設置された1軸モ−タより直接もしくは減速機を介し
て連結された第1ア−ムを鉛直方向軸まわりに回転駆動
し,第1ア−ム先端に設置された2軸モ−タより直接も
しくは減速機を介して連結された第2ア−ムを鉛直方向
軸まわりに回転駆動し,第2ア−ム先端に設けられた固
定構造もしくはひねり動作を実現する手首駆動機構を有
する手首からなる水平多関節型ロボットにおいて,機構
諸元,モ−タ特性関数,及び動作条件(動作開始点,動
作終了点,動作デュ−ティ,手先負荷質量)に対して,
動力学式干渉項の加速度に対する係数の絶対値を低減可
能な付加質量装着を想定した付加質量パラメ−タ(質量
及び設置位置)及び駆動モ−タの加減速パタ−ンの加減
速特徴パラメ−タを,モ−タの最大トルク−速度特性及
びモ−タの温度上昇がネックとなる部位の温度上昇許容
値とモ−タ所要平均トルク・所要平均速度の関係を考慮
してそれらの余裕が最小となり,動作時間を最短とでき
るように,第2ア−ムの2軸出力軸に対して手首とは反
対側に固定型もしくは着脱可能な付加質量を設けて構成
したことを特徴とする付加質量装着ロボット。
7. A single-axis motor installed on a non-rotating base directly or via a speed reducer connected by a vertical shaft drive motor installed on the base or via a speed reducer. The second arm connected to the first arm connected to the first arm is rotated about a vertical axis and connected directly from a two-axis motor installed at the tip of the first arm or via a speed reducer. In a horizontal articulated robot consisting of a wrist with a wrist drive mechanism that realizes a fixed structure provided at the tip of the second arm or a twisting motion by rotating the arm around a vertical axis, the mechanical specifications and motor For the characteristic function and operating conditions (operation start point, operation end point, operation duty, hand load mass),
Additional mass parameters (mass and installation position) and additional acceleration / deceleration characteristic parameters of the drive motor acceleration / deceleration pattern assuming the installation of an additional mass that can reduce the absolute value of the coefficient of the dynamical interference term for acceleration Considering the relationship between the maximum torque-speed characteristics of the motor and the allowable temperature rise of the motor where the temperature rise of the motor becomes a bottleneck, and the required average torque and required average speed of the motor, their margins are set. In order to minimize the operation time and minimize the operation time, a fixed type or a removable additional mass is provided on the side opposite to the wrist with respect to the biaxial output shaft of the second arm. Mass loading robot.
【請求項8】ベ−スに設置された1軸モ−タより直接も
しくは減速機を介して連結された1軸モ−タより直接も
しくは減速機を介して連結された第1ア−ムを鉛直方向
軸まわりに回転駆動し,第1ア−ムの1軸出力軸と同軸
上に設置された2軸モ−タより直接もしくは減速機を介
して連結された第2ア−ムを鉛直方向軸まわりに回転駆
動し,その先端に回転可能に設けられ第1ア−ムと平行
に動作する第3ア−ム,第3ア−ム先端と第2ア−ム先
端に回転可能に設けられた,手首軸の上下動作のみもし
くは上下・ひねり動作を実現する手首駆動機構を有する
第4ア−ムからなる水平多関節型ロボットにおいて,機
構諸元,モ−タ特性関数,動作条件(動作開始点,動作
終了点,動作デュ−ティ,手先負荷質量),及び加減速
特徴パラメ−タの与えられた駆動モ−タの加減速パタ−
ンに対して,動力学式干渉項の加速度に対する係数の絶
対値を低減可能な付加質量装着を想定した付加質量パラ
メ−タ(質量及び設置位置)をモ−タの最大トルク−速
度特性及びモ−タの温度上昇がネックとなる部位の温度
上昇許容値とモ−タ所要平均トルク・所要平均速度の関
係を考慮してそれらの余裕が最大となるように,第2ア
−ム及びもしくは第3ア−ム及びもしくは第4ア−ムに
固定型もしくは着脱可能な付加質量を設けて構成したこ
とを特徴とする付加質量装着ロボット。
8. A first arm connected directly from a single-axis motor installed via a base or via a speed reducer to the first arm connected directly or via a speed reducer. It is driven to rotate about the vertical axis, and the second arm connected directly from the two-axis motor installed coaxially with the one-axis output shaft of the first arm or through a speed reducer is connected in the vertical direction. A third arm, which is rotatably driven around an axis, is rotatably provided at its tip, and is rotatably provided at a third arm tip and a second arm tip, which operate in parallel with the first arm. In addition, in a horizontal articulated robot consisting of a fourth arm having a wrist drive mechanism that realizes only vertical movement of the wrist axis or vertical / twist movements, the mechanical specifications, the motor characteristic function, the operating conditions (start of operation) Point, operation end point, operation duty, hand load mass), and acceleration / deceleration characteristic parameters It gills the drive motor - other acceleration and deceleration pattern -
In addition, the additional mass parameters (mass and installation position) assuming the mounting of an additional mass that can reduce the absolute value of the coefficient of the dynamical interference term with respect to the acceleration are set to the maximum torque-speed characteristics of the motor and the motor. -The second arm and / or the second arm and / or the second arm and / or the second arm and / or An additional mass mounting robot characterized in that a fixed type or a removable additional mass is provided to the 3 arm and / or the 4th arm.
【請求項9】ベ−スに設置された1軸モ−タより直接も
しくは減速機を介して連結された1軸モ−タより直接も
しくは減速機を介して連結された第1ア−ムを鉛直方向
軸まわりに回転駆動し,第1ア−ムの1軸出力軸と同軸
上に設置された2軸モ−タより直接もしくは減速機を介
して連結された第2ア−ムを鉛直方向軸まわりに回転駆
動し,その先端に回転可能に設けられ第1ア−ムと平行
に動作する第3ア−ム,第3ア−ム先端と第2ア−ム先
端に回転可能に設けられた,手首軸の上下動作のみもし
くは上下・ひねり動作を実現する手首駆動機構を有する
第4ア−ムからなる水平多関節型ロボットにおいて,機
構諸元,モ−タ特性関数,及び動作条件(動作開始点,
動作終了点,動作デュ−ティ,手先負荷質量)に対し
て,動力学式干渉項の加速度に対する係数の絶対値を低
減可能な付加質量装着を想定した付加質量パラメ−タ
(質量及び設置位置)及び駆動モ−タの加減速パタ−ン
の加減速特徴パラメ−タを,モ−タの最大トルク−速度
特性及びモ−タの温度上昇がネックとなる部位の温度上
昇許容値とモ−タ所要平均トルク・所要平均速度の関係
を考慮してそれらの余裕が最小となり,動作時間を最短
とできるように,第2ア−ム及びもしくは第3ア−ム及
びもしくは第4ア−ムに固定型もしくは着脱可能な付加
質量を設けて構成したことを特徴とする付加質量装着ロ
ボット。
9. A first arm connected directly from a single-axis motor installed via a base or via a speed reducer to the first arm connected to the single-axis motor directly or via a speed reducer. It is driven to rotate about the vertical axis, and the second arm connected directly from the two-axis motor installed coaxially with the one-axis output shaft of the first arm or through a speed reducer is connected in the vertical direction. A third arm, which is rotatably driven around an axis, is rotatably provided at its tip, and is rotatably provided at a third arm tip and a second arm tip, which operate in parallel with the first arm. In addition, in a horizontal articulated robot consisting of a fourth arm having a wrist drive mechanism that realizes only vertical movement of the wrist axis or vertical / twist movements, the mechanical specifications, motor characteristic functions, and operating conditions Starting point,
Additional mass parameters (mass and installation position) assuming additional mass mounting that can reduce the absolute value of the coefficient of the dynamic interference term for acceleration with respect to the operation end point, operation duty, and hand load mass) And the acceleration / deceleration characteristic parameters of the drive motor, the maximum torque-speed characteristics of the motor and the allowable temperature rise of the part where the temperature rise of the motor becomes a bottleneck and the motor. It is fixed to the 2nd arm and / or the 3rd arm and / or the 4th arm so that their margins are minimized in consideration of the relationship between the required average torque and the required average speed, and the operating time can be minimized. An additional mass mounting robot, characterized in that it is configured by providing a mold or a removable additional mass.
【請求項10】ベ−スに設置された上下軸駆動モ−タに
より直接もしくは減速機を介して連結された非回転ベ−
スに設置された1軸モ−タより直接もしくは減速機を介
して連結された第1ア−ムを鉛直方向軸まわりに回転駆
動し,第1ア−ムの1軸出力軸と同軸上に設置された2
軸モ−タより直接もしくは減速機を介して連結された第
2ア−ムを鉛直方向軸まわりに回転駆動し,その先端に
回転可能に設けられ第1ア−ムと平行に動作する第3ア
−ム,第3ア−ム先端と第2ア−ム先端に回転可能に設
けられ,先端に固定構造もしくはひねり動作を実現する
手首駆動機構を有する手首を有する第4ア−ムからなる
水平多関節型ロボットにおいて,機構諸元,モ−タ特性
関数,動作条件(動作開始点,動作終了点,動作デュ−
ティ,手先負荷質量),及び加減速特徴パラメ−タの与
えられた駆動モ−タの加減速パタ−ンに対して,動力学
式干渉項の加速度に対する係数の絶対値を低減可能な付
加質量装着を想定した付加質量パラメ−タ(質量及び設
置位置)をモ−タの最大トルク−速度特性及びモ−タの
温度上昇がネックとなる部位の温度上昇許容値とモ−タ
所要平均トルク・所要平均速度の関係を考慮してそれら
の余裕が最大となるように,第2ア−ム及びもしくは第
3ア−ム及びもしくは第4ア−ムに,固定型もしくは着
脱可能な付加質量を設けて構成したことを特徴とする付
加質量装着ロボット。
10. A non-rotating base connected directly or through a speed reducer by a vertical drive motor installed on the base.
The first arm connected directly from the single-axis motor installed in the space or via a reducer is driven to rotate around the vertical axis, and is coaxial with the single-axis output shaft of the first arm. Installed 2
A third arm, which is rotatably driven around a vertical axis about a second arm connected directly from the shaft motor or through a speed reducer, and is rotatably provided at the tip of the second arm and operates in parallel with the first arm. A horizontal arm consisting of a fourth arm which is rotatably provided at the tip of the arm, the third arm and the tip of the second arm, and has a wrist having a fixed structure or a wrist drive mechanism for realizing a twisting motion at the tip. In an articulated robot, mechanical specifications, motor characteristic functions, operating conditions (starting point, end point, operating duty
(Tee, hand load mass) and acceleration / deceleration pattern of the drive motor given the acceleration / deceleration characteristic parameters. The additional mass parameters (mass and installation position) that are assumed to be mounted are set to the maximum torque-speed characteristics of the motor and the allowable temperature rise of the part where the temperature rise of the motor becomes a bottleneck and the average torque required for the motor. The second arm and / or the third arm and / or the fourth arm is provided with a fixed type or a removable additional mass so that the margins thereof are maximized in consideration of the relationship of the required average speed. A robot equipped with an additional mass characterized by being configured as follows.
【請求項11】ベ−スに設置された上下軸駆動モ−タに
より直接もしくは減速機を介して連結された非回転ベ−
スに設置された1軸モ−タより直接もしくは減速機を介
して連結された第1ア−ムを鉛直方向軸まわりに回転駆
動し,第1ア−ムの1軸出力軸と同軸上に設置された2
軸モ−タより直接もしくは減速機を介して連結された第
2ア−ムを鉛直方向軸まわりに回転駆動し,その先端に
回転可能に設けられ第1ア−ムと平行に動作する第3ア
−ム,第3ア−ム先端と第2ア−ム先端に回転可能に設
けられ,先端に固定構造もしくはひねり動作を実現する
手首駆動機構を有する手首を有する第4ア−ムからなる
水平多関節型ロボットにおいて,機構諸元,モ−タ特性
関数,及び動作条件(動作開始点,動作終了点,動作デ
ュ−ティ,手先負荷質量)に対して,動力学式干渉項の
加速度に対する係数の絶対値を低減可能な付加質量装着
を想定した付加質量パラメ−タ(質量及び設置位置)及
び駆動モ−タの加減速パタ−ンの加減速特徴パラメ−タ
を,モ−タの最大トルク−速度特性及びモ−タの温度上
昇がネックとなる部位の温度上昇許容値とモ−タ所要平
均トルク・所要平均速度の関係を考慮してそれらの余裕
が最小となり,動作時間を最短とできるように,第2ア
−ム及びもしくは第3ア−ム及びもしくは第4ア−ム
に,固定型もしくは着脱可能な付加質量を設けて構成し
たことを特徴とする付加質量装着ロボット。
11. A non-rotating base connected directly or via a speed reducer by a vertical shaft driving motor installed on the base.
The first arm connected directly from the single-axis motor installed in the space or via a reducer is driven to rotate around the vertical axis, and is coaxial with the single-axis output shaft of the first arm. Installed 2
A third arm, which is rotatably driven around a vertical axis about a second arm connected directly from the shaft motor or through a speed reducer, and is rotatably provided at the tip of the second arm and operates in parallel with the first arm. A horizontal arm consisting of a fourth arm which is rotatably provided at the tip of the arm, the third arm and the tip of the second arm, and has a wrist having a fixed structure or a wrist drive mechanism for realizing a twisting motion at the tip. In an articulated robot, the coefficient to the acceleration of the dynamical interference term for the mechanical specifications, the motor characteristic function, and the operating conditions (start point, end point, duty, hand load mass) The additional mass parameters (mass and installation position) and the acceleration / deceleration pattern parameters of the drive motor, which are assumed to be mounted with additional mass that can reduce the absolute value of the -Velocity characteristics and motor temperature rise are bottlenecks The second arm and / or the third arm are designed so that their margins are minimized and the operating time can be minimized in consideration of the relationship between the allowable temperature rise value of each unit and the required average torque and required average speed of the motor. An additional mass mounting robot characterized in that a fixed type or a removable additional mass is provided to the arm and / or the fourth arm.
【請求項12】ベ−スに設置された1軸モ−タより直接
もしくは減速機を介して連結された1軸モ−タより直接
もしくは減速機を介して連結された第1ア−ムを鉛直方
向軸まわりに回転駆動し,ベ−スに第1ア−ムの1軸出
力軸と同軸上に設置された2軸モ−タより直接もしくは
減速機を介して連結された第2ア−ムを鉛直方向軸まわ
りに回転駆動し,その先端に回転可能に設けられ第1ア
−ムと平行に動作する第3ア−ム,第3ア−ム先端と第
2ア−ム先端に回転可能に設けられた,手首軸の上下動
作のみもしくは上下・ひねり動作を実現する手首駆動機
構を有する第4ア−ムからなる水平多関節型ロボットに
おいて,機構諸元,モ−タ特性関数,動作条件(動作開
始点,動作終了点,動作デュ−ティ,手先負荷質量),
及び加減速特徴パラメ−タの与えられた駆動モ−タの加
減速パタ−ンに対して,動力学式干渉項の加速度に対す
る係数の絶対値を低減可能な付加質量装着を想定した付
加質量パラメ−タ(質量及び設置位置)をモ−タの最大
トルク−速度特性及びモ−タの温度上昇がネックとなる
部位の温度上昇許容値とモ−タ所要平均トルク・所要平
均速度の関係を考慮してそれらの余裕が最大となるよう
に,第2ア−ム及びもしくは第3ア−ム及びもしくは第
4ア−ムに固定型もしくは着脱可能な付加質量を設けて
構成したことを特徴とする付加質量装着ロボット。
12. A first arm connected directly from a single-axis motor installed via a base or via a speed reducer to the first arm connected directly or via a speed reducer. A second arm that is driven to rotate about a vertical axis and is directly connected to the base from a two-axis motor installed coaxially with the one-axis output shaft of the first arm or via a speed reducer. The arm is rotatably driven around a vertical axis, and is rotatably provided at the tip of the arm and rotates to a third arm, a third arm tip and a second arm tip. In the horizontal articulated robot consisting of the 4th arm, which has a wrist drive mechanism that realizes only the vertical movement of the wrist axis or the vertical and twisting movements, the mechanical specifications, the motor characteristic function, and the movement Conditions (operation start point, operation end point, operation duty, hand load mass),
And an additional mass parameter assuming the mounting of an additional mass that can reduce the absolute value of the coefficient of the dynamical interference term with respect to the acceleration for the acceleration / deceleration pattern of the drive motor given the acceleration / deceleration characteristic parameter. -Consider the relationship between the maximum torque and speed characteristics of the motor (mass and installation position), the allowable temperature rise value of the part where the temperature rise of the motor is a bottleneck, and the required average torque and required average speed of the motor. The second arm and / or the third arm and / or the fourth arm is provided with a fixed type or a removable additional mass so that the margins thereof are maximized. Robot with additional mass.
【請求項13】ベ−スに設置された1軸モ−タより直接
もしくは減速機を介して連結された1軸モ−タより直接
もしくは減速機を介して連結された第1ア−ムを鉛直方
向軸まわりに回転駆動し,ベ−スに第1ア−ムの1軸出
力軸と同軸上に設置された2軸モ−タより直接もしくは
減速機を介して連結された第2ア−ムを鉛直方向軸まわ
りに回転駆動し,その先端に回転可能に設けられ第1ア
−ムと平行に動作する第3ア−ム,第3ア−ム先端と第
2ア−ム先端に回転可能に設けられた,手首軸の上下動
作のみもしくは上下・ひねり動作を実現する手首駆動機
構を有する第4ア−ムからなる水平多関節型ロボットに
おいて,機構諸元,モ−タ特性関数,及び動作条件(動
作開始点,動作終了点,動作デュ−ティ,手先負荷質
量)に対して,動力学式干渉項の加速度に対する係数の
絶対値を低減可能な付加質量装着を想定した付加質量パ
ラメ−タ(質量及び設置位置)及び駆動モ−タの加減速
パタ−ンの加減速特徴パラメ−タを,モ−タの最大トル
ク−速度特性及びモ−タの温度上昇がネックとなる部位
の温度上昇許容値とモ−タ所要平均トルク・所要平均速
度の関係を考慮してそれらの余裕が最小となり,動作時
間を最短とできるように,第2ア−ム及びもしくは第3
ア−ム及びもしくは第4ア−ムに固定型もしくは着脱可
能な付加質量を設けて構成したことを特徴とする付加質
量装着ロボット。
13. A first arm connected directly from a single-axis motor installed via a base or via a speed reducer to the first arm connected directly or via a speed reducer. A second arm that is driven to rotate about a vertical axis and is directly connected to the base from a two-axis motor installed coaxially with the one-axis output shaft of the first arm or via a speed reducer. The arm is rotatably driven around a vertical axis, and is rotatably provided at the tip of the arm and rotates to a third arm, a third arm tip and a second arm tip. In a horizontal articulated robot consisting of a fourth arm, which has a wrist drive mechanism that realizes only vertical movement or vertical / twist movement of the wrist axis, the mechanical specifications, motor characteristic function, and Power for operating conditions (starting point, ending point, duty, hand load mass) The additional mass parameters (mass and installation position) and the acceleration / deceleration characteristic parameters of the acceleration / deceleration pattern of the drive motor, which are assumed to be mounted with an additional mass that can reduce the absolute value of the coefficient of the interference term to the acceleration, Considering the relationship between the maximum torque-speed characteristics of the motor and the allowable temperature rise of the part where temperature rise of the motor becomes a bottleneck, and the required average torque and required average speed of the motor, their margins are minimized. , The second arm and / or the third arm so that the operating time can be minimized.
An additional mass mounting robot characterized in that a fixed type or a removable additional mass is provided on the arm and / or the fourth arm.
【請求項14】ベ−スに設置された上下軸駆動モ−タに
より直接もしくは減速機を介して連結された非回転ベ−
スに設置された1軸モ−タより直接もしくは減速機を介
して連結された第1ア−ムを鉛直方向軸まわりに回転駆
動し,前記非回転ベ−スに第1ア−ムの1軸出力軸と同
軸上に設置された2軸モ−タより直接もしくは減速機を
介して連結された第2ア−ムを鉛直方向軸まわりに回転
駆動し,その先端に回転可能に設けられ第1ア−ムと平
行に動作する第3ア−ム,第3ア−ム先端と第2ア−ム
先端に回転可能に設けられた,先端に固定構造もしくは
ひねり動作を実現する手首駆動機構を有する手首を有す
る第4ア−ムからなる水平多関節型ロボットにおいて,
機構諸元,モ−タ特性関数,動作条件(動作開始点,動
作終了点,動作デュ−ティ,手先負荷質量),及び加減
速特徴パラメ−タの与えられた駆動モ−タの加減速パタ
−ンに対して,動力学式干渉項の加速度に対する係数の
絶対値を低減可能な付加質量装着を想定した付加質量パ
ラメ−タ(質量及び設置位置)をモ−タの最大トルク−
速度特性及びモ−タの温度上昇がネックとなる部位の温
度上昇許容値とモ−タ所要平均トルク・所要平均速度の
関係を考慮してそれらの余裕が最大となるように,第2
ア−ム及びもしくは第3ア−ム及びもしくは第4ア−ム
に固定型もしくは着脱可能な付加質量を設けて構成した
ことを特徴とする付加質量装着ロボット。
14. A non-rotating base connected directly or via a speed reducer by a vertical shaft driving motor installed on the base.
A first arm connected directly from a single-axis motor installed on the base or via a speed reducer is driven to rotate about a vertical axis, and the first arm of the first arm is attached to the non-rotating base. A second arm connected directly or via a reducer from a two-axis motor installed coaxially with the shaft output shaft is driven to rotate about a vertical axis, and is rotatably provided at the tip of the second arm. A third arm that operates in parallel with one arm, and a wrist drive mechanism that is rotatably provided at the tip of the third arm and the tip of the second arm and that achieves a fixed structure or a twisting motion at the tip. In a horizontal articulated robot comprising a fourth arm having a wrist,
Mechanism specifications, motor characteristic function, operating conditions (start point, end point, duty, hand load mass), and acceleration / deceleration pattern of the drive motor given acceleration / deceleration characteristic parameters. -Additional mass parameters (mass and installation position) assuming the mounting of an additional mass that can reduce the absolute value of the coefficient of the kinetic interference term with respect to acceleration are set to the maximum torque of the motor-
Considering the relationship between the speed characteristic and the temperature rise allowable value at the part where the temperature rise of the motor becomes a bottleneck, and the relationship between the required average torque of the motor and the required average speed, the margins are maximized.
An additional mass mounting robot characterized in that the arm and / or the third arm and / or the fourth arm is provided with a fixed type or a removable additional mass.
【請求項15】ベ−スに設置された上下軸駆動モ−タに
より直接もしくは減速機を介して連結された非回転ベ−
スに設置された1軸モ−タより直接もしくは減速機を介
して連結された第1ア−ムを鉛直方向軸まわりに回転駆
動し,前記非回転ベ−スに第1ア−ムの1軸出力軸と同
軸上に設置された2軸モ−タより直接もしくは減速機を
介して連結された第2ア−ムを鉛直方向軸まわりに回転
駆動し,その先端に回転可能に設けられ第1ア−ムと平
行に動作する第3ア−ム,第3ア−ム先端と第2ア−ム
先端に回転可能に設けられた,先端に固定構造もしくは
ひねり動作を実現する手首駆動機構を有する手首を有す
る第4ア−ムからなる水平多関節型ロボットにおいて,
機構諸元,モ−タ特性関数,及び動作条件(動作開始
点,動作終了点,動作デュ−ティ,手先負荷質量)に対
して,動力学式干渉項の加速度に対する係数の絶対値を
低減可能な付加質量装着を想定した付加質量パラメ−タ
(質量及び設置位置)及び駆動モ−タの加減速パタ−ン
の加減速特徴パラメ−タを,モ−タの最大トルク−速度
特性及びモ−タの温度上昇がネックとなる部位の温度上
昇許容値とモ−タ所要平均トルク・所要平均速度の関係
を考慮してそれらの余裕が最小となり,動作時間を最短
とできるように,第2ア−ム及びもしくは第3ア−ム及
びもしくは第4ア−ムに固定型もしくは着脱可能な付加
質量を設けて構成したことを特徴とする付加質量装着ロ
ボット。
15. A non-rotating base connected directly or through a speed reducer by a vertical shaft drive motor installed on the base.
A first arm connected directly from a single-axis motor installed on the base or via a speed reducer is driven to rotate about a vertical axis, and the first arm of the first arm is attached to the non-rotating base. A second arm connected directly or via a reducer from a two-axis motor installed coaxially with the shaft output shaft is driven to rotate about a vertical axis, and is rotatably provided at the tip of the second arm. A third arm that operates in parallel with one arm, and a wrist drive mechanism that is rotatably provided at the tip of the third arm and the tip of the second arm and that achieves a fixed structure or a twisting motion at the tip. In a horizontal articulated robot comprising a fourth arm having a wrist,
It is possible to reduce the absolute value of the coefficient of the dynamic interference term for the acceleration with respect to the mechanical specifications, the motor characteristic function, and the operating conditions (start point, end point, duty, hand load mass). The additional mass parameters (mass and installation position) and the acceleration / deceleration characteristic parameters of the drive motor, which are assumed to be installed with various additional masses, are used to determine the maximum torque-speed characteristics of the motor and the motor. Considering the relationship between the allowable temperature rise of the part where the temperature rise of the motor becomes a bottleneck and the required average torque and required average speed of the motor, these margins are minimized and the second operation time is set to be the shortest. An additional mass mounting robot, characterized in that the arm and / or the third arm and / or the fourth arm is provided with a fixed type or a removable additional mass.
【請求項16】ベ−スに設置された1軸モ−タより直接
もしくは減速機を介して連結された1軸モ−タにより直
接もしくは減速機を介して連結された第1ア−ムを鉛直
方向軸まわりに回転駆動し,第1ア−ム先端に回転可能
に設けられた第2ア−ムが,ベ−スに第1ア−ムの1軸
出力軸と同軸上に設置された2軸モ−タより直接もしく
は減速機で発生された動力を第1ア−ム先端までベルト
を介して動力伝達することにより鉛直方向軸まわりに回
転駆動し,第2ア−ム先端に設けられた手首軸の上下動
作のみもしくは上下・ひねり動作を実現する手首駆動機
構を有する水平多関節型ロボットにおいて,機構諸元,
モ−タ特性関数,動作条件(動作開始点,動作終了点,
動作デュ−ティ,手先負荷質量),及び加減速特徴パラ
メ−タの与えられた駆動モ−タの加減速パタ−ンに対し
て,動力学式干渉項の加速度に対する係数の絶対値を低
減可能な付加質量装着を想定した付加質量パラメ−タ
(質量及び設置位置)をモ−タの最大トルク−速度特性
及びモ−タの温度上昇がネックとなる部位の温度上昇許
容値とモ−タ所要平均トルク・所要平均速度の関係を考
慮してそれらの余裕が最大となるように,第2ア−ムの
2軸出力軸に対して手首軸とは反対側に固定型もしくは
着脱可能な付加質量を設けて構成したことを特徴とする
付加質量装着ロボット。
16. A first arm connected directly from a single-axis motor installed on a base or via a speed reducer and directly connected to the first arm via a speed reducer. A second arm rotatably driven around a vertical axis and rotatably provided at the tip of the first arm was installed on the base coaxially with the 1-axis output shaft of the first arm. The power generated by the two-axis motor directly or by the speed reducer is transmitted to the tip of the first arm via the belt so that it is driven to rotate about the vertical axis and is installed at the tip of the second arm. In a horizontal articulated robot with a wrist drive mechanism that realizes only vertical movement of the wrist axis or vertical / twist movement,
Motor characteristic function, operation condition (operation start point, operation end point,
Motion duty, hand load mass), and acceleration / deceleration pattern of the drive motor given the acceleration / deceleration characteristic parameters, the absolute value of the coefficient of the dynamic interference term for acceleration can be reduced. The additional mass parameters (mass and installation position) assuming various additional masses are required for the maximum temperature-speed characteristics of the motor and the temperature rise allowable value and the motor where the temperature rise of the motor becomes a bottleneck. Considering the relationship between average torque and required average speed, a fixed type or removable additional mass is installed on the side opposite to the wrist axis with respect to the two-axis output axis of the second arm in order to maximize the margins. An additional mass mounting robot, characterized by being configured with.
【請求項17】ベ−スに設置された1軸モ−タより直接
もしくは減速機を介して連結された1軸モ−タにより直
接もしくは減速機を介して連結された第1ア−ムを鉛直
方向軸まわりに回転駆動し,第1ア−ム先端に回転可能
に設けられた第2ア−ムが,ベ−スに第1ア−ムの1軸
出力軸と同軸上に設置された2軸モ−タより直接もしく
は減速機で発生された動力を第1ア−ム先端までベルト
を介して動力伝達することにより鉛直方向軸まわりに回
転駆動し,第2ア−ム先端に設けられた手首軸の上下動
作のみもしくは上下・ひねり動作を実現する手首駆動機
構を有する水平多関節型ロボットにおいて,機構諸元,
モ−タ特性関数,及び動作条件(動作開始点,動作終了
点,動作デュ−ティ,手先負荷質量)に対して,動力学
式干渉項の加速度に対する係数の絶対値を低減可能な付
加質量装着を想定した付加質量パラメ−タ(質量及び設
置位置)及び駆動モ−タの加減速パタ−ンの加減速特徴
パラメ−タを,モ−タの最大トルク−速度特性及びモ−
タの温度上昇がネックとなる部位の温度上昇許容値とモ
−タ所要平均トルク・所要平均速度の関係を考慮してそ
れらの余裕が最小となり,動作時間を最短とできるよう
に,第2ア−ムの2軸出力軸に対して手首軸とは反対側
に固定型もしくは着脱可能な付加質量を設けて構成した
ことを特徴とする付加質量装着ロボット。
17. A first arm connected directly or through a speed reducer to a single axis motor installed directly on the base or through a speed reducer. A second arm rotatably driven around a vertical axis and rotatably provided at the tip of the first arm was installed on the base coaxially with the 1-axis output shaft of the first arm. The power generated by the two-axis motor directly or by the speed reducer is transmitted to the tip of the first arm via the belt so that it is driven to rotate about the vertical axis and is installed at the tip of the second arm. In a horizontal articulated robot with a wrist drive mechanism that realizes only vertical movement of the wrist axis or vertical / twist movement,
Additional mass attachment that can reduce the absolute value of the coefficient of the dynamic interference term to acceleration for the motor characteristic function and operating conditions (starting point, ending point, duty, hand load mass) The additional mass parameters (mass and installation position) and the acceleration / deceleration characteristic parameters of the drive motor's acceleration / deceleration pattern are used for the maximum torque-speed characteristics of the motor and the motor.
Considering the relationship between the allowable temperature rise of the part where the temperature rise of the motor becomes a bottleneck and the required average torque and required average speed of the motor, these margins are minimized and the second operation time is set to be the shortest. An additional mass mounting robot, characterized in that a fixed type or a removable additional mass is provided on the side opposite to the wrist shaft with respect to the biaxial output shaft of the frame.
【請求項18】ベ−スに設置された上下軸駆動モ−タに
より直接もしくは減速機を介して連結された非回転ベ−
スに設置された1軸モ−タより直接もしくは減速機を介
して連結された第1ア−ムを鉛直方向軸まわりに回転駆
動し,第1ア−ム先端に回転可能に設けられた第2ア−
ムが,前記非回転ベ−スに第1ア−ムの1軸出力軸と同
軸上に設置された2軸モ−タより直接もしくは減速機で
発生された動力を第1ア−ム先端までベルトを介して動
力伝達することにより鉛直方向軸まわりに回転駆動し,
第2ア−ム先端に設けられた固定構造もしくはひねり動
作を実現する手首駆動機構を有する手首からなる水平多
関節型ロボットにおいて,機構諸元,モ−タ特性関数,
動作条件(動作開始点,動作終了点,動作デュ−ティ,
手先負荷質量),及び加減速特徴パラメ−タの与えられ
た駆動モ−タの加減速パタ−ンに対して,動力学式干渉
項の加速度に対する係数の絶対値を低減可能な付加質量
装着を想定した付加質量パラメ−タ(質量及び設置位
置)をモ−タの最大トルク−速度特性及びモ−タの温度
上昇がネックとなる部位の温度上昇許容値とモ−タ所要
平均トルク・所要平均速度の関係を考慮してそれらの余
裕が最大となるように,第2ア−ムの2軸出力軸に対し
て手首とは反対側に固定型もしくは着脱型の付加質量を
設けて構成したことを特徴とする付加質量装着ロボッ
ト。
18. A non-rotating base connected directly or via a speed reducer by a vertical shaft drive motor installed on the base.
The first arm connected directly from the single-axis motor installed on the space or through a speed reducer is driven to rotate around the vertical axis, and the first arm is rotatably provided at the tip of the first arm. 2 a
The non-rotating base uses a two-axis motor installed coaxially with the one-axis output shaft of the first arm on the non-rotating base to directly or motive power generated by the reducer to the tip of the first arm. By transmitting power via a belt, it is driven to rotate about the vertical axis,
In a horizontal articulated robot consisting of a wrist having a fixed structure provided at the tip of the second arm or a wrist driving mechanism for realizing a twisting motion, the mechanical specifications, the motor characteristic function,
Operating conditions (operation start point, operation end point, operation duty,
Load mass) and acceleration / deceleration pattern of the drive motor to which the acceleration / deceleration characteristic parameters are given, with additional mass attachment that can reduce the absolute value of the coefficient of the dynamic interference term to the acceleration. Assuming the additional mass parameters (mass and installation position), the maximum torque-speed characteristics of the motor and the allowable temperature rise of the part where the temperature rise of the motor becomes a bottleneck, and the required average torque and required average of the motor In consideration of the speed relationship, a fixed type or removable type additional mass is provided on the side opposite to the wrist with respect to the biaxial output shaft of the second arm so as to maximize the margins. A robot equipped with an additional mass.
【請求項19】ベ−スに設置された上下軸駆動モ−タに
より直接もしくは減速機を介して連結された非回転ベ−
スに設置された1軸モ−タより直接もしくは減速機を介
して連結された第1ア−ムを鉛直方向軸まわりに回転駆
動し,第1ア−ム先端に回転可能に設けられた第2ア−
ムが,前記非回転ベ−スに第1ア−ムの1軸出力軸と同
軸上に設置された2軸モ−タより直接もしくは減速機で
発生された動力を第1ア−ム先端までベルトを介して動
力伝達することにより鉛直方向軸まわりに回転駆動し,
第2ア−ム先端に設けられた固定構造もしくはひねり動
作を実現する手首駆動機構を有する手首からなる水平多
関節型ロボットにおいて,機構諸元,モ−タ特性関数,
及び動作条件(動作開始点,動作終了点,動作デュ−テ
ィ,手先負荷質量)に対して,動力学式干渉項の加速度
に対する係数の絶対値を低減可能な付加質量装着を想定
した付加質量パラメ−タ(質量及び設置位置)及び駆動
モ−タの加減速パタ−ンの加減速特徴パラメ−タを,モ
−タの最大トルク−速度特性及びモ−タの温度上昇がネ
ックとなる部位の温度上昇許容値とモ−タ所要平均トル
ク・所要平均速度の関係を考慮してそれらの余裕が最小
となり,動作時間を最短とできるように,第2ア−ムの
2軸出力軸に対して手首とは反対側に固定型もしくは着
脱型の付加質量を設けて構成したことを特徴とする付加
質量装着ロボット。
19. A non-rotating base connected directly or through a speed reducer to a vertical shaft driving motor installed on the base.
The first arm connected directly from the single-axis motor installed on the space or through a speed reducer is driven to rotate around the vertical axis, and the first arm is rotatably provided at the tip of the first arm. 2 a
The non-rotating base uses a two-axis motor installed coaxially with the one-axis output shaft of the first arm on the non-rotating base to directly or motive power generated by the reducer to the tip of the first arm. By transmitting power via a belt, it is driven to rotate about the vertical axis,
In a horizontal articulated robot consisting of a wrist having a fixed structure provided at the tip of the second arm or a wrist driving mechanism for realizing a twisting motion, the mechanical specifications, the motor characteristic function,
Also, for the operating conditions (starting point, ending point, operating duty, hand load mass), an additional mass parameter is assumed, which can reduce the absolute value of the coefficient of the dynamic interference term to the acceleration. -The acceleration / deceleration characteristic parameters of the motor (mass and installation position) and the acceleration / deceleration pattern of the drive motor are used to determine the maximum torque-speed characteristics of the motor and the temperature rise of the motor. Considering the relationship between the allowable temperature rise and the required average torque and required average speed of the motor, their margins are minimized so that the operating time can be minimized. An additional mass wearing robot characterized in that a fixed type or removable type additional mass is provided on the side opposite to the wrist.
【請求項20】ベ−スに設置された1軸モ−タより直接
もしくは減速機を介して連結された1軸モ−タにより直
接もしくは減速機を介して連結された第1ア−ムを鉛直
方向軸まわりに回転駆動し,第1ア−ム先端に回転可能
に設けられた第2ア−ムが,第1ア−ムの1軸出力軸と
同軸上に設置された2軸モ−タより直接もしくは減速機
で発生された動力を第1ア−ム先端までベルトを介して
動力伝達することにより鉛直方向軸まわりに回転駆動
し,第2ア−ム先端に設けられた手首軸の上下動作のみ
もしくは上下・ひねり動作を実現する手首駆動機構を有
する水平多関節型ロボットにおいて,機構諸元,モ−タ
特性関数,及び動作条件(動作開始点,動作終了点,動
作デュ−ティ,手先負荷質量),及び加減速特徴パラメ
−タの与えられた駆動モ−タの加減速パタ−ンに対し
て,動力学式干渉項の加速度に対する係数の絶対値を低
減可能な付加質量装着を想定した付加質量パラメ−タ
(質量及び設置位置)を,モ−タの最大トルク−速度特
性及びモ−タの温度上昇がネックとなる部位の温度上昇
許容値とモ−タ所要平均トルク・所要平均速度の関係を
考慮してそれらの余裕が最大となるように,第2ア−ム
の2軸出力軸に対して手首軸とは反対側に固定型もしく
は着脱可能な付加質量を設けて構成したことを特徴とす
る付加質量装着ロボット。
20. A first arm connected directly or via a speed reducer to a single axis motor installed directly on the base or via a speed reducer. A second arm rotatably driven around a vertical axis and rotatably provided at the tip of the first arm has a two-axis motor installed coaxially with the one-axis output shaft of the first arm. The power generated directly from the motor or by the speed reducer is transmitted to the tip of the first arm via the belt to drive the rotation about the vertical axis, and the wrist shaft provided at the tip of the second arm is driven. In a horizontal articulated robot with a wrist drive mechanism that realizes only vertical movements or vertical / twist movements, mechanical specifications, motor characteristic functions, and operating conditions (starting point, ending point, operating duty, Load mass) and acceleration / deceleration characteristic parameters For the acceleration / deceleration pattern of the motor, an additional mass parameter (mass and installation position) is assumed that can be used to reduce the absolute value of the coefficient of the dynamical interference term for acceleration. Considering the relationship between the maximum torque-speed characteristics of the motor and the temperature rise allowable value of the part where the temperature rise of the motor becomes a bottleneck, and the required average torque and required average speed of the motor, the margins are maximized. An additional mass mounting robot characterized in that a fixed type or a removable additional mass is provided on the side opposite to the wrist shaft with respect to the two-axis output shaft of the second arm.
【請求項21】ベ−スに設置された1軸モ−タより直接
もしくは減速機を介して連結された1軸モ−タにより直
接もしくは減速機を介して連結された第1ア−ムを鉛直
方向軸まわりに回転駆動し,第1ア−ム先端に回転可能
に設けられた第2ア−ムが,第1ア−ムの1軸出力軸と
同軸上に設置された2軸モ−タより直接もしくは減速機
で発生された動力を第1ア−ム先端までベルトを介して
動力伝達することにより鉛直方向軸まわりに回転駆動
し,第2ア−ム先端に設けられた手首軸の上下動作のみ
もしくは上下・ひねり動作を実現する手首駆動機構を有
する水平多関節型ロボットにおいて,機構諸元,モ−タ
特性関数,及び動作条件(動作開始点,動作終了点,動
作デュ−ティ,手先負荷質量)に対して,動力学式干渉
項の加速度に対する係数の絶対値を低減可能な付加質量
装着を想定した付加質量パラメ−タ(質量及び設置位
置)及び駆動モ−タの加減速パタ−ンの加減速特徴パラ
メ−タを,モ−タの最大トルク−速度特性及びモ−タの
温度上昇がネックとなる部位の温度上昇許容値とモ−タ
所要平均トルク・所要平均速度の関係を考慮してそれら
の余裕が最小となり,動作時間を最短とできるように,
第2ア−ムの2軸出力軸に対して手首軸とは反対側に固
定型もしくは着脱可能な付加質量を設けて構成したこと
を特徴とする付加質量装着ロボット。
21. A first arm connected directly from a single-axis motor installed on a base or via a speed reducer and directly connected to the first arm via a speed reducer. A second arm rotatably driven around a vertical axis and rotatably provided at the tip of the first arm has a two-axis motor installed coaxially with the one-axis output shaft of the first arm. The power generated directly from the motor or by the speed reducer is transmitted to the tip of the first arm via the belt to drive the rotation about the vertical axis, and the wrist shaft provided at the tip of the second arm is driven. In a horizontal articulated robot with a wrist drive mechanism that realizes only vertical movements or vertical / twist movements, mechanical specifications, motor characteristic functions, and operating conditions (starting point, ending point, operating duty, Load mass) to acceleration of dynamical interference term The additional mass parameters (mass and installation position) and the acceleration / deceleration pattern parameters of the drive motor acceleration / deceleration pattern are set to the maximum of the motor. Considering the relationship between the torque-speed characteristics and the temperature rise allowable value at the part where the temperature rise of the motor becomes a bottleneck, and the relationship between the required average torque and required average speed of the motor, their margins are minimized and the operating time is shortened. to be able to do,
An additional mass mounting robot characterized in that a fixed type or a removable additional mass is provided on the side opposite to the wrist shaft with respect to the biaxial output shaft of the second arm.
【請求項22】ベ−スに設置された上下軸駆動モ−タに
より直接もしくは減速機を介して連結された非回転ベ−
スに設置された1軸モ−タより直接もしくは減速機を介
して連結された第1ア−ムを鉛直方向軸まわりに回転駆
動し,第1ア−ム先端に回転可能に設けられた第2ア−
ムが,第1ア−ムの1軸出力軸と同軸上に設置された2
軸モ−タより直接もしくは減速機で発生された動力を第
1ア−ム先端までベルトを介して動力伝達することによ
り鉛直方向軸まわりに回転駆動し,第2ア−ム先端に設
けられた固定構造もしくはひねり動作を実現する手首駆
動機構を有する手首からなる水平多関節型ロボットにお
いて,機構諸元,モ−タ特性関数,及び動作条件(動作
開始点,動作終了点,動作デュ−ティ,手先負荷質
量),及び加減速特徴パラメ−タの与えられた駆動モ−
タの加減速パタ−ンに対して,動力学式干渉項の加速度
に対する係数の絶対値を低減可能な付加質量装着を想定
した付加質量パラメ−タ(質量及び設置位置)を,モ−
タの最大トルク−速度特性及びモ−タの温度上昇がネッ
クとなる部位の温度上昇許容値とモ−タ所要平均トルク
・所要平均速度の関係を考慮してそれらの余裕が最大と
なるように,第2ア−ムの2軸出力軸に対して手首とは
反対側に固定型もしくは着脱可能な付加質量を設けて構
成したことを特徴とする付加質量装着ロボット。
22. A non-rotating base directly or via a speed reducer connected to a vertical shaft driving motor installed on the base.
The first arm connected directly from the single-axis motor installed on the space or through a speed reducer is driven to rotate around the vertical axis, and the first arm is rotatably provided at the tip of the first arm. 2 a
2 is installed coaxially with the 1-axis output shaft of the 1st arm.
The power generated directly from the shaft motor or by the speed reducer is transmitted to the tip of the first arm via the belt to drive the rotation about the vertical axis, and the tip of the second arm is provided. In a horizontal articulated robot consisting of a wrist with a fixed structure or a wrist drive mechanism that realizes a twisting motion, the mechanical specifications, the motor characteristic function, and the motion condition (motion start point, motion end point, motion duty, Load mass), and drive mode with acceleration / deceleration characteristic parameters
With respect to the acceleration / deceleration pattern of the motor, the additional mass parameters (mass and installation position) that can reduce the absolute value of the coefficient of the dynamical interference term with respect to the acceleration are assumed to be
Considering the relationship between the maximum torque-speed characteristics of the motor and the temperature rise allowable value of the part where the temperature rise of the motor becomes a bottleneck, and the required average torque and required average speed of the motor, the margins are maximized. An additional mass mounting robot characterized in that a fixed type or a removable additional mass is provided on the side opposite to the wrist with respect to the biaxial output shaft of the second arm.
【請求項23】ベ−スに設置された上下軸駆動モ−タに
より直接もしくは減速機を介して連結された非回転ベ−
スに設置された1軸モ−タより直接もしくは減速機を介
して連結された第1ア−ムを鉛直方向軸まわりに回転駆
動し,第1ア−ム先端に回転可能に設けられた第2ア−
ムが,第1ア−ムの1軸出力軸と同軸上に設置された2
軸モ−タより直接もしくは減速機で発生された動力を第
1ア−ム先端までベルトを介して動力伝達することによ
り鉛直方向軸まわりに回転駆動し,第2ア−ム先端に設
けられた固定構造もしくはひねり動作を実現する手首駆
動機構を有する手首からなる水平多関節型ロボットにお
いて,機構諸元,モ−タ特性関数,及び動作条件(動作
開始点,動作終了点,動作デュ−ティ,手先負荷質量)
に対して,動力学式干渉項の加速度に対する係数の絶対
値を低減可能な付加質量装着を想定した付加質量パラメ
−タ(質量及び設置位置)及び駆動モ−タの加減速パタ
−ンの加減速特徴パラメ−タを,モ−タの最大トルク−
速度特性及びモ−タの温度上昇がネックとなる部位の温
度上昇許容値とモ−タ所要平均トルク・所要平均速度の
関係を考慮してそれらの余裕が最小となり,動作時間を
最短とできるように,第2ア−ムの2軸出力軸に対して
手首とは反対側に固定型もしくは着脱可能な付加質量を
設けて構成したことを特徴とする付加質量装着ロボッ
ト。
23. A non-rotating base connected directly or through a speed reducer by a vertical shaft driving motor installed on the base.
The first arm connected directly from the single-axis motor installed on the space or through a speed reducer is driven to rotate around the vertical axis, and the first arm is rotatably provided at the tip of the first arm. 2 a
2 is installed coaxially with the 1-axis output shaft of the 1st arm.
The power generated directly from the shaft motor or by the speed reducer is transmitted to the tip of the first arm via the belt to drive the rotation about the vertical axis, and the tip of the second arm is provided. In a horizontal articulated robot consisting of a wrist with a fixed structure or a wrist drive mechanism that realizes a twisting motion, the mechanical specifications, the motor characteristic function, and the motion condition (motion start point, motion end point, motion duty, Hand load mass)
On the other hand, the additional mass parameters (mass and installation position) and the acceleration / deceleration pattern of the drive motor, which are assumed to be equipped with an additional mass that can reduce the absolute value of the coefficient of the dynamical interference term for acceleration, are added. The deceleration characteristic parameter is the maximum torque of the motor.
Considering the relationship between the speed characteristic and the temperature rise allowable value at the part where the temperature rise of the motor is a bottleneck, and the relationship between the required average torque and the required average speed of the motor, their margins are minimized to minimize the operating time. An additional mass mounting robot characterized in that a fixed type or removable additional mass is provided on the side opposite to the wrist with respect to the biaxial output shaft of the second arm.
【請求項24】ベ−スに設置された旋回軸モ−タより直
接もしくは減速機を介して連結された旋回軸モ−タによ
り直接もしくは減速機を介して連結された鉛直方向軸ま
わりに回転駆動される旋回ベ−スと,前記旋回ベ−スに
設置される旋回軸モ−タ出力軸とは直交する出力回転軸
を有する上腕軸モ−タより直接もしくは減速機を介して
連結された上腕ア−ムと,前記上腕ア−ム先端に設置さ
れる上腕軸モ−タ出力軸とは平行な出力回転軸を有する
前腕軸モ−タにより直接もしくは減速機を介して連結さ
れた前腕ア−ムと,その先端に0以上の姿勢決め自由度
を有する手首機構を有する垂直多関節型ロボットにおい
て,機構諸元,モ−タ特性関数,及び動作条件(動作開
始点,動作終了点,動作デュ−ティ,手先負荷質量),
及び加減速特徴パラメ−タの与えられた駆動モ−タの加
減速パタ−ンに対して,動力学式干渉項の加速度に対す
る係数の絶対値を低減可能な付加質量装着を想定した付
加質量パラメ−タ(質量及び設置位置)を,モ−タの最
大トルク−速度特性及びモ−タの温度上昇がネックとな
る部位の温度上昇許容値とモ−タ所要平均トルク・所要
平均速度の関係を考慮してそれらの余裕が最大となるよ
うに,前腕ア−ムの前腕出力軸に対して手首機構とは反
対側に固定型もしくは着脱可能な付加質量を設けて構成
したことを特徴とした付加質量装着ロボット。
24. Rotation about a vertical axis connected directly or via a speed reducer to a swivel motor installed directly to the base or via a speed reducer. The driven swivel base and the swivel motor output shaft installed on the swivel base were connected directly or via a speed reducer from an upper arm shaft motor having an output rotary shaft orthogonal to each other. The upper arm arm and the forearm arm connected to the upper arm motor output shaft, which is installed at the tip of the upper arm arm, are connected directly or via a reducer by a forearm shaft motor having an output rotation axis parallel to the upper arm arm. -In a vertical articulated robot having a wrist and a wrist mechanism having 0 or more posture-determining degrees of freedom at its tip, mechanical specifications, motor characteristic functions, and motion conditions (motion start point, motion end point, motion Duty, hand load mass),
And an additional mass parameter assuming the mounting of an additional mass that can reduce the absolute value of the coefficient of the dynamical interference term with respect to the acceleration for the acceleration / deceleration pattern of the drive motor given the acceleration / deceleration characteristic parameter. -The relationship between the maximum torque-speed characteristics of the motor and the allowable temperature rise of the part where the temperature rise of the motor becomes a bottleneck and the required average torque and required average speed of the motor In consideration of the above, the addition is characterized in that a fixed type or a detachable additional mass is provided on the side of the forearm arm opposite to the forearm output shaft from the wrist mechanism so as to maximize the margins. Mass loading robot.
【請求項25】ベ−スに設置された旋回軸モ−タより直
接もしくは減速機を介して連結された旋回軸モ−タによ
り直接もしくは減速機を介して連結された鉛直方向軸ま
わりに回転駆動される旋回ベ−スと,前記旋回ベ−スに
設置される旋回軸モ−タ出力軸とは直交する出力回転軸
を有する上腕軸モ−タより直接もしくは減速機を介して
連結された上腕ア−ムと,前記上腕ア−ム先端に設置さ
れる上腕軸モ−タ出力軸とは平行な出力回転軸を有する
前腕軸モ−タにより直接もしくは減速機を介して連結さ
れた前腕ア−ムと,その先端に0以上の姿勢決め自由度
を有する手首機構を有する垂直多関節型ロボットにおい
て,機構諸元,モ−タ特性関数,及び動作条件(動作開
始点,動作終了点,動作デュ−ティ,手先負荷質量)に
対して,動力学式干渉項の加速度に対する係数の絶対値
を低減可能な付加質量装着を想定した付加質量パラメ−
タ(質量及び設置位置)及び駆動モ−タの加減速パタ−
ンの加減速特徴パラメ−タを,モ−タの最大トルク−速
度特性及びモ−タの温度上昇がネックとなる部位の温度
上昇許容値とモ−タ所要平均トルク・所要平均速度の関
係を考慮してそれらの余裕が最小となり,動作時間を最
短とできるように,前腕ア−ムの前腕出力軸に対して手
首機構とは反対側に固定型もしくは着脱可能な付加質量
を設けて構成したことを特徴とした付加質量装着ロボッ
ト。
25. Rotation about a vertical axis connected directly or via a speed reducer to a swivel motor installed directly on the base or via a speed reducer. The driven swivel base and the swivel motor output shaft installed on the swivel base were connected directly or via a speed reducer from an upper arm shaft motor having an output rotary shaft orthogonal to each other. The upper arm arm and the forearm arm connected to the upper arm motor output shaft, which is installed at the tip of the upper arm arm, are connected directly or via a reducer by a forearm shaft motor having an output rotation axis parallel to the upper arm arm. -In a vertical articulated robot having a wrist and a wrist mechanism having 0 or more posture-determining degrees of freedom at its tip, mechanical specifications, motor characteristic functions, and motion conditions (motion start point, motion end point, motion (Duty, hand load mass) Additional mass parameters assuming capable of reducing additional mass attached to the absolute value of the coefficient for the acceleration of Wataruko -
Acceleration / deceleration pattern of the drive motor (mass and installation position) and drive motor
The acceleration / deceleration characteristic parameter of the motor is used to determine the relationship between the maximum torque-speed characteristic of the motor and the allowable temperature rise value of the part where the temperature rise of the motor becomes a bottleneck, and the required average torque / average speed of the motor. In consideration of them, the margins are minimized and the operating time is minimized. A fixed type or removable additional mass is provided on the side of the forearm arm opposite to the forearm output shaft from the wrist mechanism. A robot equipped with an additional mass, which is characterized by that.
【請求項26】ベ−スに設置された旋回軸モ−タより直
接もしくは減速機を介して連結された旋回軸モ−タによ
り直接もしくは減速機を介して連結された鉛直方向軸ま
わりに回転駆動される旋回ベ−スと,前記旋回ベ−スに
設置される旋回軸モ−タ出力軸とは直交する出力回転軸
を有する上腕軸モ−タより直接もしくは減速機を介して
連結された上腕ア−ムと,前記上腕ア−ム根元に上腕軸
モ−タ出力軸とは同軸上に設けられた前腕軸モ−タによ
り直接もしくは減速機を介して駆動される前腕サブア−
ムと,前腕サブア−ム先端に回転可能に設けられた上腕
サブア−ムと,上腕ア−ム先端・上腕サブア−ム先端に
対して回転可能に設けられた前腕ア−ムと,前記前腕ア
−ム先端に0以上の姿勢決め自由度を有する手首機構を
有する垂直多関節型ロボットにおいて,機構諸元,モ−
タ特性関数,及び動作条件(動作開始点,動作終了点,
動作デュ−ティ,手先負荷質量),及び加減速特徴パラ
メ−タの与えられた駆動モ−タの加減速パタ−ンに対し
て,動力学式干渉項の加速度に対する係数の絶対値を低
減可能な付加質量装着を想定した付加質量パラメ−タ
(質量及び設置位置)を,モ−タの最大トルク−速度特
性及びモ−タの温度上昇がネックとなる部位の温度上昇
許容値とモ−タ所要平均トルク・所要平均速度の関係を
考慮してそれらの余裕が最大となるように,前腕ア−ム
及びもしくは,上腕サブア−ム及びもしくは,前腕サブ
ア−ムに固定型もしくは着脱可能な付加質量を設けて構
成したことを特徴とした付加質量装着ロボット。
26. Rotation around a vertical axis directly or via a speed reducer connected directly to or via a speed reducer installed on a base. The driven swivel base and the swivel motor output shaft installed on the swivel base were connected directly or via a speed reducer from an upper arm shaft motor having an output rotary shaft orthogonal to each other. A forearm subarm driven by a forearm shaft motor provided coaxially with the upper arm arm and the output shaft of the upper arm motor at the base of the forearm arm or through a speed reducer.
Arm, an upper arm subarm rotatably provided at the tip of the forearm subarm, a forearm arm rotatably provided at the tip of the upper arm arm and the tip of the upper arm subarm, and the forearm arm. -In a vertical articulated robot having a wrist mechanism with 0 or more posture-determining degrees of freedom at the tip of the mechanism,
Characteristics function and operating conditions (operation start point, operation end point,
Motion duty, hand load mass), and acceleration / deceleration pattern of the drive motor given the acceleration / deceleration characteristic parameters, the absolute value of the coefficient of the dynamic interference term for acceleration can be reduced. The additional mass parameters (mass and installation position), which are assumed to be used for various additional masses, are set to the maximum torque-speed characteristics of the motor and the allowable temperature rise of the part where the temperature rise of the motor becomes a bottleneck and the motor. Considering the relationship between the required average torque and the required average speed, in order to maximize their margin, a fixed type or removable additional mass to the forearm arm and / or upper arm subarm and / or forearm subarm An additional mass mounting robot characterized by being configured with.
【請求項27】ベ−スに設置された旋回軸モ−タより直
接もしくは減速機を介して連結された旋回軸モ−タによ
り直接もしくは減速機を介して連結された鉛直方向軸ま
わりに回転駆動される旋回ベ−スと,前記旋回ベ−スに
設置される旋回軸モ−タ出力軸とは直交する出力回転軸
を有する上腕軸モ−タより直接もしくは減速機を介して
連結された上腕ア−ムと,前記上腕ア−ム根元に上腕軸
モ−タ出力軸とは同軸上に設けられた前腕軸モ−タによ
り直接もしくは減速機を介して駆動される前腕サブア−
ムと,前腕サブア−ム先端に回転可能に設けられた上腕
サブア−ムと,上腕ア−ム先端・上腕サブア−ム先端に
対して回転可能に設けられた前腕ア−ムと,前記前腕ア
−ム先端に0以上の姿勢決め自由度を有する手首機構を
有する垂直多関節型ロボットにおいて,機構諸元,モ−
タ特性関数,及び動作条件(動作開始点,動作終了点,
動作デュ−ティ,手先負荷質量)に対して,動力学式干
渉項の加速度に対する係数の絶対値を低減可能な付加質
量装着を想定した付加質量パラメ−タ(質量及び設置位
置)及び駆動モ−タの加減速パタ−ンの加減速特徴パラ
メ−タを,モ−タの最大トルク−速度特性及びモ−タの
温度上昇がネックとなる部位の温度上昇許容値とモ−タ
所要平均トルク・所要平均速度の関係を考慮してそれら
の余裕が最小となり,動作時間を最短とできるように,
前腕ア−ム及びもしくは,上腕サブア−ム及びもしく
は,前腕サブア−ムに固定型もしくは着脱可能な付加質
量を設けて構成したことを特徴とした付加質量装着ロボ
ット。
27. Rotation around a vertical axis connected directly or via a speed reducer to a swivel motor installed directly to the base or via a speed reducer. The driven swivel base and the swivel motor output shaft installed on the swivel base were connected directly or via a speed reducer from an upper arm shaft motor having an output rotary shaft orthogonal to each other. A forearm subarm driven by a forearm shaft motor provided coaxially with the upper arm arm and the output shaft of the upper arm motor at the base of the forearm arm or through a speed reducer.
Arm, an upper arm subarm rotatably provided at the tip of the forearm subarm, a forearm arm rotatably provided at the tip of the upper arm arm and the tip of the upper arm subarm, and the forearm arm. -In a vertical articulated robot having a wrist mechanism with 0 or more posture-determining degrees of freedom at the tip of the mechanism,
Characteristics function and operating conditions (operation start point, operation end point,
Additional mass parameters (mass and installation position) and drive mode assuming additional mass mounting that can reduce the absolute value of the coefficient of the dynamic interference term with respect to acceleration (motion duty, hand load mass) Acceleration / deceleration pattern of the motor The parameter parameters are the maximum torque-speed characteristics of the motor and the allowable temperature rise of the part where the temperature rise of the motor becomes a bottleneck and the average torque required for the motor. Considering the relationship between the required average speeds, these margins are minimized so that the operating time can be minimized.
An additional mass mounting robot characterized in that the forearm arm and / or the upper arm subarm and / or the forearm subarm is provided with a fixed or detachable additional mass.
【請求項28】ベ−スに設置された旋回軸モ−タより直
接もしくは減速機を介して連結された旋回軸モ−タによ
り直接もしくは減速機を介して連結された鉛直方向軸ま
わりに回転駆動される旋回ベ−スと,前記旋回ベ−スに
設置される旋回軸モ−タ出力軸とは直交する出力回転軸
を有する上腕軸モ−タより直接もしくは減速機を介して
連結された上腕ア−ムと,前記旋回ベ−スに上腕軸モ−
タ出力軸とは同軸上に設けられた前腕軸モ−タにより直
接もしくは減速機を介して駆動される前腕サブア−ム
と,前腕サブア−ム先端に回転可能に設けられた上腕サ
ブア−ムと,上腕ア−ム先端・上腕サブア−ム先端に対
して回転可能に設けられた前腕ア−ムと,前記前腕ア−
ム先端に0以上の姿勢決め自由度を有する手首機構を有
する垂直多関節型ロボットにおいて,機構諸元,モ−タ
特性関数,及び動作条件(動作開始点,動作終了点,動
作デュ−ティ,手先負荷質量),及び加減速特徴パラメ
−タの与えられた駆動モ−タの加減速パタ−ンに対し
て,動力学式干渉項の加速度に対する係数の絶対値を低
減可能な付加質量装着を想定した付加質量パラメ−タ
(質量及び設置位置)を,モ−タの最大トルク−速度特
性及びモ−タの温度上昇がネックとなる部位の温度上昇
許容値とモ−タ所要平均トルク・所要平均速度の関係を
考慮してそれらの余裕が最大となるように,前腕ア−ム
及びもしくは,上腕サブア−ム及びもしくは,前腕サブ
ア−ムに固定型もしくは着脱可能な付加質量を設けて構
成したことを特徴とした付加質量装着ロボット。
28. Rotation about a vertical axis connected directly or via a speed reducer to a swivel motor installed directly on the base or via a speed reducer. The driven swivel base and the swivel motor output shaft installed on the swivel base were connected directly or via a speed reducer from an upper arm shaft motor having an output rotary shaft orthogonal to each other. The upper arm arm and the upper arm shaft mode on the turning base.
The output shaft is a forearm subarm driven directly by a forearm shaft motor provided coaxially or through a reduction gear, and an upper arm subarm rotatably provided at the tip of the forearm subarm. A forearm arm rotatably provided with respect to the tip of the upper arm arm and the tip of the upper arm subarm, and the forearm arm
In a vertical articulated robot having a wrist mechanism with 0 or more posture determining freedom at the tip of the robot, the mechanical specifications, the motor characteristic function, and the operating conditions (starting point, ending point, operating duty, Load mass) and acceleration / deceleration pattern of the drive motor to which the acceleration / deceleration characteristic parameters are given, with additional mass attachment that can reduce the absolute value of the coefficient of the dynamic interference term to the acceleration. Assuming the additional mass parameters (mass and installation position), the maximum torque-speed characteristics of the motor and the allowable temperature rise of the part where the temperature rise of the motor becomes a bottleneck and the required average torque of the motor The forearm arm and / or the upper arm subarm and / or the forearm subarm is provided with a fixed or removable additional mass so that the margins are maximized in consideration of the relationship of the average speed. Characterized by Additional mass attached robot.
【請求項29】ベ−スに設置された旋回軸モ−タより直
接もしくは減速機を介して連結された旋回軸モ−タによ
り直接もしくは減速機を介して連結された鉛直方向軸ま
わりに回転駆動される旋回ベ−スと,前記旋回ベ−スに
設置される旋回軸モ−タ出力軸とは直交する出力回転軸
を有する上腕軸モ−タより直接もしくは減速機を介して
連結された上腕ア−ムと,前記旋回ベ−スに上腕軸モ−
タ出力軸とは同軸上に設けられた前腕軸モ−タにより直
接もしくは減速機を介して駆動される前腕サブア−ム
と,前腕サブア−ム先端に回転可能に設けられた上腕サ
ブア−ムと,上腕ア−ム先端・上腕サブア−ム先端に対
して回転可能に設けられた前腕ア−ムと,前記前腕ア−
ム先端に0以上の姿勢決め自由度を有する手首機構を有
する垂直多関節型ロボットにおいて,機構諸元,モ−タ
特性関数,及び動作条件(動作開始点,動作終了点,動
作デュ−ティ,手先負荷質量)に対して,動力学式干渉
項の加速度に対する係数の絶対値を低減可能な付加質量
装着を想定した付加質量パラメ−タ(質量及び設置位
置)及び駆動モ−タの加減速パタ−ンの加減速特徴パラ
メ−タを,モ−タの最大トルク−速度特性及びモ−タの
温度上昇がネックとなる部位の温度上昇許容値とモ−タ
所要平均トルク・所要平均速度の関係を考慮してそれら
の余裕が最小となり,動作時間を最短とできるように,
前腕ア−ム及びもしくは,上腕サブア−ム及びもしく
は,前腕サブア−ムに固定型もしくは着脱可能な付加質
量を設けて構成したことを特徴とした付加質量装着ロボ
ット。
29. Rotation about a vertical axis connected directly or via a speed reducer to a swivel motor installed directly on the base or via a speed reducer. The driven swivel base and the swivel motor output shaft installed on the swivel base were connected directly or via a speed reducer from an upper arm shaft motor having an output rotary shaft orthogonal to each other. The upper arm arm and the upper arm shaft mode on the turning base.
The output shaft is a forearm subarm driven directly by a forearm shaft motor provided coaxially or through a reduction gear, and an upper arm subarm rotatably provided at the tip of the forearm subarm. A forearm arm rotatably provided with respect to the tip of the upper arm arm and the tip of the upper arm subarm, and the forearm arm
In a vertical articulated robot having a wrist mechanism with 0 or more posture determining freedom at the tip of the robot, the mechanical specifications, the motor characteristic function, and the operating conditions (starting point, ending point, operating duty, Load mass parameter (mass and installation position) and the acceleration / deceleration pattern of the drive motor, assuming an additional mass attachment that can reduce the absolute value of the coefficient of the dynamic interference term for acceleration -The acceleration / deceleration characteristic parameter of the motor is defined as the relationship between the maximum torque-speed characteristics of the motor and the allowable temperature rise of the part where the temperature rise of the motor becomes a bottleneck, and the required average torque and required average speed of the motor. In consideration of the above, their margins are minimized so that the operation time can be minimized.
An additional mass mounting robot characterized in that the forearm arm and / or the upper arm subarm and / or the forearm subarm is provided with a fixed or detachable additional mass.
【請求項30】ベ−スに設置された旋回軸モ−タより直
接もしくは減速機を介して連結された旋回軸モ−タによ
り直接もしくは減速機を介して連結された鉛直方向軸ま
わりに回転駆動される旋回ベ−スと,前記旋回ベ−スに
設置される旋回軸モ−タ出力軸とは直交する出力回転軸
を有する上腕軸モ−タより直接もしくは減速機を介して
連結された上腕ア−ムと,前記上腕ア−ム先端に回転可
能に設けられた前腕ア−ムと,前記旋回ベ−スに設置さ
れた前腕軸モ−タより直接もしくは減速機とベルトを介
して前腕ア−ム回転軸を駆動し,前記前腕ア−ム先端に
0以上の姿勢決め自由度を有する手首機構を有する垂直
多関節型ロボットにおいて,機構諸元,モ−タ特性関
数,及び動作条件(動作開始点,動作終了点,動作デュ
−ティ,手先負荷質量),及び加減速特徴パラメ−タの
与えられた駆動モ−タの加減速パタ−ンに対して,動力
学式干渉項の加速度に対する係数の絶対値を低減可能な
付加質量装着を想定した付加質量パラメ−タ(質量及び
設置位置)を,モ−タの最大トルク−速度特性及びモ−
タの温度上昇がネックとなる部位の温度上昇許容値とモ
−タ所要平均トルク・所要平均速度の関係を考慮してそ
れらの余裕が最大となるように,前腕ア−ムの前腕出力
軸に対して手首機構とは反対側に固定型もしくは着脱可
能な付加質量を設けて構成したことを特徴とした付加質
量装着ロボット。
30. Rotation about a vertical axis directly or through a speed reducer connected directly from the orbiting shaft motor installed on the base or through a speed reducer. The driven swivel base and the swivel motor output shaft installed on the swivel base were connected directly or via a speed reducer from an upper arm shaft motor having an output rotary shaft orthogonal to each other. An upper arm arm, a forearm arm rotatably provided at the tip of the upper arm arm, and a forearm directly from a forearm shaft motor installed on the turning base or via a speed reducer and a belt. In a vertical articulated robot having a wrist mechanism that drives the arm rotation axis and has a posture freedom degree of 0 or more at the tip of the forearm arm, the mechanical specifications, the motor characteristic function, and the operating condition ( Action start point, action end point, action duty, hand load quality ), And the acceleration / deceleration pattern of the drive motor to which the acceleration / deceleration characteristic parameters are given, with the assumption that additional mass attachment that can reduce the absolute value of the coefficient of the dynamic interference term to the acceleration is assumed. Set the mass parameters (mass and installation position) to the maximum torque-speed characteristics of the motor and the motor.
In consideration of the relationship between the allowable temperature rise of the part where the temperature rise of the motor is a bottleneck and the required average torque and required average speed of the motor, the forearm output shaft of the forearm arm is set so that these margins are maximized. On the other hand, an additional mass mounting robot characterized in that a fixed type or a removable additional mass is provided on the side opposite to the wrist mechanism.
【請求項31】ベ−スに設置された旋回軸モ−タより直
接もしくは減速機を介して連結された旋回軸モ−タによ
り直接もしくは減速機を介して連結された鉛直方向軸ま
わりに回転駆動される旋回ベ−スと,前記旋回ベ−スに
設置される旋回軸モ−タ出力軸とは直交する出力回転軸
を有する上腕軸モ−タより直接もしくは減速機を介して
連結された上腕ア−ムと,前記上腕ア−ム先端に回転可
能に設けられた前腕ア−ムと,前記旋回ベ−スに設置さ
れた前腕軸モ−タより直接もしくは減速機とベルトを介
して前腕ア−ム回転軸を駆動し,前記前腕ア−ム先端に
0以上の姿勢決め自由度を有する手首機構を有する垂直
多関節型ロボットにおいて,機構諸元,モ−タ特性関
数,及び動作条件(動作開始点,動作終了点,動作デュ
−ティ,手先負荷質量)に対して,動力学式干渉項の加
速度に対する係数の絶対値を低減可能な付加質量装着を
想定した付加質量パラメ−タ(質量及び設置位置)及び
駆動モ−タの加減速パタ−ンの加減速特徴パラメ−タ
を,モ−タの最大トルク−速度特性及びモ−タの温度上
昇がネックとなる部位の温度上昇許容値とモ−タ所要平
均トルク・所要平均速度の関係を考慮してそれらの余裕
が最小となり,動作時間を最短とできるように,前腕ア
−ムの前腕出力軸に対して手首機構とは反対側に固定型
もしくは着脱可能な付加質量を設けて構成したことを特
徴とした付加質量装着ロボット。
31. Rotation about a vertical axis connected directly or via a speed reducer to a swivel motor installed directly on the base or via a speed reducer. The driven swivel base and the swivel motor output shaft installed on the swivel base were connected directly or via a speed reducer from an upper arm shaft motor having an output rotary shaft orthogonal to each other. An upper arm arm, a forearm arm rotatably provided at the tip of the upper arm arm, and a forearm directly from a forearm shaft motor installed on the turning base or via a speed reducer and a belt. In a vertical articulated robot having a wrist mechanism that drives the arm rotation axis and has a posture freedom degree of 0 or more at the tip of the forearm arm, the mechanical specifications, the motor characteristic function, and the operating condition ( Action start point, action end point, action duty, hand load quality ), The additional mass parameters (mass and installation position) and the acceleration / deceleration pattern of the drive motor that assume the mounting of an additional mass that can reduce the absolute value of the coefficient of the dynamical interference term with respect to acceleration Acceleration / deceleration characteristic parameters are considered in consideration of the relationship between the maximum torque-speed characteristics of the motor and the allowable temperature rise value of the part where the temperature rise of the motor becomes a bottleneck and the required average torque / average speed of the motor. In order to minimize these margins and minimize the operating time, a fixed type or removable additional mass is provided on the side of the forearm arm opposite to the forearm output shaft from the wrist mechanism. A featured robot with added mass.
【請求項32】ベ−スに設置された旋回軸モ−タより直
接もしくは減速機を介して連結された旋回軸モ−タによ
り直接もしくは減速機を介して連結された鉛直方向軸ま
わりに回転駆動される旋回ベ−スと,前記旋回ベ−スに
設置される旋回軸モ−タ出力軸とは直交する出力回転軸
を有する上腕軸モ−タより直接もしくは減速機を介して
連結された上腕ア−ムと,前記上腕ア−ム先端に回転可
能に設けられた前腕ア−ムと,前記上腕ア−ム根元に上
腕軸モ−タ出力軸と出力軸が一致するように設置された
前腕軸モ−タより直接もしくは減速機とベルトを介して
前腕ア−ム回転軸を駆動し,前記前腕ア−ム先端に0以
上の姿勢決め自由度を有する手首機構を有する垂直多関
節型ロボットにおいて,機構諸元,モ−タ特性関数,及
び動作条件(動作開始点,動作終了点,動作デュ−テ
ィ,手先負荷質量),及び加減速特徴パラメ−タの与え
られた駆動モ−タの加減速パタ−ンに対して,動力学式
干渉項の加速度に対する係数の絶対値を低減可能な付加
質量装着を想定した付加質量パラメ−タ(質量及び設置
位置)を,モ−タの最大トルク−速度特性及びモ−タの
温度上昇がネックとなる部位の温度上昇許容値とモ−タ
所要平均トルク・所要平均速度の関係を考慮してそれら
の余裕が最大となるように,前腕ア−ムの前腕出力軸に
対して手首機構とは反対側に固定型もしくは着脱可能な
付加質量を設けて構成したことを特徴とした付加質量装
着ロボット。
32. Rotation around a vertical axis directly or via a speed reducer connected directly to or through a speed reducer installed on a base. The driven swivel base and the swivel motor output shaft installed on the swivel base were connected directly or via a speed reducer from an upper arm shaft motor having an output rotary shaft orthogonal to each other. The upper arm arm, the forearm arm rotatably provided at the tip of the upper arm arm, and the upper arm arm were installed so that the output shaft and the output shaft of the upper arm motor coincided with each other. A vertical articulated robot having a wrist mechanism that drives the forearm arm rotation shaft directly from the forearm shaft motor or via a speed reducer and a belt, and has a wrist mechanism at the tip of the forearm arm having a degree of freedom of posture determination of 0 or more. , Mechanical specifications, motor characteristic function, and operating conditions (operation Start point, end point, operation duty, hand load mass), and acceleration / deceleration pattern of the drive motor given the acceleration / deceleration characteristic parameters, the coefficient for the acceleration of the dynamic interference term The additional mass parameters (mass and installation position) that can be used to reduce the absolute value of the motor are used to measure the maximum torque-speed characteristics of the motor and the temperature rise of the part where the temperature rise of the motor becomes a bottleneck. Considering the relationship between the allowable value and the required average torque and required average speed of the motor, a fixed type or a fixed type on the side opposite to the wrist mechanism with respect to the forearm output shaft of the forearm arm is used to maximize the margin. An additional mass mounting robot characterized by being configured with a removable additional mass.
【請求項33】ベ−スに設置された旋回軸モ−タより直
接もしくは減速機を介して連結された旋回軸モ−タによ
り直接もしくは減速機を介して連結された鉛直方向軸ま
わりに回転駆動される旋回ベ−スと,前記旋回ベ−スに
設置される旋回軸モ−タ出力軸とは直交する出力回転軸
を有する上腕軸モ−タより直接もしくは減速機を介して
連結された上腕ア−ムと,前記上腕ア−ム先端に回転可
能に設けられた前腕ア−ムと,前記上腕ア−ム根元に上
腕軸モ−タ出力軸と出力軸が一致するように設置された
前腕軸モ−タより直接もしくは減速機とベルトを介して
前腕ア−ム回転軸を駆動し,前記前腕ア−ム先端に0以
上の姿勢決め自由度を有する手首機構を有する垂直多関
節型ロボットにおいて,機構諸元,モ−タ特性関数,及
び動作条件(動作開始点,動作終了点,動作デュ−テ
ィ,手先負荷質量)に対して,動力学式干渉項の加速度
に対する係数の絶対値を低減可能な付加質量装着を想定
した付加質量パラメ−タ(質量及び設置位置)及び駆動
モ−タの加減速パタ−ンの加減速特徴パラメ−タを,モ
−タの最大トルク−速度特性及びモ−タの温度上昇がネ
ックとなる部位の温度上昇許容値とモ−タ所要平均トル
ク・所要平均速度の関係を考慮してそれらの余裕が最小
となり,動作時間を最短とできるように,前腕ア−ムの
前腕出力軸に対して手首機構とは反対側に固定型もしく
は着脱可能な付加質量を設けて構成したことを特徴とし
た付加質量装着ロボット。
33. Rotation around a vertical axis directly or via a speed reducer connected to a swivel motor installed on a base or directly via a speed reducer. The driven swivel base and the swivel motor output shaft installed on the swivel base were connected directly or via a speed reducer from an upper arm shaft motor having an output rotary shaft orthogonal to each other. The upper arm arm, the forearm arm rotatably provided at the tip of the upper arm arm, and the upper arm arm were installed so that the output shaft and the output shaft of the upper arm motor coincided with each other. A vertical articulated robot having a wrist mechanism that drives the forearm arm rotation shaft directly from the forearm shaft motor or via a speed reducer and a belt, and has a wrist mechanism at the tip of the forearm arm having a degree of freedom of posture determination of 0 or more. , Mechanical specifications, motor characteristic function, and operating conditions (operation Additional mass parameters (mass and installation) assuming additional mass installation that can reduce the absolute value of the coefficient of the dynamic interference term for acceleration with respect to the start point, operation end point, operation duty, and hand load mass) Position) and the acceleration / deceleration pattern of the drive motor.The parameters are set to the maximum torque-speed characteristics of the motor and the allowable temperature rise of the part where the temperature rise of the motor becomes a bottleneck. -Fixed on the side opposite to the wrist mechanism with respect to the forearm output shaft of the forearm arm so that the margins are minimized considering the relationship between the required average torque and the required average speed, and the operating time can be minimized. An additional mass mounting robot characterized by being configured by providing a mold or a removable additional mass.
【請求項34】ベ−スに設置された1軸モ−タより直接
もしくは減速機を介して連結された第1ア−ムを鉛直方
向軸まわりに回転駆動し,第1ア−ム先端に設置された
2軸モ−タより直接もしくは減速機を介して連結された
第2ア−ムを鉛直方向軸まわりに回転駆動し,第2ア−
ム先端に設けられた手首軸の上下動作のみもしくは上下
・ひねり動作を実現する手首駆動機構を有する水平多関
節型ロボットにおいて,機構諸元,モ−タ特性関数,動
作条件(動作開始点,動作終了点,動作デュ−ティ,手
先負荷質量),及び加減速特徴パラメ−タの与えられた
駆動モ−タの加減速パタ−ンに対して,動力学式干渉項
の加速度に対する係数の絶対値を低減可能な付加質量装
着を想定した付加質量パラメ−タ(質量及び設置位置)
をモ−タの最大トルク−速度特性及びモ−タの温度上昇
がネックとなる部位の温度上昇許容値とモ−タ所要平均
トルク・所要平均速度の関係を考慮してそれらの余裕が
最大となるように,第2ア−ムの2軸出力軸に対して手
首軸とは反対側に手首駆動装置を設けて構成したことを
特徴とする特定質量配分具備ロボット。
34. A first arm connected directly from a single-axis motor installed on a base or via a speed reducer is rotationally driven about a vertical axis, and is attached to the tip of the first arm. The second arm connected directly from the installed two-axis motor or via a speed reducer is driven to rotate about the vertical axis, and the second arm is rotated.
In a horizontal articulated robot with a wrist drive mechanism that realizes only vertical movement or vertical / twist movement of the wrist axis provided at the tip of the robot, the mechanical specifications, motor characteristic function, and operating conditions (starting point, operation End point, operation duty, hand load mass), and acceleration / deceleration pattern of the drive motor given the acceleration / deceleration characteristic parameters, the absolute value of the coefficient for the acceleration of the dynamic interference term Additional mass parameters (mass and installation position) assuming additional mass installation
Considering the relationship between the maximum torque-speed characteristics of the motor and the temperature rise allowable value of the part where the temperature rise of the motor is a bottleneck, and the required average torque / required average speed of the motor, these margins are the maximum. As described above, a robot with specific mass distribution characterized in that a wrist drive device is provided on the side opposite to the wrist shaft with respect to the two-axis output shaft of the second arm.
【請求項35】ベ−スに設置された1軸モ−タより直接
もしくは減速機を介して連結された第1ア−ムを鉛直方
向軸まわりに回転駆動し,第1ア−ム先端に設置された
2軸モ−タより直接もしくは減速機を介して連結された
第2ア−ムを鉛直方向軸まわりに回転駆動し,第2ア−
ム先端に設けられた手首軸の上下動作のみもしくは上下
・ひねり動作を実現する手首駆動機構を有する水平多関
節型ロボットにおいて,機構諸元,モ−タ特性関数,及
び動作条件(動作開始点,動作終了点,動作デュ−テ
ィ,手先負荷質量)に対して,動力学式干渉項の加速度
に対する係数の絶対値を低減可能な付加質量装着を想定
した付加質量パラメ−タ(質量及び設置位置)及び駆動
モ−タの加減速パタ−ンの加減速特徴パラメ−タを,モ
−タの最大トルク−速度特性及びモ−タの温度上昇がネ
ックとなる部位の温度上昇許容値とモ−タ所要平均トル
ク・所要平均速度の関係を考慮してそれらの余裕が最小
となり,動作時間を最短とできるように,第2ア−ムの
2軸出力軸に対して手首軸とは反対側に手首駆動装置を
設けて構成したことを特徴とする特定質量配分具備ロボ
ット。
35. A first arm connected directly from a single-axis motor installed on a base or via a speed reducer is rotationally driven about a vertical axis, and is attached to the tip of the first arm. The second arm connected directly from the installed two-axis motor or via a speed reducer is driven to rotate about the vertical axis, and the second arm is rotated.
In a horizontal articulated robot with a wrist drive mechanism that realizes only vertical movement or vertical / twist movement of the wrist shaft provided at the tip of the robot, the mechanical specifications, motor characteristic function, and operating conditions (starting point, Additional mass parameters (mass and installation position) assuming additional mass mounting that can reduce the absolute value of the coefficient of the dynamic interference term for acceleration with respect to the operation end point, operation duty, and hand load mass) And the acceleration / deceleration characteristic parameters of the drive motor, the maximum torque-speed characteristics of the motor and the allowable temperature rise of the part where the temperature rise of the motor becomes a bottleneck and the motor. Considering the relationship between the required average torque and the required average speed, those margins are minimized so that the operating time can be minimized, so that the wrist is on the opposite side of the wrist axis with respect to the 2-axis output axis of the second arm. Having a drive device Specific mass distribution comprising a robot characterized.
【請求項36】ベ−スに設置された上下軸駆動モ−タに
より直接もしくは減速機を介して連結された非回転ベ−
スに設置された1軸モ−タより直接もしくは減速機を介
して連結された第1ア−ムを鉛直方向軸まわりに回転駆
動し,第1ア−ム先端に設置された2軸モ−タより直接
もしくは減速機を介して連結された第2ア−ムを鉛直方
向軸まわりに回転駆動し,第2ア−ム先端に設けられた
固定構造もしくはひねり動作を実現する手首駆動機構を
有する手首からなる水平多関節型ロボットにおいて,機
構諸元,モ−タ特性関数,動作条件(動作開始点,動作
終了点,動作デュ−ティ,手先負荷質量),及び加減速
特徴パラメ−タの与えられた駆動モ−タの加減速パタ−
ンに対して,動力学式干渉項の加速度に対する係数の絶
対値を低減可能な付加質量装着を想定した付加質量パラ
メ−タ(質量及び設置位置)をモ−タの最大トルク−速
度特性及びモ−タの温度上昇がネックとなる部位の温度
上昇許容値とモ−タ所要平均トルク・所要平均速度の関
係を考慮してそれらの余裕が最大となるように,第2ア
−ムの2軸出力軸に対して手首とは反対側に手首駆動装
置を設けて構成したことを特徴とする特定質量配分具備
ロボット。
36. A non-rotating base connected directly or through a speed reducer to a vertical shaft driving motor installed on the base.
A single-axis motor installed on the space directly drives the first arm connected directly or via a speed reducer to rotate about a vertical axis, and a two-axis motor installed at the tip of the first arm. Has a wrist drive mechanism for rotating the second arm, which is connected to the arm directly or via a speed reducer, about the vertical axis to realize a fixed structure provided at the tip of the second arm or a twisting motion. In a horizontal articulated robot consisting of wrists, mechanical specifications, motor characteristic functions, operation conditions (operation start point, operation end point, operation duty, hand load mass), and acceleration / deceleration characteristic parameters are given. Acceleration / deceleration pattern of the driven motor
In addition, the additional mass parameters (mass and installation position) assuming the mounting of an additional mass that can reduce the absolute value of the coefficient of the dynamical interference term with respect to the acceleration are set to the maximum torque-speed characteristics of the motor and the motor. -In consideration of the relationship between the temperature rise allowable value at the part where the temperature rise of the motor becomes a bottleneck and the required average torque and required average speed of the motor, the two axes of the second arm are set so that their margins are maximized. A robot with specific mass distribution, characterized in that a wrist drive device is provided on the side opposite to the wrist with respect to the output shaft.
【請求項37】ベ−スに設置された上下軸駆動モ−タに
より直接もしくは減速機を介して連結された非回転ベ−
スに設置された1軸モ−タより直接もしくは減速機を介
して連結された第1ア−ムを鉛直方向軸まわりに回転駆
動し,第1ア−ム先端に設置された2軸モ−タより直接
もしくは減速機を介して連結された第2ア−ムを鉛直方
向軸まわりに回転駆動し,第2ア−ム先端に設けられた
固定構造もしくはひねり動作を実現する手首駆動機構を
有する手首からなる水平多関節型ロボットにおいて,機
構諸元,モ−タ特性関数,及び動作条件(動作開始点,
動作終了点,動作デュ−ティ,手先負荷質量)に対し
て,動力学式干渉項の加速度に対する係数の絶対値を低
減可能な付加質量装着を想定した付加質量パラメ−タ
(質量及び設置位置)及び駆動モ−タの加減速パタ−ン
の加減速特徴パラメ−タを,モ−タの最大トルク−速度
特性及びモ−タの温度上昇がネックとなる部位の温度上
昇許容値とモ−タ所要平均トルク・所要平均速度の関係
を考慮してそれらの余裕が最小となり,動作時間を最短
とできるように,第2ア−ムの2軸出力軸に対して手首
とは反対側に手首駆動装置を設けて構成したことを特徴
とする特定質量配分具備ロボット。
37. A non-rotating base connected directly or via a speed reducer by a vertical shaft driving motor installed on the base.
A single-axis motor installed on the space directly drives the first arm connected directly or via a speed reducer to rotate about a vertical axis, and a two-axis motor installed at the tip of the first arm. Has a wrist drive mechanism for rotating the second arm, which is connected to the arm directly or via a speed reducer, about the vertical axis to realize a fixed structure provided at the tip of the second arm or a twisting motion. In a horizontal articulated robot consisting of wrists, mechanical specifications, motor characteristic functions, and operating conditions (starting point,
Additional mass parameters (mass and installation position) assuming additional mass mounting that can reduce the absolute value of the coefficient of the dynamic interference term for acceleration with respect to the operation end point, operation duty, and hand load mass) And the acceleration / deceleration characteristic parameters of the drive motor, the maximum torque-speed characteristics of the motor and the allowable temperature rise of the part where the temperature rise of the motor becomes a bottleneck and the motor. In consideration of the relationship between the required average torque and the required average speed, those margins are minimized and the wrist drive is performed on the side opposite to the wrist with respect to the biaxial output shaft of the second arm so that the operating time can be minimized. A robot equipped with a specific mass distribution, characterized by comprising a device.
【請求項38】ベ−スに設置された1軸モ−タより直接
もしくは減速機を介して連結された1軸モ−タより直接
もしくは減速機を介して連結された第1ア−ムを鉛直方
向軸まわりに回転駆動し,第1ア−ムの1軸出力軸と同
軸上に設置された2軸モ−タより直接もしくは減速機を
介して連結された第2ア−ムを鉛直方向軸まわりに回転
駆動し,その先端に回転可能に設けられ第1ア−ムと平
行に動作する第3ア−ム,第3ア−ム先端と第2ア−ム
先端に回転可能に設けられた,手首軸の上下動作のみも
しくは上下・ひねり動作を実現する手首駆動機構を有す
る第4ア−ムからなる水平多関節型ロボットにおいて,
機構諸元,モ−タ特性関数,動作条件(動作開始点,動
作終了点,動作デュ−ティ,手先負荷質量),及び加減
速特徴パラメ−タの与えられた駆動モ−タの加減速パタ
−ンに対して,動力学式干渉項の加速度に対する係数の
絶対値を低減可能な付加質量装着を想定した付加質量パ
ラメ−タ(質量及び設置位置)をモ−タの最大トルク−
速度特性及びモ−タの温度上昇がネックとなる部位の温
度上昇許容値とモ−タ所要平均トルク・所要平均速度の
関係を考慮してそれらの余裕が最大となるように,第2
ア−ム及びもしくは第3ア−ム及びもしくは第4ア−ム
に手首駆動装置を設けて構成したことを特徴とする特定
質量配分具備ロボット。
38. A first arm connected directly from a single-axis motor installed on a base or via a speed reducer to the first arm connected to the single-axis motor directly or via a speed reducer. It is driven to rotate about the vertical axis, and the second arm connected directly from the two-axis motor installed coaxially with the one-axis output shaft of the first arm or through a speed reducer is connected in the vertical direction. A third arm, which is rotatably driven around an axis, is rotatably provided at its tip, and is rotatably provided at a third arm tip and a second arm tip, which operate in parallel with the first arm. In addition, in a horizontal articulated robot consisting of a fourth arm having a wrist drive mechanism that realizes only vertical movement of the wrist axis or vertical / twist movement,
Mechanism specifications, motor characteristic function, operating conditions (start point, end point, duty, hand load mass), and acceleration / deceleration pattern of the drive motor given acceleration / deceleration characteristic parameters. -Additional mass parameters (mass and installation position) assuming the mounting of an additional mass that can reduce the absolute value of the coefficient of the kinetic interference term with respect to acceleration are set to the maximum torque of the motor-
Considering the relationship between the speed characteristic and the temperature rise allowable value at the part where the temperature rise of the motor becomes a bottleneck, and the relationship between the required average torque of the motor and the required average speed, the margins are maximized.
A robot with specific mass distribution, characterized in that a wrist drive device is provided on the arm and / or the third arm and / or the fourth arm.
【請求項39】ベ−スに設置された1軸モ−タより直接
もしくは減速機を介して連結された1軸モ−タより直接
もしくは減速機を介して連結された第1ア−ムを鉛直方
向軸まわりに回転駆動し,第1ア−ムの1軸出力軸と同
軸上に設置された2軸モ−タより直接もしくは減速機を
介して連結された第2ア−ムを鉛直方向軸まわりに回転
駆動し,その先端に回転可能に設けられ第1ア−ムと平
行に動作する第3ア−ム,第3ア−ム先端と第2ア−ム
先端に回転可能に設けられた,手首軸の上下動作のみも
しくは上下・ひねり動作を実現する手首駆動機構を有す
る第4ア−ムからなる水平多関節型ロボットにおいて,
機構諸元,モ−タ特性関数,及び動作条件(動作開始
点,動作終了点,動作デュ−ティ,手先負荷質量)に対
して,動力学式干渉項の加速度に対する係数の絶対値を
低減可能な付加質量装着を想定した付加質量パラメ−タ
(質量及び設置位置)及び駆動モ−タの加減速パタ−ン
の加減速特徴パラメ−タを,モ−タの最大トルク−速度
特性及びモ−タの温度上昇がネックとなる部位の温度上
昇許容値とモ−タ所要平均トルク・所要平均速度の関係
を考慮してそれらの余裕が最小となり,動作時間を最短
とできるように,第2ア−ム及びもしくは第3ア−ム及
びもしくは第4ア−ムに手首駆動装置を設けて構成した
ことを特徴とする特定質量配分具備ロボット。
39. A first arm connected directly from a single-axis motor installed via a base or via a speed reducer to the first arm connected directly or via a speed reducer. It is driven to rotate about the vertical axis, and the second arm connected directly from the two-axis motor installed coaxially with the one-axis output shaft of the first arm or through a speed reducer is connected in the vertical direction. A third arm, which is rotatably driven around an axis, is rotatably provided at its tip, and is rotatably provided at a third arm tip and a second arm tip, which operate in parallel with the first arm. In addition, in a horizontal articulated robot consisting of a fourth arm having a wrist drive mechanism that realizes only vertical movement of the wrist axis or vertical / twist movement,
It is possible to reduce the absolute value of the coefficient of the dynamic interference term for the acceleration with respect to the mechanical specifications, the motor characteristic function, and the operating conditions (start point, end point, duty, hand load mass). The additional mass parameters (mass and installation position) and the acceleration / deceleration characteristic parameters of the drive motor, which are assumed to be installed with various additional masses, are used to determine the maximum torque-speed characteristics of the motor and the motor. Considering the relationship between the allowable temperature rise of the part where the temperature rise of the motor becomes a bottleneck and the required average torque and required average speed of the motor, these margins are minimized and the second operation time is set to be the shortest. A robot with specific mass distribution, characterized in that a wrist drive device is provided on the arm and / or the third arm and / or the fourth arm.
【請求項40】ベ−スに設置された上下軸駆動モ−タに
より直接もしくは減速機を介して連結された非回転ベ−
スに設置された1軸モ−タより直接もしくは減速機を介
して連結された第1ア−ムを鉛直方向軸まわりに回転駆
動し,第1ア−ムの1軸出力軸と同軸上に設置された2
軸モ−タより直接もしくは減速機を介して連結された第
2ア−ムを鉛直方向軸まわりに回転駆動し,その先端に
回転可能に設けられ第1ア−ムと平行に動作する第3ア
−ム,第3ア−ム先端と第2ア−ム先端に回転可能に設
けられ,先端に固定構造もしくはひねり動作を実現する
手首駆動機構を有する手首を有する第4ア−ムからなる
水平多関節型ロボットにおいて,機構諸元,モ−タ特性
関数,動作条件(動作開始点,動作終了点,動作デュ−
ティ,手先負荷質量),及び加減速特徴パラメ−タの与
えられた駆動モ−タの加減速パタ−ンに対して,動力学
式干渉項の加速度に対する係数の絶対値を低減可能な付
加質量装着を想定した付加質量パラメ−タ(質量及び設
置位置)をモ−タの最大トルク−速度特性及びモ−タの
温度上昇がネックとなる部位の温度上昇許容値とモ−タ
所要平均トルク・所要平均速度の関係を考慮してそれら
の余裕が最大となるように,第2ア−ム及びもしくは第
3ア−ム及びもしくは第4ア−ムに,手首駆動装置を設
けて構成したことを特徴とする特定質量配分具備ロボッ
ト。
40. A non-rotating base connected directly or through a speed reducer by a vertical shaft driving motor installed on the base.
The first arm connected directly from the single-axis motor installed in the space or via a reducer is driven to rotate around the vertical axis, and is coaxial with the single-axis output shaft of the first arm. Installed 2
A third arm, which is rotatably driven around a vertical axis about a second arm connected directly from the shaft motor or through a speed reducer, and is rotatably provided at the tip of the second arm and operates in parallel with the first arm. A horizontal arm consisting of a fourth arm which is rotatably provided at the tip of the arm, the third arm and the tip of the second arm, and has a wrist having a fixed structure or a wrist drive mechanism for realizing a twisting motion at the tip. In an articulated robot, mechanical specifications, motor characteristic functions, operating conditions (starting point, end point, operating duty
(Tee, hand load mass) and acceleration / deceleration pattern of the drive motor given the acceleration / deceleration characteristic parameters. The additional mass parameters (mass and installation position) that are assumed to be mounted are set to the maximum torque-speed characteristics of the motor and the allowable temperature rise of the part where the temperature rise of the motor becomes a bottleneck and the average torque required for the motor. Considering the relationship between the required average speeds, the second arm and / or the third arm and / or the fourth arm is provided with a wrist drive device so that the margins thereof are maximized. A robot equipped with a characteristic specific mass distribution.
【請求項41】ベ−スに設置された上下軸駆動モ−タに
より直接もしくは減速機を介して連結された非回転ベ−
スに設置された1軸モ−タより直接もしくは減速機を介
して連結された第1ア−ムを鉛直方向軸まわりに回転駆
動し,第1ア−ムの1軸出力軸と同軸上に設置された2
軸モ−タより直接もしくは減速機を介して連結された第
2ア−ムを鉛直方向軸まわりに回転駆動し,その先端に
回転可能に設けられ第1ア−ムと平行に動作する第3ア
−ム,第3ア−ム先端と第2ア−ム先端に回転可能に設
けられ,先端に固定構造もしくはひねり動作を実現する
手首駆動機構を有する手首を有する第4ア−ムからなる
水平多関節型ロボットにおいて,機構諸元,モ−タ特性
関数,及び動作条件(動作開始点,動作終了点,動作デ
ュ−ティ,手先負荷質量)に対して,動力学式干渉項の
加速度に対する係数の絶対値を低減可能な付加質量装着
を想定した付加質量パラメ−タ(質量及び設置位置)及
び駆動モ−タの加減速パタ−ンの加減速特徴パラメ−タ
を,モ−タの最大トルク−速度特性及びモ−タの温度上
昇がネックとなる部位の温度上昇許容値とモ−タ所要平
均トルク・所要平均速度の関係を考慮してそれらの余裕
が最小となり,動作時間を最短とできるように,第2ア
−ム及びもしくは第3ア−ム及びもしくは第4ア−ム
に,手首駆動装置を設けて構成したことを特徴とする特
定質量配分具備ロボット。
41. A non-rotating base directly or via a speed reducer connected to a vertical shaft driving motor installed on the base.
The first arm connected directly from the single-axis motor installed in the space or via a reducer is driven to rotate around the vertical axis, and is coaxial with the single-axis output shaft of the first arm. Installed 2
A third arm, which is rotatably driven around a vertical axis about a second arm connected directly from the shaft motor or through a speed reducer, and is rotatably provided at the tip of the second arm and operates in parallel with the first arm. A horizontal arm consisting of a fourth arm which is rotatably provided at the tip of the arm, the third arm and the tip of the second arm, and has a wrist having a fixed structure or a wrist drive mechanism for realizing a twisting motion at the tip. In an articulated robot, the coefficient to the acceleration of the dynamical interference term for the mechanical specifications, the motor characteristic function, and the operating conditions (start point, end point, duty, hand load mass) The additional mass parameters (mass and installation position) and the acceleration / deceleration pattern parameters of the drive motor, which are assumed to be mounted with additional mass that can reduce the absolute value of the -Velocity characteristics and motor temperature rise are bottlenecks The second arm and / or the third arm are designed so that their margins are minimized and the operating time can be minimized in consideration of the relationship between the allowable temperature rise value of each unit and the required average torque and required average speed of the motor. A robot with specific mass distribution, characterized in that a wrist drive device is provided on the arm and / or the fourth arm.
【請求項42】ベ−スに設置された1軸モ−タより直接
もしくは減速機を介して連結された1軸モ−タより直接
もしくは減速機を介して連結された第1ア−ムを鉛直方
向軸まわりに回転駆動し,ベ−スに第1ア−ムの1軸出
力軸と同軸上に設置された2軸モ−タより直接もしくは
減速機を介して連結された第2ア−ムを鉛直方向軸まわ
りに回転駆動し,その先端に回転可能に設けられ第1ア
−ムと平行に動作する第3ア−ム,第3ア−ム先端と第
2ア−ム先端に回転可能に設けられた,手首軸の上下動
作のみもしくは上下・ひねり動作を実現する手首駆動機
構を有する第4ア−ムからなる水平多関節型ロボットに
おいて,機構諸元,モ−タ特性関数,動作条件(動作開
始点,動作終了点,動作デュ−ティ,手先負荷質量),
及び加減速特徴パラメ−タの与えられた駆動モ−タの加
減速パタ−ンに対して,動力学式干渉項の加速度に対す
る係数の絶対値を低減可能な付加質量装着を想定した付
加質量パラメ−タ(質量及び設置位置)をモ−タの最大
トルク−速度特性及びモ−タの温度上昇がネックとなる
部位の温度上昇許容値とモ−タ所要平均トルク・所要平
均速度の関係を考慮してそれらの余裕が最大となるよう
に,第2ア−ム及びもしくは第3ア−ム及びもしくは第
4ア−ムに手首駆動装置を設けて構成したことを特徴と
する特定質量配分具備ロボット。
42. A first arm connected directly from a single-axis motor installed via a base or via a speed reducer to the first arm connected to the single-axis motor via a speed reducer. A second arm that is driven to rotate about a vertical axis and is directly connected to the base from a two-axis motor installed coaxially with the one-axis output shaft of the first arm or via a speed reducer. The arm is rotatably driven around a vertical axis, and is rotatably provided at the tip of the arm and rotates to a third arm, a third arm tip and a second arm tip. In a horizontal articulated robot consisting of a fourth arm, which has a wrist drive mechanism that realizes only vertical movement of the wrist axis or vertical and twisting movements, the mechanical specifications, motor characteristic functions, and movements Conditions (operation start point, operation end point, operation duty, hand load mass),
And an additional mass parameter assuming the mounting of an additional mass that can reduce the absolute value of the coefficient of the dynamical interference term with respect to the acceleration for the acceleration / deceleration pattern of the drive motor given the acceleration / deceleration characteristic parameter. -Consider the relationship between the maximum torque and speed characteristics of the motor (mass and installation position), the allowable temperature rise value of the part where the temperature rise of the motor is a bottleneck, and the required average torque and required average speed of the motor. And a robot having a specific mass distribution, characterized in that the second arm and / or the third arm and / or the fourth arm is provided with a wrist drive device so that the margins thereof are maximized. .
【請求項43】ベ−スに設置された1軸モ−タより直接
もしくは減速機を介して連結された1軸モ−タより直接
もしくは減速機を介して連結された第1ア−ムを鉛直方
向軸まわりに回転駆動し,ベ−スに第1ア−ムの1軸出
力軸と同軸上に設置された2軸モ−タより直接もしくは
減速機を介して連結された第2ア−ムを鉛直方向軸まわ
りに回転駆動し,その先端に回転可能に設けられ第1ア
−ムと平行に動作する第3ア−ム,第3ア−ム先端と第
2ア−ム先端に回転可能に設けられた,手首軸の上下動
作のみもしくは上下・ひねり動作を実現する手首駆動機
構を有する第4ア−ムからなる水平多関節型ロボットに
おいて,機構諸元,モ−タ特性関数,及び動作条件(動
作開始点,動作終了点,動作デュ−ティ,手先負荷質
量)に対して,動力学式干渉項の加速度に対する係数の
絶対値を低減可能な付加質量装着を想定した付加質量パ
ラメ−タ(質量及び設置位置)及び駆動モ−タの加減速
パタ−ンの加減速特徴パラメ−タを,モ−タの最大トル
ク−速度特性及びモ−タの温度上昇がネックとなる部位
の温度上昇許容値とモ−タ所要平均トルク・所要平均速
度の関係を考慮してそれらの余裕が最小となり,動作時
間を最短とできるように,第2ア−ム及びもしくは第3
ア−ム及びもしくは第4ア−ムに手首駆動装置を設けて
構成したことを特徴とする特定質量配分具備ロボット。
43. A first arm connected directly from a single-axis motor installed via a base or via a speed reducer to the first arm connected directly or via a speed reducer. A second arm that is driven to rotate about a vertical axis and is directly connected to the base from a two-axis motor installed coaxially with the one-axis output shaft of the first arm or via a speed reducer. The arm is rotatably driven around a vertical axis, and is rotatably provided at the tip of the arm and rotates to a third arm, a third arm tip and a second arm tip. In a horizontal articulated robot consisting of a fourth arm, which has a wrist drive mechanism that realizes only vertical movement or vertical / twist movement of the wrist axis, the mechanical specifications, motor characteristic function, and Power for operating conditions (starting point, ending point, duty, hand load mass) The additional mass parameters (mass and installation position) and the acceleration / deceleration characteristic parameters of the acceleration / deceleration pattern of the drive motor, which are assumed to be mounted with an additional mass that can reduce the absolute value of the coefficient of the interference term to the acceleration, Considering the relationship between the maximum torque-speed characteristics of the motor and the allowable temperature rise of the part where temperature rise of the motor becomes a bottleneck, and the required average torque and required average speed of the motor, their margins are minimized. , The second arm and / or the third arm so that the operating time can be minimized.
A robot with specific mass distribution, characterized in that a wrist drive device is provided on the arm and / or the fourth arm.
【請求項44】ベ−スに設置された上下軸駆動モ−タに
より直接もしくは減速機を介して連結された非回転ベ−
スに設置された1軸モ−タより直接もしくは減速機を介
して連結された第1ア−ムを鉛直方向軸まわりに回転駆
動し,前記非回転ベ−スに第1ア−ムの1軸出力軸と同
軸上に設置された2軸モ−タより直接もしくは減速機を
介して連結された第2ア−ムを鉛直方向軸まわりに回転
駆動し,その先端に回転可能に設けられ第1ア−ムと平
行に動作する第3ア−ム,第3ア−ム先端と第2ア−ム
先端に回転可能に設けられた,先端に固定構造もしくは
ひねり動作を実現する手首駆動機構を有する手首を有す
る第4ア−ムからなる水平多関節型ロボットにおいて,
機構諸元,モ−タ特性関数,動作条件(動作開始点,動
作終了点,動作デュ−ティ,手先負荷質量),及び加減
速特徴パラメ−タの与えられた駆動モ−タの加減速パタ
−ンに対して,動力学式干渉項の加速度に対する係数の
絶対値を低減可能な付加質量装着を想定した付加質量パ
ラメ−タ(質量及び設置位置)をモ−タの最大トルク−
速度特性及びモ−タの温度上昇がネックとなる部位の温
度上昇許容値とモ−タ所要平均トルク・所要平均速度の
関係を考慮してそれらの余裕が最大となるように,第2
ア−ム及びもしくは第3ア−ム及びもしくは第4ア−ム
に手首駆動装置を設けて構成したことを特徴とする特定
質量配分具備ロボット。
44. A non-rotating base connected directly or through a speed reducer by a vertical shaft drive motor installed on the base.
A first arm connected directly from a single-axis motor installed on the base or via a speed reducer is driven to rotate about a vertical axis, and the first arm of the first arm is attached to the non-rotating base. A second arm connected directly or via a reducer from a two-axis motor installed coaxially with the shaft output shaft is driven to rotate about a vertical axis, and is rotatably provided at the tip of the second arm. A third arm that operates in parallel with one arm, and a wrist drive mechanism that is rotatably provided at the tip of the third arm and the tip of the second arm and that achieves a fixed structure or a twisting motion at the tip. In a horizontal articulated robot comprising a fourth arm having a wrist,
Mechanism specifications, motor characteristic function, operating conditions (start point, end point, duty, hand load mass), and acceleration / deceleration pattern of the drive motor given acceleration / deceleration characteristic parameters. -Additional mass parameters (mass and installation position) assuming the mounting of an additional mass that can reduce the absolute value of the coefficient of the kinetic interference term with respect to acceleration are set to the maximum torque of the motor-
Considering the relationship between the speed characteristic and the temperature rise allowable value at the part where the temperature rise of the motor becomes a bottleneck, and the relationship between the required average torque of the motor and the required average speed, the margins are maximized.
A robot with specific mass distribution, characterized in that a wrist drive device is provided on the arm and / or the third arm and / or the fourth arm.
【請求項45】ベ−スに設置された上下軸駆動モ−タに
より直接もしくは減速機を介して連結された非回転ベ−
スに設置された1軸モ−タより直接もしくは減速機を介
して連結された第1ア−ムを鉛直方向軸まわりに回転駆
動し,前記非回転ベ−スに第1ア−ムの1軸出力軸と同
軸上に設置された2軸モ−タより直接もしくは減速機を
介して連結された第2ア−ムを鉛直方向軸まわりに回転
駆動し,その先端に回転可能に設けられ第1ア−ムと平
行に動作する第3ア−ム,第3ア−ム先端と第2ア−ム
先端に回転可能に設けられた,先端に固定構造もしくは
ひねり動作を実現する手首駆動機構を有する手首を有す
る第4ア−ムからなる水平多関節型ロボットにおいて,
機構諸元,モ−タ特性関数,及び動作条件(動作開始
点,動作終了点,動作デュ−ティ,手先負荷質量)に対
して,動力学式干渉項の加速度に対する係数の絶対値を
低減可能な付加質量装着を想定した付加質量パラメ−タ
(質量及び設置位置)及び駆動モ−タの加減速パタ−ン
の加減速特徴パラメ−タを,モ−タの最大トルク−速度
特性及びモ−タの温度上昇がネックとなる部位の温度上
昇許容値とモ−タ所要平均トルク・所要平均速度の関係
を考慮してそれらの余裕が最小となり,動作時間を最短
とできるように,第2ア−ム及びもしくは第3ア−ム及
びもしくは第4ア−ムに手首駆動装置を設けて構成した
ことを特徴とする特定質量配分具備ロボット。
45. A non-rotating base directly or via a speed reducer connected to a vertical shaft driving motor installed on the base.
A first arm connected directly from a single-axis motor installed on the base or via a speed reducer is driven to rotate about a vertical axis, and the first arm of the first arm is attached to the non-rotating base. A second arm connected directly or via a reducer from a two-axis motor installed coaxially with the shaft output shaft is driven to rotate about a vertical axis, and is rotatably provided at the tip of the second arm. A third arm that operates in parallel with one arm, and a wrist drive mechanism that is rotatably provided at the tip of the third arm and the tip of the second arm and that achieves a fixed structure or a twisting motion at the tip. In a horizontal articulated robot comprising a fourth arm having a wrist,
It is possible to reduce the absolute value of the coefficient of the dynamic interference term for the acceleration with respect to the mechanical specifications, the motor characteristic function, and the operating conditions (start point, end point, duty, hand load mass). The additional mass parameters (mass and installation position) and the acceleration / deceleration characteristic parameters of the drive motor, which are assumed to be installed with various additional masses, are used to determine the maximum torque-speed characteristics of the motor and the motor. Considering the relationship between the allowable temperature rise of the part where the temperature rise of the motor becomes a bottleneck and the required average torque and required average speed of the motor, these margins are minimized and the second operation time is set to be the shortest. A robot with specific mass distribution, characterized in that a wrist drive device is provided on the arm and / or the third arm and / or the fourth arm.
【請求項46】ベ−スに設置された1軸モ−タより直接
もしくは減速機を介して連結された1軸モ−タにより直
接もしくは減速機を介して連結された第1ア−ムを鉛直
方向軸まわりに回転駆動し,第1ア−ム先端に回転可能
に設けられた第2ア−ムが,ベ−スに第1ア−ムの1軸
出力軸と同軸上に設置された2軸モ−タより直接もしく
は減速機で発生された動力を第1ア−ム先端までベルト
を介して動力伝達することにより鉛直方向軸まわりに回
転駆動し,第2ア−ム先端に設けられた手首軸の上下動
作のみもしくは上下・ひねり動作を実現する手首駆動機
構を有する水平多関節型ロボットにおいて,機構諸元,
モ−タ特性関数,動作条件(動作開始点,動作終了点,
動作デュ−ティ,手先負荷質量),及び加減速特徴パラ
メ−タの与えられた駆動モ−タの加減速パタ−ンに対し
て,動力学式干渉項の加速度に対する係数の絶対値を低
減可能な付加質量装着を想定した付加質量パラメ−タ
(質量及び設置位置)をモ−タの最大トルク−速度特性
及びモ−タの温度上昇がネックとなる部位の温度上昇許
容値とモ−タ所要平均トルク・所要平均速度の関係を考
慮してそれらの余裕が最大となるように,第2ア−ムの
2軸出力軸に対して手首軸とは反対側に手首駆動装置を
設けて構成したことを特徴とする特定質量配分具備ロボ
ット。
46. A first arm connected directly or via a speed reducer to a single axis motor installed directly on the base or via a speed reducer. A second arm rotatably driven around a vertical axis and rotatably provided at the tip of the first arm was installed on the base coaxially with the 1-axis output shaft of the first arm. The power generated by the two-axis motor directly or by the speed reducer is transmitted to the tip of the first arm via the belt so that it is driven to rotate about the vertical axis and is installed at the tip of the second arm. In a horizontal articulated robot with a wrist drive mechanism that realizes only vertical movement of the wrist axis or vertical / twist movement,
Motor characteristic function, operation condition (operation start point, operation end point,
Motion duty, hand load mass), and acceleration / deceleration pattern of the drive motor given the acceleration / deceleration characteristic parameters, the absolute value of the coefficient of the dynamic interference term for acceleration can be reduced. The additional mass parameters (mass and installation position) assuming various additional masses are required for the maximum temperature-speed characteristics of the motor and the temperature rise allowable value and the motor where the temperature rise of the motor becomes a bottleneck. In consideration of the relationship between the average torque and the required average speed, a wrist drive device was provided on the side opposite to the wrist shaft with respect to the two-axis output shaft of the second arm so as to maximize the margins. A robot equipped with a specific mass distribution characterized by the following.
【請求項47】ベ−スに設置された1軸モ−タより直接
もしくは減速機を介して連結された1軸モ−タにより直
接もしくは減速機を介して連結された第1ア−ムを鉛直
方向軸まわりに回転駆動し,第1ア−ム先端に回転可能
に設けられた第2ア−ムが,ベ−スに第1ア−ムの1軸
出力軸と同軸上に設置された2軸モ−タより直接もしく
は減速機で発生された動力を第1ア−ム先端までベルト
を介して動力伝達することにより鉛直方向軸まわりに回
転駆動し,第2ア−ム先端に設けられた手首軸の上下動
作のみもしくは上下・ひねり動作を実現する手首駆動機
構を有する水平多関節型ロボットにおいて,機構諸元,
モ−タ特性関数,及び動作条件(動作開始点,動作終了
点,動作デュ−ティ,手先負荷質量)に対して,動力学
式干渉項の加速度に対する係数の絶対値を低減可能な付
加質量装着を想定した付加質量パラメ−タ(質量及び設
置位置)及び駆動モ−タの加減速パタ−ンの加減速特徴
パラメ−タを,モ−タの最大トルク−速度特性及びモ−
タの温度上昇がネックとなる部位の温度上昇許容値とモ
−タ所要平均トルク・所要平均速度の関係を考慮してそ
れらの余裕が最小となり,動作時間を最短とできるよう
に,第2ア−ムの2軸出力軸に対して手首軸とは反対側
に手首駆動装置を設けて構成したことを特徴とする特定
質量配分具備ロボット。
47. A first arm connected directly or through a speed reducer to a single axis motor installed directly on the base or via a speed reducer. A second arm rotatably driven around a vertical axis and rotatably provided at the tip of the first arm was installed on the base coaxially with the 1-axis output shaft of the first arm. The power generated by the two-axis motor directly or by the speed reducer is transmitted to the tip of the first arm via the belt so that it is driven to rotate about the vertical axis and is installed at the tip of the second arm. In a horizontal articulated robot with a wrist drive mechanism that realizes only vertical movement of the wrist axis or vertical / twist movement,
Additional mass attachment that can reduce the absolute value of the coefficient of the dynamic interference term to acceleration for the motor characteristic function and operating conditions (starting point, ending point, duty, hand load mass) The additional mass parameters (mass and installation position) and the acceleration / deceleration characteristic parameters of the drive motor's acceleration / deceleration pattern are used for the maximum torque-speed characteristics of the motor and the motor.
Considering the relationship between the allowable temperature rise of the part where the temperature rise of the motor becomes a bottleneck and the required average torque and required average speed of the motor, these margins are minimized and the second operation time is set to be the shortest. A robot with specific mass distribution, characterized in that a wrist drive device is provided on the side opposite to the wrist shaft with respect to the biaxial output shaft of the frame.
【請求項48】ベ−スに設置された上下軸駆動モ−タに
より直接もしくは減速機を介して連結された非回転ベ−
スに設置された1軸モ−タより直接もしくは減速機を介
して連結された第1ア−ムを鉛直方向軸まわりに回転駆
動し,第1ア−ム先端に回転可能に設けられた第2ア−
ムが,前記非回転ベ−スに第1ア−ムの1軸出力軸と同
軸上に設置された2軸モ−タより直接もしくは減速機で
発生された動力を第1ア−ム先端までベルトを介して動
力伝達することにより鉛直方向軸まわりに回転駆動し,
第2ア−ム先端に設けられた固定構造もしくはひねり動
作を実現する手首駆動機構を有する手首からなる水平多
関節型ロボットにおいて,機構諸元,モ−タ特性関数,
動作条件(動作開始点,動作終了点,動作デュ−ティ,
手先負荷質量),及び加減速特徴パラメ−タの与えられ
た駆動モ−タの加減速パタ−ンに対して,動力学式干渉
項の加速度に対する係数の絶対値を低減可能な付加質量
装着を想定した付加質量パラメ−タ(質量及び設置位
置)をモ−タの最大トルク−速度特性及びモ−タの温度
上昇がネックとなる部位の温度上昇許容値とモ−タ所要
平均トルク・所要平均速度の関係を考慮してそれらの余
裕が最大となるように,第2ア−ムの2軸出力軸に対し
て手首とは反対側に手首駆動装置を設けて構成したこと
を特徴とする特定質量配分具備ロボット。
48. A non-rotating base connected directly or via a speed reducer by a vertical shaft drive motor installed on the base.
The first arm connected directly from the single-axis motor installed on the space or through a speed reducer is driven to rotate around the vertical axis, and the first arm is rotatably provided at the tip of the first arm. 2 a
The non-rotating base uses a two-axis motor installed coaxially with the one-axis output shaft of the first arm on the non-rotating base to directly or motive power generated by the reducer to the tip of the first arm. By transmitting power via a belt, it is driven to rotate about the vertical axis,
In a horizontal articulated robot consisting of a wrist having a fixed structure provided at the tip of the second arm or a wrist driving mechanism for realizing a twisting motion, the mechanical specifications, the motor characteristic function,
Operating conditions (operation start point, operation end point, operation duty,
Load mass) and acceleration / deceleration pattern of the drive motor to which the acceleration / deceleration characteristic parameters are given, with additional mass attachment that can reduce the absolute value of the coefficient of the dynamic interference term to the acceleration. Assuming the additional mass parameters (mass and installation position), the maximum torque-speed characteristics of the motor and the allowable temperature rise of the part where the temperature rise of the motor becomes a bottleneck, and the required average torque and required average of the motor A specification characterized in that a wrist drive device is provided on the side opposite to the wrist with respect to the biaxial output shaft of the second arm so that the margins thereof are maximized in consideration of the speed relationship. Mass distribution equipped robot.
【請求項49】ベ−スに設置された上下軸駆動モ−タに
より直接もしくは減速機を介して連結された非回転ベ−
スに設置された1軸モ−タより直接もしくは減速機を介
して連結された第1ア−ムを鉛直方向軸まわりに回転駆
動し,第1ア−ム先端に回転可能に設けられた第2ア−
ムが,前記非回転ベ−スに第1ア−ムの1軸出力軸と同
軸上に設置された2軸モ−タより直接もしくは減速機で
発生された動力を第1ア−ム先端までベルトを介して動
力伝達することにより鉛直方向軸まわりに回転駆動し,
第2ア−ム先端に設けられた固定構造もしくはひねり動
作を実現する手首駆動機構を有する手首からなる水平多
関節型ロボットにおいて,機構諸元,モ−タ特性関数,
及び動作条件(動作開始点,動作終了点,動作デュ−テ
ィ,手先負荷質量)に対して,動力学式干渉項の加速度
に対する係数の絶対値を低減可能な付加質量装着を想定
した付加質量パラメ−タ(質量及び設置位置)及び駆動
モ−タの加減速パタ−ンの加減速特徴パラメ−タを,モ
−タの最大トルク−速度特性及びモ−タの温度上昇がネ
ックとなる部位の温度上昇許容値とモ−タ所要平均トル
ク・所要平均速度の関係を考慮してそれらの余裕が最小
となり,動作時間を最短とできるように,第2ア−ムの
2軸出力軸に対して手首とは反対側に手首駆動装置を設
けて構成したことを特徴とする特定質量配分具備ロボッ
ト。
49. A non-rotating base connected directly or through a speed reducer by a vertical shaft driving motor installed on the base.
The first arm connected directly from the single-axis motor installed on the space or through a speed reducer is driven to rotate around the vertical axis, and the first arm is rotatably provided at the tip of the first arm. 2 a
The non-rotating base uses a two-axis motor installed coaxially with the one-axis output shaft of the first arm on the non-rotating base to directly or motive power generated by the reducer to the tip of the first arm. By transmitting power via a belt, it is driven to rotate about the vertical axis,
In a horizontal articulated robot consisting of a wrist having a fixed structure provided at the tip of the second arm or a wrist driving mechanism for realizing a twisting motion, the mechanical specifications, the motor characteristic function,
Also, for the operating conditions (starting point, ending point, operating duty, hand load mass), an additional mass parameter is assumed, which can reduce the absolute value of the coefficient of the dynamic interference term to the acceleration. -The acceleration / deceleration characteristic parameters of the motor (mass and installation position) and the acceleration / deceleration pattern of the drive motor are used to determine the maximum torque-speed characteristics of the motor and the temperature rise of the motor. Considering the relationship between the allowable temperature rise and the required average torque and required average speed of the motor, their margins are minimized so that the operating time can be minimized. A robot with specific mass distribution, characterized in that a wrist drive device is provided on the side opposite to the wrist.
【請求項50】ベ−スに設置された1軸モ−タより直接
もしくは減速機を介して連結された1軸モ−タにより直
接もしくは減速機を介して連結された第1ア−ムを鉛直
方向軸まわりに回転駆動し,第1ア−ム先端に回転可能
に設けられた第2ア−ムが,第1ア−ムの1軸出力軸と
同軸上に設置された2軸モ−タより直接もしくは減速機
で発生された動力を第1ア−ム先端までベルトを介して
動力伝達することにより鉛直方向軸まわりに回転駆動
し,第2ア−ム先端に設けられた手首軸の上下動作のみ
もしくは上下・ひねり動作を実現する手首駆動機構を有
する水平多関節型ロボットにおいて,機構諸元,モ−タ
特性関数,及び動作条件(動作開始点,動作終了点,動
作デュ−ティ,手先負荷質量),及び加減速特徴パラメ
−タの与えられた駆動モ−タの加減速パタ−ンに対し
て,動力学式干渉項の加速度に対する係数の絶対値を低
減可能な付加質量装着を想定した付加質量パラメ−タ
(質量及び設置位置)を,モ−タの最大トルク−速度特
性及びモ−タの温度上昇がネックとなる部位の温度上昇
許容値とモ−タ所要平均トルク・所要平均速度の関係を
考慮してそれらの余裕が最大となるように,第2ア−ム
の2軸出力軸に対して手首軸とは反対側に手首駆動装置
を設けて構成したことを特徴とする特定質量配分具備ロ
ボット。
50. A first arm connected directly or through a speed reducer to a single axis motor installed directly on the base or through a speed reducer. A second arm rotatably driven around a vertical axis and rotatably provided at the tip of the first arm has a two-axis motor installed coaxially with the one-axis output shaft of the first arm. The power generated directly from the motor or by the speed reducer is transmitted to the tip of the first arm via the belt to drive the rotation about the vertical axis, and the wrist shaft provided at the tip of the second arm is driven. In a horizontal articulated robot with a wrist drive mechanism that realizes only vertical movements or vertical / twist movements, mechanical specifications, motor characteristic functions, and operating conditions (starting point, ending point, operating duty, Load mass) and acceleration / deceleration characteristic parameters For the acceleration / deceleration pattern of the motor, an additional mass parameter (mass and installation position) is assumed that can be used to reduce the absolute value of the coefficient of the dynamical interference term for acceleration. Considering the relationship between the maximum torque-speed characteristics of the motor and the temperature rise allowable value of the part where the temperature rise of the motor becomes a bottleneck, and the required average torque and required average speed of the motor, the margins are maximized. A robot with specific mass distribution, characterized in that a wrist drive device is provided on the side opposite to the wrist shaft with respect to the biaxial output shaft of the second arm.
【請求項51】ベ−スに設置された1軸モ−タより直接
もしくは減速機を介して連結された1軸モ−タにより直
接もしくは減速機を介して連結された第1ア−ムを鉛直
方向軸まわりに回転駆動し,第1ア−ム先端に回転可能
に設けられた第2ア−ムが,第1ア−ムの1軸出力軸と
同軸上に設置された2軸モ−タより直接もしくは減速機
で発生された動力を第1ア−ム先端までベルトを介して
動力伝達することにより鉛直方向軸まわりに回転駆動
し,第2ア−ム先端に設けられた手首軸の上下動作のみ
もしくは上下・ひねり動作を実現する手首駆動機構を有
する水平多関節型ロボットにおいて,機構諸元,モ−タ
特性関数,及び動作条件(動作開始点,動作終了点,動
作デュ−ティ,手先負荷質量)に対して,動力学式干渉
項の加速度に対する係数の絶対値を低減可能な付加質量
装着を想定した付加質量パラメ−タ(質量及び設置位
置)及び駆動モ−タの加減速パタ−ンの加減速特徴パラ
メ−タを,モ−タの最大トルク−速度特性及びモ−タの
温度上昇がネックとなる部位の温度上昇許容値とモ−タ
所要平均トルク・所要平均速度の関係を考慮してそれら
の余裕が最小となり,動作時間を最短とできるように,
第2ア−ムの2軸出力軸に対して手首軸とは反対側に手
首駆動装置を設けて構成したことを特徴とする特定質量
配分具備ロボット。
51. A first arm connected directly or via a speed reducer to a single axis motor installed directly on the base or via a speed reducer. A second arm rotatably driven around a vertical axis and rotatably provided at the tip of the first arm has a two-axis motor installed coaxially with the one-axis output shaft of the first arm. The power generated directly from the motor or by the speed reducer is transmitted to the tip of the first arm via the belt to drive the rotation about the vertical axis, and the wrist shaft provided at the tip of the second arm is driven. In a horizontal articulated robot with a wrist drive mechanism that realizes only vertical movements or vertical / twist movements, mechanical specifications, motor characteristic functions, and operating conditions (starting point, ending point, operating duty, Load mass) to acceleration of dynamical interference term The additional mass parameters (mass and installation position) and the acceleration / deceleration pattern parameters of the drive motor acceleration / deceleration pattern are set to the maximum of the motor. Considering the relationship between the torque-speed characteristics and the temperature rise allowable value at the part where the temperature rise of the motor becomes a bottleneck, and the relationship between the required average torque and required average speed of the motor, their margins are minimized and the operating time is shortened. to be able to do,
A robot with specific mass distribution, characterized in that a wrist drive device is provided on the side opposite to the wrist shaft with respect to the biaxial output shaft of the second arm.
【請求項52】ベ−スに設置された上下軸駆動モ−タに
より直接もしくは減速機を介して連結された非回転ベ−
スに設置された1軸モ−タより直接もしくは減速機を介
して連結された第1ア−ムを鉛直方向軸まわりに回転駆
動し,第1ア−ム先端に回転可能に設けられた第2ア−
ムが,第1ア−ムの1軸出力軸と同軸上に設置された2
軸モ−タより直接もしくは減速機で発生された動力を第
1ア−ム先端までベルトを介して動力伝達することによ
り鉛直方向軸まわりに回転駆動し,第2ア−ム先端に設
けられた固定構造もしくはひねり動作を実現する手首駆
動機構を有する手首からなる水平多関節型ロボットにお
いて,機構諸元,モ−タ特性関数,及び動作条件(動作
開始点,動作終了点,動作デュ−ティ,手先負荷質
量),及び加減速特徴パラメ−タの与えられた駆動モ−
タの加減速パタ−ンに対して,動力学式干渉項の加速度
に対する係数の絶対値を低減可能な付加質量装着を想定
した付加質量パラメ−タ(質量及び設置位置)を,モ−
タの最大トルク−速度特性及びモ−タの温度上昇がネッ
クとなる部位の温度上昇許容値とモ−タ所要平均トルク
・所要平均速度の関係を考慮してそれらの余裕が最大と
なるように,第2ア−ムの2軸出力軸に対して手首とは
反対側に手首駆動装置を設けて構成したことを特徴とす
る特定質量配分具備ロボット。
52. A non-rotating base directly or via a speed reducer connected to a vertical shaft driving motor installed on the base.
The first arm connected directly from the single-axis motor installed on the space or through a speed reducer is driven to rotate around the vertical axis, and the first arm is rotatably provided at the tip of the first arm. 2 a
2 is installed coaxially with the 1-axis output shaft of the 1st arm.
The power generated directly from the shaft motor or by the speed reducer is transmitted to the tip of the first arm via the belt to drive the rotation about the vertical axis, and the tip of the second arm is provided. In a horizontal articulated robot consisting of a wrist with a fixed structure or a wrist drive mechanism that realizes a twisting motion, the mechanical specifications, the motor characteristic function, and the motion condition (motion start point, motion end point, motion duty, Load mass), and drive mode with acceleration / deceleration characteristic parameters
With respect to the acceleration / deceleration pattern of the motor, the additional mass parameters (mass and installation position) that can reduce the absolute value of the coefficient of the dynamical interference term with respect to the acceleration are assumed to be
Considering the relationship between the maximum torque-speed characteristics of the motor and the temperature rise allowable value of the part where the temperature rise of the motor becomes a bottleneck, and the required average torque and required average speed of the motor, the margins are maximized. A robot with specific mass distribution, characterized in that a wrist drive device is provided on the side opposite to the wrist with respect to the biaxial output shaft of the second arm.
【請求項53】ベ−スに設置された上下軸駆動モ−タに
より直接もしくは減速機を介して連結された非回転ベ−
スに設置された1軸モ−タより直接もしくは減速機を介
して連結された第1ア−ムを鉛直方向軸まわりに回転駆
動し,第1ア−ム先端に回転可能に設けられた第2ア−
ムが,第1ア−ムの1軸出力軸と同軸上に設置された2
軸モ−タより直接もしくは減速機で発生された動力を第
1ア−ム先端までベルトを介して動力伝達することによ
り鉛直方向軸まわりに回転駆動し,第2ア−ム先端に設
けられた固定構造もしくはひねり動作を実現する手首駆
動機構を有する手首からなる水平多関節型ロボットにお
いて,機構諸元,モ−タ特性関数,及び動作条件(動作
開始点,動作終了点,動作デュ−ティ,手先負荷質量)
に対して,動力学式干渉項の加速度に対する係数の絶対
値を低減可能な付加質量装着を想定した付加質量パラメ
−タ(質量及び設置位置)及び駆動モ−タの加減速パタ
−ンの加減速特徴パラメ−タを,モ−タの最大トルク−
速度特性及びモ−タの温度上昇がネックとなる部位の温
度上昇許容値とモ−タ所要平均トルク・所要平均速度の
関係を考慮してそれらの余裕が最小となり,動作時間を
最短とできるように,第2ア−ムの2軸出力軸に対して
手首とは反対側に手首駆動装置を設けて構成したことを
特徴とする特定質量配分具備ロボット。
53. A non-rotating base directly or via a speed reducer connected to a vertical shaft driving motor installed on the base.
The first arm connected directly from the single-axis motor installed on the space or through a speed reducer is driven to rotate around the vertical axis, and the first arm is rotatably provided at the tip of the first arm. 2 a
2 is installed coaxially with the 1-axis output shaft of the 1st arm.
The power generated directly from the shaft motor or by the speed reducer is transmitted to the tip of the first arm via the belt to drive the rotation about the vertical axis, and the tip of the second arm is provided. In a horizontal articulated robot consisting of a wrist with a fixed structure or a wrist drive mechanism that realizes a twisting motion, the mechanical specifications, the motor characteristic function, and the motion condition (motion start point, motion end point, motion duty, Hand load mass)
On the other hand, the additional mass parameters (mass and installation position) and the acceleration / deceleration pattern of the drive motor, which are assumed to be equipped with an additional mass that can reduce the absolute value of the coefficient of the dynamical interference term for acceleration, are added. The deceleration characteristic parameter is the maximum torque of the motor.
Considering the relationship between the speed characteristic and the temperature rise allowable value at the part where the temperature rise of the motor is a bottleneck, and the relationship between the required average torque and the required average speed of the motor, their margins are minimized to minimize the operating time. A robot with specific mass distribution characterized in that a wrist drive device is provided on the side opposite to the wrist with respect to the biaxial output shaft of the second arm.
【請求項54】ベ−スに設置された旋回軸モ−タより直
接もしくは減速機を介して連結された旋回軸モ−タによ
り直接もしくは減速機を介して連結された鉛直方向軸ま
わりに回転駆動される旋回ベ−スと,前記旋回ベ−スに
設置される旋回軸モ−タ出力軸とは直交する出力回転軸
を有する上腕軸モ−タより直接もしくは減速機を介して
連結された上腕ア−ムと,前記上腕ア−ム先端に設置さ
れる上腕軸モ−タ出力軸とは平行な出力回転軸を有する
前腕軸モ−タにより直接もしくは減速機を介して連結さ
れた前腕ア−ムと,その先端に0以上の姿勢決め自由度
を有する手首機構を有する垂直多関節型ロボットにおい
て,機構諸元,モ−タ特性関数,及び動作条件(動作開
始点,動作終了点,動作デュ−ティ,手先負荷質量),
及び加減速特徴パラメ−タの与えられた駆動モ−タの加
減速パタ−ンに対して,動力学式干渉項の加速度に対す
る係数の絶対値を低減可能な付加質量装着を想定した付
加質量パラメ−タ(質量及び設置位置)を,モ−タの最
大トルク−速度特性及びモ−タの温度上昇がネックとな
る部位の温度上昇許容値とモ−タ所要平均トルク・所要
平均速度の関係を考慮してそれらの余裕が最大となるよ
うに,前腕ア−ムの前腕出力軸に対して手首機構とは反
対側に手首駆動装置を設けて構成したことを特徴とした
特定質量配分具備ロボット。
54. Rotation about a vertical axis connected directly or via a speed reducer to a swivel motor installed directly to the base or via a speed reducer. The driven swivel base and the swivel motor output shaft installed on the swivel base were connected directly or via a speed reducer from an upper arm shaft motor having an output rotary shaft orthogonal to each other. The upper arm arm and the forearm arm connected to the upper arm motor output shaft, which is installed at the tip of the upper arm arm, are connected directly or via a reducer by a forearm shaft motor having an output rotation axis parallel to the upper arm arm. -In a vertical articulated robot having a wrist and a wrist mechanism having 0 or more posture-determining degrees of freedom at its tip, mechanical specifications, motor characteristic functions, and motion conditions (motion start point, motion end point, motion Duty, hand load mass),
And an additional mass parameter assuming the mounting of an additional mass that can reduce the absolute value of the coefficient of the dynamical interference term with respect to the acceleration for the acceleration / deceleration pattern of the drive motor given the acceleration / deceleration characteristic parameter. -The relationship between the maximum torque-speed characteristics of the motor and the allowable temperature rise of the part where the temperature rise of the motor becomes a bottleneck and the required average torque and required average speed of the motor A robot with specific mass distribution characterized in that a wrist drive device is provided on the side of the forearm arm opposite to the forearm output shaft so as to maximize these margins in consideration.
【請求項55】ベ−スに設置された旋回軸モ−タより直
接もしくは減速機を介して連結された旋回軸モ−タによ
り直接もしくは減速機を介して連結された鉛直方向軸ま
わりに回転駆動される旋回ベ−スと,前記旋回ベ−スに
設置される旋回軸モ−タ出力軸とは直交する出力回転軸
を有する上腕軸モ−タより直接もしくは減速機を介して
連結された上腕ア−ムと,前記上腕ア−ム先端に設置さ
れる上腕軸モ−タ出力軸とは平行な出力回転軸を有する
前腕軸モ−タにより直接もしくは減速機を介して連結さ
れた前腕ア−ムと,その先端に0以上の姿勢決め自由度
を有する手首機構を有する垂直多関節型ロボットにおい
て,機構諸元,モ−タ特性関数,及び動作条件(動作開
始点,動作終了点,動作デュ−ティ,手先負荷質量)に
対して,動力学式干渉項の加速度に対する係数の絶対値
を低減可能な付加質量装着を想定した付加質量パラメ−
タ(質量及び設置位置)及び駆動モ−タの加減速パタ−
ンの加減速特徴パラメ−タを,モ−タの最大トルク−速
度特性及びモ−タの温度上昇がネックとなる部位の温度
上昇許容値とモ−タ所要平均トルク・所要平均速度の関
係を考慮してそれらの余裕が最小となり,動作時間を最
短とできるように,前腕ア−ムの前腕出力軸に対して手
首機構とは反対側に手首駆動装置を設けて構成したこと
を特徴とした特定質量配分具備ロボット。
55. Rotation around a vertical axis directly or via a speed reducer connected directly to or through a speed reducer installed on a base. The driven swivel base and the swivel motor output shaft installed on the swivel base were connected directly or via a speed reducer from an upper arm shaft motor having an output rotary shaft orthogonal to each other. The upper arm arm and the forearm arm connected to the upper arm motor output shaft, which is installed at the tip of the upper arm arm, are connected directly or via a reducer by a forearm shaft motor having an output rotation axis parallel to the upper arm arm. -In a vertical articulated robot having a wrist and a wrist mechanism having 0 or more posture-determining degrees of freedom at its tip, mechanical specifications, motor characteristic functions, and motion conditions (motion start point, motion end point, motion (Duty, hand load mass) Additional mass parameters assuming capable of reducing additional mass attached to the absolute value of the coefficient for the acceleration of Wataruko -
Acceleration / deceleration pattern of the drive motor (mass and installation position) and drive motor
The acceleration / deceleration characteristic parameter of the motor is used to determine the relationship between the maximum torque-speed characteristic of the motor and the allowable temperature rise value of the part where the temperature rise of the motor becomes a bottleneck, and the required average torque / average speed of the motor. Considering them, the margins are minimized and the operating time is minimized. A wrist drive device is provided on the side of the forearm arm that is opposite to the wrist mechanism with respect to the forearm output shaft. Robot with specific mass distribution.
【請求項56】ベ−スに設置された旋回軸モ−タより直
接もしくは減速機を介して連結された旋回軸モ−タによ
り直接もしくは減速機を介して連結された鉛直方向軸ま
わりに回転駆動される旋回ベ−スと,前記旋回ベ−スに
設置される旋回軸モ−タ出力軸とは直交する出力回転軸
を有する上腕軸モ−タより直接もしくは減速機を介して
連結された上腕ア−ムと,前記上腕ア−ム根元に上腕軸
モ−タ出力軸とは同軸上に設けられた前腕軸モ−タによ
り直接もしくは減速機を介して駆動される前腕サブア−
ムと,前腕サブア−ム先端に回転可能に設けられた上腕
サブア−ムと,上腕ア−ム先端・上腕サブア−ム先端に
対して回転可能に設けられた前腕ア−ムと,前記前腕ア
−ム先端に0以上の姿勢決め自由度を有する手首機構を
有する垂直多関節型ロボットにおいて,機構諸元,モ−
タ特性関数,及び動作条件(動作開始点,動作終了点,
動作デュ−ティ,手先負荷質量),及び加減速特徴パラ
メ−タの与えられた駆動モ−タの加減速パタ−ンに対し
て,動力学式干渉項の加速度に対する係数の絶対値を低
減可能な付加質量装着を想定した付加質量パラメ−タ
(質量及び設置位置)を,モ−タの最大トルク−速度特
性及びモ−タの温度上昇がネックとなる部位の温度上昇
許容値とモ−タ所要平均トルク・所要平均速度の関係を
考慮してそれらの余裕が最大となるように,前腕ア−ム
及びもしくは,上腕サブア−ム及びもしくは,前腕サブ
ア−ムに手首駆動装置を設けて構成したことを特徴とし
た特定質量配分具備ロボット。
56. Rotation about a vertical axis connected directly or via a speed reducer to a swivel motor installed directly on the base or via a speed reducer. The driven swivel base and the swivel motor output shaft installed on the swivel base were connected directly or via a speed reducer from an upper arm shaft motor having an output rotary shaft orthogonal to each other. A forearm subarm driven by a forearm shaft motor provided coaxially with the upper arm arm and the output shaft of the upper arm motor at the base of the forearm arm or through a speed reducer.
Arm, an upper arm subarm rotatably provided at the tip of the forearm subarm, a forearm arm rotatably provided at the tip of the upper arm arm and the tip of the upper arm subarm, and the forearm arm. -In a vertical articulated robot having a wrist mechanism with 0 or more posture-determining degrees of freedom at the tip of the mechanism,
Characteristics function and operating conditions (operation start point, operation end point,
Motion duty, hand load mass), and acceleration / deceleration pattern of the drive motor given the acceleration / deceleration characteristic parameters, the absolute value of the coefficient of the dynamic interference term for acceleration can be reduced. The additional mass parameters (mass and installation position), which are assumed to be used for various additional masses, are set to the maximum torque-speed characteristics of the motor and the allowable temperature rise of the part where the temperature rise of the motor becomes a bottleneck and the motor. In consideration of the relationship between the required average torque and the required average speed, a wrist drive device was provided in the forearm arm and / or the upper arm subarm and / or the forearm subarm to maximize the margins. A robot equipped with a specific mass distribution characterized by the above.
【請求項57】ベ−スに設置された旋回軸モ−タより直
接もしくは減速機を介して連結された旋回軸モ−タによ
り直接もしくは減速機を介して連結された鉛直方向軸ま
わりに回転駆動される旋回ベ−スと,前記旋回ベ−スに
設置される旋回軸モ−タ出力軸とは直交する出力回転軸
を有する上腕軸モ−タより直接もしくは減速機を介して
連結された上腕ア−ムと,前記上腕ア−ム根元に上腕軸
モ−タ出力軸とは同軸上に設けられた前腕軸モ−タによ
り直接もしくは減速機を介して駆動される前腕サブア−
ムと,前腕サブア−ム先端に回転可能に設けられた上腕
サブア−ムと,上腕ア−ム先端・上腕サブア−ム先端に
対して回転可能に設けられた前腕ア−ムと,前記前腕ア
−ム先端に0以上の姿勢決め自由度を有する手首機構を
有する垂直多関節型ロボットにおいて,機構諸元,モ−
タ特性関数,及び動作条件(動作開始点,動作終了点,
動作デュ−ティ,手先負荷質量)に対して,動力学式干
渉項の加速度に対する係数の絶対値を低減可能な付加質
量装着を想定した付加質量パラメ−タ(質量及び設置位
置)及び駆動モ−タの加減速パタ−ンの加減速特徴パラ
メ−タを,モ−タの最大トルク−速度特性及びモ−タの
温度上昇がネックとなる部位の温度上昇許容値とモ−タ
所要平均トルク・所要平均速度の関係を考慮してそれら
の余裕が最小となり,動作時間を最短とできるように,
前腕ア−ム及びもしくは,上腕サブア−ム及びもしく
は,前腕サブア−ムに手首駆動装置を設けて構成したこ
とを特徴とした特定質量配分具備ロボット。
57. Rotation about a vertical axis connected directly or via a speed reducer to a swivel motor installed on a base, or directly connected via a speed reducer. The driven swivel base and the swivel motor output shaft installed on the swivel base were connected directly or via a speed reducer from an upper arm shaft motor having an output rotary shaft orthogonal to each other. A forearm subarm driven by a forearm shaft motor provided coaxially with the upper arm arm and the output shaft of the upper arm motor at the base of the forearm arm or through a speed reducer.
Arm, an upper arm subarm rotatably provided at the tip of the forearm subarm, a forearm arm rotatably provided at the tip of the upper arm arm and the tip of the upper arm subarm, and the forearm arm. -In a vertical articulated robot having a wrist mechanism with 0 or more posture-determining degrees of freedom at the tip of the mechanism,
Characteristics function and operating conditions (operation start point, operation end point,
Additional mass parameters (mass and installation position) and drive mode assuming additional mass mounting that can reduce the absolute value of the coefficient of the dynamic interference term with respect to acceleration (motion duty, hand load mass) Acceleration / deceleration pattern of the motor The parameter parameters are the maximum torque-speed characteristics of the motor and the allowable temperature rise of the part where the temperature rise of the motor becomes a bottleneck and the average torque required for the motor. Considering the relationship between the required average speeds, these margins are minimized so that the operating time can be minimized.
A robot with specific mass distribution characterized in that a wrist drive device is provided on the forearm arm and / or the upper arm subarm and / or the forearm subarm.
【請求項58】ベ−スに設置された旋回軸モ−タより直
接もしくは減速機を介して連結された旋回軸モ−タによ
り直接もしくは減速機を介して連結された鉛直方向軸ま
わりに回転駆動される旋回ベ−スと,前記旋回ベ−スに
設置される旋回軸モ−タ出力軸とは直交する出力回転軸
を有する上腕軸モ−タより直接もしくは減速機を介して
連結された上腕ア−ムと,前記旋回ベ−スに上腕軸モ−
タ出力軸とは同軸上に設けられた前腕軸モ−タにより直
接もしくは減速機を介して駆動される前腕サブア−ム
と,前腕サブア−ム先端に回転可能に設けられた上腕サ
ブア−ムと,上腕ア−ム先端・上腕サブア−ム先端に対
して回転可能に設けられた前腕ア−ムと,前記前腕ア−
ム先端に0以上の姿勢決め自由度を有する手首機構を有
する垂直多関節型ロボットにおいて,機構諸元,モ−タ
特性関数,及び動作条件(動作開始点,動作終了点,動
作デュ−ティ,手先負荷質量),及び加減速特徴パラメ
−タの与えられた駆動モ−タの加減速パタ−ンに対し
て,動力学式干渉項の加速度に対する係数の絶対値を低
減可能な付加質量装着を想定した付加質量パラメ−タ
(質量及び設置位置)を,モ−タの最大トルク−速度特
性及びモ−タの温度上昇がネックとなる部位の温度上昇
許容値とモ−タ所要平均トルク・所要平均速度の関係を
考慮してそれらの余裕が最大となるように,前腕ア−ム
及びもしくは,上腕サブア−ム及びもしくは,前腕サブ
ア−ムに手首駆動装置を設けて構成したことを特徴とし
た特定質量配分具備ロボット。
58. Rotation around a vertical axis connected directly or via a speed reducer to a swivel motor installed directly to the base or via a speed reducer. The driven swivel base and the swivel motor output shaft installed on the swivel base were connected directly or via a speed reducer from an upper arm shaft motor having an output rotary shaft orthogonal to each other. The upper arm arm and the upper arm shaft mode on the turning base.
The output shaft is a forearm subarm driven directly by a forearm shaft motor provided coaxially or through a reduction gear, and an upper arm subarm rotatably provided at the tip of the forearm subarm. A forearm arm rotatably provided with respect to the tip of the upper arm arm and the tip of the upper arm subarm, and the forearm arm
In a vertical articulated robot having a wrist mechanism with 0 or more posture determining freedom at the tip of the robot, the mechanical specifications, the motor characteristic function, and the operating conditions (starting point, ending point, operating duty, Load mass) and acceleration / deceleration pattern of the drive motor to which the acceleration / deceleration characteristic parameters are given, with additional mass attachment that can reduce the absolute value of the coefficient of the dynamic interference term to the acceleration. Assuming the additional mass parameters (mass and installation position), the maximum torque-speed characteristics of the motor and the allowable temperature rise of the part where the temperature rise of the motor becomes a bottleneck and the required average torque of the motor The forearm arm and / or the upper arm subarm and / or the forearm subarm is equipped with a wrist drive device so that the margins thereof are maximized in consideration of the relationship of the average speed. Specific mass distribution Tsu door.
【請求項59】ベ−スに設置された旋回軸モ−タより直
接もしくは減速機を介して連結された旋回軸モ−タによ
り直接もしくは減速機を介して連結された鉛直方向軸ま
わりに回転駆動される旋回ベ−スと,前記旋回ベ−スに
設置される旋回軸モ−タ出力軸とは直交する出力回転軸
を有する上腕軸モ−タより直接もしくは減速機を介して
連結された上腕ア−ムと,前記旋回ベ−スに上腕軸モ−
タ出力軸とは同軸上に設けられた前腕軸モ−タにより直
接もしくは減速機を介して駆動される前腕サブア−ム
と,前腕サブア−ム先端に回転可能に設けられた上腕サ
ブア−ムと,上腕ア−ム先端・上腕サブア−ム先端に対
して回転可能に設けられた前腕ア−ムと,前記前腕ア−
ム先端に0以上の姿勢決め自由度を有する手首機構を有
する垂直多関節型ロボットにおいて,機構諸元,モ−タ
特性関数,及び動作条件(動作開始点,動作終了点,動
作デュ−ティ,手先負荷質量)に対して,動力学式干渉
項の加速度に対する係数の絶対値を低減可能な付加質量
装着を想定した付加質量パラメ−タ(質量及び設置位
置)及び駆動モ−タの加減速パタ−ンの加減速特徴パラ
メ−タを,モ−タの最大トルク−速度特性及びモ−タの
温度上昇がネックとなる部位の温度上昇許容値とモ−タ
所要平均トルク・所要平均速度の関係を考慮してそれら
の余裕が最小となり,動作時間を最短とできるように,
前腕ア−ム及びもしくは,上腕サブア−ム及びもしく
は,前腕サブア−ムに手首駆動装置を設けて構成したこ
とを特徴とした特定質量配分具備ロボット。
59. Rotation around a vertical axis connected directly or via a speed reducer to a swivel motor installed directly to the base or via a speed reducer. The driven swivel base and the swivel motor output shaft installed on the swivel base were connected directly or via a speed reducer from an upper arm shaft motor having an output rotary shaft orthogonal to each other. The upper arm arm and the upper arm shaft mode on the turning base.
The output shaft is a forearm subarm driven directly by a forearm shaft motor provided coaxially or through a reduction gear, and an upper arm subarm rotatably provided at the tip of the forearm subarm. A forearm arm rotatably provided with respect to the tip of the upper arm arm and the tip of the upper arm subarm, and the forearm arm
In a vertical articulated robot having a wrist mechanism with 0 or more posture determining freedom at the tip of the robot, the mechanical specifications, the motor characteristic function, and the operating conditions (starting point, ending point, operating duty, Load mass parameter (mass and installation position) and the acceleration / deceleration pattern of the drive motor, assuming an additional mass attachment that can reduce the absolute value of the coefficient of the dynamic interference term for acceleration -The acceleration / deceleration characteristic parameter of the motor is defined as the relationship between the maximum torque-speed characteristics of the motor and the allowable temperature rise of the part where the temperature rise of the motor is a bottleneck, and the required average torque and required average speed of the motor. In consideration of the above, their margins are minimized so that the operation time can be minimized.
A robot with specific mass distribution characterized in that a wrist drive device is provided on the forearm arm and / or the upper arm subarm and / or the forearm subarm.
【請求項60】ベ−スに設置された旋回軸モ−タより直
接もしくは減速機を介して連結された旋回軸モ−タによ
り直接もしくは減速機を介して連結された鉛直方向軸ま
わりに回転駆動される旋回ベ−スと,前記旋回ベ−スに
設置される旋回軸モ−タ出力軸とは直交する出力回転軸
を有する上腕軸モ−タより直接もしくは減速機を介して
連結された上腕ア−ムと,前記上腕ア−ム先端に回転可
能に設けられた前腕ア−ムと,前記旋回ベ−スに設置さ
れた前腕軸モ−タより直接もしくは減速機とベルトを介
して前腕ア−ム回転軸を駆動し,前記前腕ア−ム先端に
0以上の姿勢決め自由度を有する手首機構を有する垂直
多関節型ロボットにおいて,機構諸元,モ−タ特性関
数,及び動作条件(動作開始点,動作終了点,動作デュ
−ティ,手先負荷質量),及び加減速特徴パラメ−タの
与えられた駆動モ−タの加減速パタ−ンに対して,動力
学式干渉項の加速度に対する係数の絶対値を低減可能な
付加質量装着を想定した付加質量パラメ−タ(質量及び
設置位置)を,モ−タの最大トルク−速度特性及びモ−
タの温度上昇がネックとなる部位の温度上昇許容値とモ
−タ所要平均トルク・所要平均速度の関係を考慮してそ
れらの余裕が最大となるように,前腕ア−ムの前腕出力
軸に対して手首機構とは反対側に手首駆動装置を設けて
構成したことを特徴とした特定質量配分具備ロボット。
60. Rotation about a vertical axis directly or by a swivel motor connected by a swivel motor installed on a base or by a speed reducer. The driven swivel base and the swivel motor output shaft installed on the swivel base were connected directly or via a speed reducer from an upper arm shaft motor having an output rotary shaft orthogonal to each other. An upper arm arm, a forearm arm rotatably provided at the tip of the upper arm arm, and a forearm directly from a forearm shaft motor installed on the turning base or via a speed reducer and a belt. In a vertical articulated robot having a wrist mechanism that drives the arm rotation axis and has a posture freedom degree of 0 or more at the tip of the forearm arm, the mechanical specifications, the motor characteristic function, and the operating condition ( Action start point, action end point, action duty, hand load quality ), And the acceleration / deceleration pattern of the drive motor to which the acceleration / deceleration characteristic parameters are given, with the assumption that additional mass attachment that can reduce the absolute value of the coefficient of the dynamic interference term to the acceleration is assumed. Set the mass parameters (mass and installation position) to the maximum torque-speed characteristics of the motor and the motor.
In consideration of the relationship between the allowable temperature rise of the part where the temperature rise of the motor is a bottleneck and the required average torque and required average speed of the motor, the forearm output shaft of the forearm arm is set so that these margins become maximum. On the other hand, a robot with a specific mass distribution characterized in that a wrist drive device is provided on the side opposite to the wrist mechanism.
【請求項61】ベ−スに設置された旋回軸モ−タより直
接もしくは減速機を介して連結された旋回軸モ−タによ
り直接もしくは減速機を介して連結された鉛直方向軸ま
わりに回転駆動される旋回ベ−スと,前記旋回ベ−スに
設置される旋回軸モ−タ出力軸とは直交する出力回転軸
を有する上腕軸モ−タより直接もしくは減速機を介して
連結された上腕ア−ムと,前記上腕ア−ム先端に回転可
能に設けられた前腕ア−ムと,前記旋回ベ−スに設置さ
れた前腕軸モ−タより直接もしくは減速機とベルトを介
して前腕ア−ム回転軸を駆動し,前記前腕ア−ム先端に
0以上の姿勢決め自由度を有する手首機構を有する垂直
多関節型ロボットにおいて,機構諸元,モ−タ特性関
数,及び動作条件(動作開始点,動作終了点,動作デュ
−ティ,手先負荷質量)に対して,動力学式干渉項の加
速度に対する係数の絶対値を低減可能な付加質量装着を
想定した付加質量パラメ−タ(質量及び設置位置)及び
駆動モ−タの加減速パタ−ンの加減速特徴パラメ−タ
を,モ−タの最大トルク−速度特性及びモ−タの温度上
昇がネックとなる部位の温度上昇許容値とモ−タ所要平
均トルク・所要平均速度の関係を考慮してそれらの余裕
が最小となり,動作時間を最短とできるように,前腕ア
−ムの前腕出力軸に対して手首機構とは反対側に手首駆
動装置を設けて構成したことを特徴とした特定質量配分
具備ロボット。
61. Rotation about a vertical axis connected directly or via a speed reducer to a swivel motor installed directly on the base or via a speed reducer. The driven swivel base and the swivel motor output shaft installed on the swivel base were connected directly or via a speed reducer from an upper arm shaft motor having an output rotary shaft orthogonal to each other. An upper arm arm, a forearm arm rotatably provided at the tip of the upper arm arm, and a forearm directly from a forearm shaft motor installed on the turning base or via a speed reducer and a belt. In a vertical articulated robot having a wrist mechanism that drives the arm rotation axis and has a posture freedom degree of 0 or more at the tip of the forearm arm, the mechanical specifications, the motor characteristic function, and the operating condition ( Action start point, action end point, action duty, hand load quality ), The additional mass parameters (mass and installation position) and the acceleration / deceleration pattern of the drive motor that assume the mounting of an additional mass that can reduce the absolute value of the coefficient of the dynamical interference term with respect to acceleration Acceleration / deceleration characteristic parameters are considered in consideration of the relationship between the maximum torque-speed characteristics of the motor and the allowable temperature rise value of the part where the temperature rise of the motor becomes a bottleneck and the required average torque / average speed of the motor. The specific mass is characterized by a wrist drive device provided on the side of the forearm arm opposite to the wrist mechanism with respect to the forearm output shaft so as to minimize the margin and minimize the operating time. Distribution-equipped robot.
【請求項62】ベ−スに設置された旋回軸モ−タより直
接もしくは減速機を介して連結された旋回軸モ−タによ
り直接もしくは減速機を介して連結された鉛直方向軸ま
わりに回転駆動される旋回ベ−スと,前記旋回ベ−スに
設置される旋回軸モ−タ出力軸とは直交する出力回転軸
を有する上腕軸モ−タより直接もしくは減速機を介して
連結された上腕ア−ムと,前記上腕ア−ム先端に回転可
能に設けられた前腕ア−ムと,前記上腕ア−ム根元に上
腕軸モ−タ出力軸と出力軸が一致するように設置された
前腕軸モ−タより直接もしくは減速機とベルトを介して
前腕ア−ム回転軸を駆動し,前記前腕ア−ム先端に0以
上の姿勢決め自由度を有する手首機構を有する垂直多関
節型ロボットにおいて,機構諸元,モ−タ特性関数,及
び動作条件(動作開始点,動作終了点,動作デュ−テ
ィ,手先負荷質量),及び加減速特徴パラメ−タの与え
られた駆動モ−タの加減速パタ−ンに対して,動力学式
干渉項の加速度に対する係数の絶対値を低減可能な付加
質量装着を想定した付加質量パラメ−タ(質量及び設置
位置)を,モ−タの最大トルク−速度特性及びモ−タの
温度上昇がネックとなる部位の温度上昇許容値とモ−タ
所要平均トルク・所要平均速度の関係を考慮してそれら
の余裕が最大となるように,前腕ア−ムの前腕出力軸に
対して手首機構とは反対側に手首駆動装置を設けて構成
したことを特徴とした特定質量配分具備ロボット。
62. Rotation about a vertical axis connected directly or through a speed reducer to a swivel motor installed directly to the base or through a speed reducer. The driven swivel base and the swivel motor output shaft installed on the swivel base were connected directly or via a speed reducer from an upper arm shaft motor having an output rotary shaft orthogonal to each other. The upper arm arm, the forearm arm rotatably provided at the tip of the upper arm arm, and the upper arm arm were installed so that the output shaft and the output shaft of the upper arm motor coincided with each other. A vertical articulated robot having a wrist mechanism that drives the forearm arm rotation shaft directly from the forearm shaft motor or via a speed reducer and a belt, and has a wrist mechanism at the tip of the forearm arm having a degree of freedom of posture determination of 0 or more. , Mechanical specifications, motor characteristic function, and operating conditions (operation Start point, end point, operation duty, hand load mass), and acceleration / deceleration pattern of the drive motor given the acceleration / deceleration characteristic parameters, the coefficient for the acceleration of the dynamic interference term The additional mass parameters (mass and installation position) that can be used to reduce the absolute value of the motor are used to measure the maximum torque-speed characteristics of the motor and the temperature rise of the part where the temperature rise of the motor becomes a bottleneck. Considering the relationship between the allowable value and the required average torque / required average speed of the motor, the wrist drive device is placed on the side opposite to the wrist mechanism with respect to the forearm output shaft of the forearm arm in order to maximize the margins. A robot equipped with a specific mass distribution characterized by being configured by providing a.
【請求項63】ベ−スに設置された旋回軸モ−タより直
接もしくは減速機を介して連結された旋回軸モ−タによ
り直接もしくは減速機を介して連結された鉛直方向軸ま
わりに回転駆動される旋回ベ−スと,前記旋回ベ−スに
設置される旋回軸モ−タ出力軸とは直交する出力回転軸
を有する上腕軸モ−タより直接もしくは減速機を介して
連結された上腕ア−ムと,前記上腕ア−ム先端に回転可
能に設けられた前腕ア−ムと,前記上腕ア−ム根元に上
腕軸モ−タ出力軸と出力軸が一致するように設置された
前腕軸モ−タより直接もしくは減速機とベルトを介して
前腕ア−ム回転軸を駆動し,前記前腕ア−ム先端に0以
上の姿勢決め自由度を有する手首機構を有する垂直多関
節型ロボットにおいて,機構諸元,モ−タ特性関数,及
び動作条件(動作開始点,動作終了点,動作デュ−テ
ィ,手先負荷質量)に対して,動力学式干渉項の加速度
に対する係数の絶対値を低減可能な付加質量装着を想定
した付加質量パラメ−タ(質量及び設置位置)及び駆動
モ−タの加減速パタ−ンの加減速特徴パラメ−タを,モ
−タの最大トルク−速度特性及びモ−タの温度上昇がネ
ックとなる部位の温度上昇許容値とモ−タ所要平均トル
ク・所要平均速度の関係を考慮してそれらの余裕が最小
となり,動作時間を最短とできるように,前腕ア−ムの
前腕出力軸に対して手首機構とは反対側に手首駆動装置
を設けて構成したことを特徴とした特定質量配分具備ロ
ボット。
63. Rotation about a vertical axis connected directly or via a speed reducer to a swivel motor installed directly on the base or via a speed reducer. The driven swivel base and the swivel motor output shaft installed on the swivel base were connected directly or via a speed reducer from an upper arm shaft motor having an output rotary shaft orthogonal to each other. The upper arm arm, the forearm arm rotatably provided at the tip of the upper arm arm, and the upper arm arm were installed so that the output shaft and the output shaft of the upper arm motor coincided with each other. A vertical articulated robot having a wrist mechanism that drives the forearm arm rotation shaft directly from the forearm shaft motor or via a speed reducer and a belt, and has a wrist mechanism having 0 or more posture determining freedom at the tip of the forearm arm. , Mechanical specifications, motor characteristic function, and operating conditions (operation Additional mass parameters (mass and installation) assuming additional mass installation that can reduce the absolute value of the coefficient of the dynamic interference term for acceleration with respect to the start point, operation end point, operation duty, and hand load mass) Position) and the acceleration / deceleration pattern of the drive motor.The parameters are set to the maximum torque-speed characteristics of the motor and the allowable temperature rise of the part where the temperature rise of the motor becomes a bottleneck. Considering the relationship between the required average torque and the required average speed, the margins are minimized and the operating time is minimized so that the wrist is on the side opposite to the wrist mechanism with respect to the forearm output shaft of the forearm arm. A robot equipped with a specific mass distribution characterized by being provided with a drive device.
JP27644893A 1993-11-05 1993-11-05 Mass distribution determining method for multi-axial mechanism, acceleration/deceleration feature parameter determining method, mass distribution and acceleration/ deceleration feature parameter simultaneous determining method, and additional mass mounted robot and specific mass distribution equipped robot having mass distribution based on the same mass distribution determining method Pending JPH07129210A (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP27644893A JPH07129210A (en) 1993-11-05 1993-11-05 Mass distribution determining method for multi-axial mechanism, acceleration/deceleration feature parameter determining method, mass distribution and acceleration/ deceleration feature parameter simultaneous determining method, and additional mass mounted robot and specific mass distribution equipped robot having mass distribution based on the same mass distribution determining method

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP27644893A JPH07129210A (en) 1993-11-05 1993-11-05 Mass distribution determining method for multi-axial mechanism, acceleration/deceleration feature parameter determining method, mass distribution and acceleration/ deceleration feature parameter simultaneous determining method, and additional mass mounted robot and specific mass distribution equipped robot having mass distribution based on the same mass distribution determining method

Publications (1)

Publication Number Publication Date
JPH07129210A true JPH07129210A (en) 1995-05-19

Family

ID=17569577

Family Applications (1)

Application Number Title Priority Date Filing Date
JP27644893A Pending JPH07129210A (en) 1993-11-05 1993-11-05 Mass distribution determining method for multi-axial mechanism, acceleration/deceleration feature parameter determining method, mass distribution and acceleration/ deceleration feature parameter simultaneous determining method, and additional mass mounted robot and specific mass distribution equipped robot having mass distribution based on the same mass distribution determining method

Country Status (1)

Country Link
JP (1) JPH07129210A (en)

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH09222910A (en) * 1996-02-20 1997-08-26 Yaskawa Electric Corp Controller for multiaxes robot
JP2010207986A (en) * 2009-03-11 2010-09-24 Toyota Motor Corp Robot device and method of controlling the same

Cited By (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH09222910A (en) * 1996-02-20 1997-08-26 Yaskawa Electric Corp Controller for multiaxes robot
WO1997031303A1 (en) * 1996-02-20 1997-08-28 Kabushiki Kaisha Yaskawa Denki Controller of multi-axis robot
US6069463A (en) * 1996-02-20 2000-05-30 Kabushiki Kaisha Yaskawa Denki Controller of multi-axis robot
JP2010207986A (en) * 2009-03-11 2010-09-24 Toyota Motor Corp Robot device and method of controlling the same
US8818559B2 (en) 2009-03-11 2014-08-26 Toyota Jidosha Kabushiki Kaisha Robot apparatus and control method therefor

Similar Documents

Publication Publication Date Title
JP6167770B2 (en) Multi-axis robot trajectory generation method and multi-axis robot controller
JP6268819B2 (en) Trajectory generation method for multi-axis robot
US11839979B2 (en) Dual mode free-drive of robot arm
US6684128B1 (en) Robot and method of controlling the robot
JPWO2002066210A1 (en) Robot controller
JP6123595B2 (en) Speed control method for 2-axis robot
JP3316967B2 (en) Robot control device
JPH07129210A (en) Mass distribution determining method for multi-axial mechanism, acceleration/deceleration feature parameter determining method, mass distribution and acceleration/ deceleration feature parameter simultaneous determining method, and additional mass mounted robot and specific mass distribution equipped robot having mass distribution based on the same mass distribution determining method
Kazerooni Statically balanced direct drive manipulator
JPH08161015A (en) Driving control method for articulated robot
WO1999008167A1 (en) Method of generating acceleration/deceleration pattern for industrial robot
US20230191603A1 (en) Input shaping control of a robot arm in different reference spaces
JP5656189B2 (en) Trajectory information generation device for articulated robot arm type transfer device
JP5633268B2 (en) Robot control device
CN116901063B (en) Redundant space mechanical arm track planning method based on quadratic programming
JP2002331479A (en) Method for controlling industrial robot
Zhang et al. Mechanical design and dynamic compliance control of lightweight manipulator
JP3373351B2 (en) Articulated robot
JPH06190750A (en) Robot control device
JPH0255803B2 (en)
WO2024024578A1 (en) Robot control method and robot control device
JPH04160604A (en) Robot control system
Berner et al. The influence of joint angle constraints on the optimum design of a planar robot manipulator following a complicated prescribed path
JP3594985B2 (en) Robot control device
JP2004090111A (en) Redundant manipulator, controlling device, control method, and control program