JPH06182681A - Robot remote control evaluating device - Google Patents

Robot remote control evaluating device

Info

Publication number
JPH06182681A
JPH06182681A JP4338296A JP33829692A JPH06182681A JP H06182681 A JPH06182681 A JP H06182681A JP 4338296 A JP4338296 A JP 4338296A JP 33829692 A JP33829692 A JP 33829692A JP H06182681 A JPH06182681 A JP H06182681A
Authority
JP
Japan
Prior art keywords
robot
robot arm
error
target value
joint angle
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Granted
Application number
JP4338296A
Other languages
Japanese (ja)
Other versions
JP3208687B2 (en
Inventor
Yoshikazu Kodama
義和 児玉
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.)
Fujitsu Ltd
Original Assignee
Fujitsu 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 Fujitsu Ltd filed Critical Fujitsu Ltd
Priority to JP33829692A priority Critical patent/JP3208687B2/en
Publication of JPH06182681A publication Critical patent/JPH06182681A/en
Application granted granted Critical
Publication of JP3208687B2 publication Critical patent/JP3208687B2/en
Anticipated expiration legal-status Critical
Expired - Fee Related legal-status Critical Current

Links

Landscapes

  • Manipulator (AREA)

Abstract

PURPOSE:To calculate and evaluate the attitude/orbit of a robot and the joint angle of a robot arm when the robot arm is moved and transmit the data to the robot when the evaluation is satisfactory in a robot remote control evaluat ing device evaluating the remote control of the robot. CONSTITUTION:The robot remote control evaluating device is provided with a robot motion simulation section 22 calculating the attitude angle/orbit position of a robot based on the target value of a robot arm, a robot arm motion simulation section 23 calculating the state quantity of the robot arm based on the target value of the robot arm, and an error detection section 25 detecting the errors between the calculated attitude angle/orbit position of a robot and the state quantity of the robot arm and the target values (or target values specified in advance). The errors detected by the error detection section 25 are outputted.

Description

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

【0001】[0001]

【産業上の利用分野】本発明は、ロボットの遠隔操作を
評価するロボット遠隔操作評価装置に関するものであ
る。
BACKGROUND OF THE INVENTION 1. Field of the Invention The present invention relates to a robot remote control evaluation device for evaluating remote control of a robot.

【0002】遠隔操作するロボット、例えば宇宙ロボッ
トは、地上から遠隔操作する搭載ロボットアームによっ
て、宇宙ステーションの組み立て、物資の補給などの作
業を行う人工衛星である。地上に置かれたマスタアーム
を操作することによって、これと連動して動作するよう
にした宇宙ロボット搭載のロボットアームを駆動する。
このため、マスタアームを操作するときに当該マスタア
ームから出力するロボットアーム関節角の目標値を遠隔
操作指令として、逐次、宇宙ロボットへ送信する。宇宙
ロボット側は、このロボットアーム関節角の目標値もと
に、宇宙ロボット搭載のロボットアームを駆動する。
A remote-controlled robot, for example, a space robot, is an artificial satellite that carries out operations such as assembling a space station and replenishing supplies with an on-board robot arm that is remotely controlled from the ground. By operating a master arm placed on the ground, a robot arm equipped with a space robot that operates in conjunction with this is driven.
Therefore, when the master arm is operated, the target value of the robot arm joint angle output from the master arm is sequentially transmitted to the space robot as a remote operation command. The space robot side drives the robot arm equipped with the space robot based on the target value of the robot arm joint angle.

【0003】宇宙ロボットは、通信装置の重量制限、消
費電力制限のために、通信容量が制限される。そのた
め、地上から送信する際にロボットアーム関節角の目標
値をサンプリングなどによりデータ圧縮してデータ量を
低減し、宇宙ロボット側でロボットアーム関節角データ
をデータ補間などにより元の目標値を再生し、宇宙ロボ
ット搭載のロボットアームを駆動する。この際、遠隔操
作指令であるロボットアーム関節角の目標値についてそ
の妥当性を評価する必要がある。
The space robot has a limited communication capacity due to the weight limitation of the communication device and the power consumption limitation. Therefore, when transmitting from the ground, the target value of the robot arm joint angle is compressed by sampling etc. to reduce the data amount, and the space robot side reproduces the original target value of the robot arm joint angle data by data interpolation etc. , Drive a robot arm equipped with a space robot. At this time, it is necessary to evaluate the validity of the target value of the robot arm joint angle which is a remote control command.

【0004】[0004]

【従来の技術】従来、宇宙ロボットの遠隔操作は、地上
のロボットと同様な観点から、宇宙ロボット搭載のロボ
ットアームの動作を模擬するロボットアーム動作模擬装
置を用いて、地上から遠隔操作する際のロボットアーム
の位置誤差を測定し、ロボットアーム関節角の目標値に
ついてその妥当性を評価するようにしていた。
2. Description of the Related Art Conventionally, a remote control of a space robot has been performed from the same viewpoint as that of a ground robot by using a robot arm operation simulator for simulating the operation of a robot arm mounted on the space robot. The position error of the robot arm is measured, and the validity of the target value of the robot arm joint angle is evaluated.

【0005】以下従来の技術について説明する。 (1) 宇宙ロボットの遠隔操作において発生する現
象。 宇宙ロボットの遠隔操作の際に発生する現象には、人
工衛星の側面と、ロボット遠隔操作の側面がある。
The conventional technique will be described below. (1) Phenomena that occur during remote control of space robots. Phenomena that occur during remote control of space robots include the side of artificial satellites and the side of robot remote control.

【0006】 人工衛星の側面:宇宙ロボットは無重
力の宇宙空間を飛行しているため、宇宙ロボット搭載の
ロボットアームを駆動すると、宇宙ロボット本体は反作
用を受けて、姿勢の回転と軌道の移動が発生する。
Side of artificial satellite: Since the space robot is flying in a weightless space, when the robot arm equipped with the space robot is driven, the space robot body receives a reaction and the posture is rotated and the orbit is moved. To do.

【0007】 ロボットの遠隔操作の側面:遠隔操作
指令を伝送するために、指令が届くのに時間がかかる
(時間遅れが発生する)。また、伝送量に制限があるた
め、データ量を減らす必要がある(データ圧縮/再
生)。
Aspects of Remote Control of Robot: It takes a long time to reach a command because a remote control command is transmitted (a time delay occurs). Further, since the transmission amount is limited, it is necessary to reduce the data amount (data compression / reproduction).

【0008】(2) 従来の技術 人工衛星に搭載された可動物を動かして姿勢制御/
軌道制御することは行われている。
(2) Conventional technology Attitude control / moving a movable object mounted on an artificial satellite
Orbit control is done.

【0009】 人工衛星の姿勢運動/軌道運動をシミ
ュレーションすることは行われている。 地上に固定されたロボットの運動を事前にシミュレ
ーションし、動作を確認することが行われている。
Simulations of attitude / orbital motions of satellites have been performed. The motion of a robot fixed on the ground is simulated in advance to confirm its operation.

【0010】 時間遅れ、データ圧縮/再生などの通
信装置の特性をシミュレーションすることが行われてい
る。
Simulations of characteristics of a communication device such as time delay and data compression / reproduction are performed.

【0011】[0011]

【発明が解決しようとする課題】上述したように宇宙ロ
ボットは、地上のロボットと異なり、無重力の宇宙空間
を飛行しているため、宇宙ロボット搭載のロボットアー
ムを駆動すると、宇宙ロボット本体が反作用を受けて、
姿勢の回転と軌道の移動が発生する。通常、宇宙ロボッ
トの姿勢や軌道を保持するために姿勢制御装置および軌
道制御装置が搭載されている。ロボットアームの動きの
方向と速さによっては、姿勢/軌道を安定に保持するこ
とができない。宇宙ロボットは地上との通信のために、
常に通信アンテナを地上に向けており、宇宙ロボットの
姿勢/軌道が変化するとアンテナの向きが変わり、地上
との通信が途絶して遠隔操作ができなくなる。
As described above, the space robot, unlike the ground robot, flies in the weightless space, so that when the robot arm equipped with the space robot is driven, the space robot body causes a reaction. receive,
Posture rotation and orbit movement occur. Usually, an attitude control device and an orbit control device are mounted to hold the attitude and orbit of the space robot. Depending on the direction and speed of movement of the robot arm, the posture / trajectory cannot be stably maintained. Space robots are
The communication antenna is always directed to the ground, and if the attitude / orbit of the space robot changes, the direction of the antenna changes, and communication with the ground is interrupted and remote control becomes impossible.

【0012】従って、宇宙ロボットの姿勢運動/軌道運
動を無視した従来の手法では、宇宙ロボット搭載のロボ
ットアームを安定に遠隔操作することができないという
問題があった。また、宇宙ロボットだけでなく、油上に
浮かばせたりしたときにも同様に、支点がなくなりロボ
ットアームの反作用によりロボット本体の姿勢や位置が
移動したりしてまう問題もあった。
Therefore, the conventional method ignoring the attitude motion / orbital motion of the space robot has a problem that the robot arm mounted on the space robot cannot be remotely controlled in a stable manner. Further, not only the space robot, but also when it is floated on oil, there is a problem that the fulcrum disappears and the posture and position of the robot main body move due to the reaction of the robot arm.

【0013】本発明は、これらの問題を解決するため、
ロボットアームの移動に伴うロボットの姿勢/軌道およ
びロボットアームの関節角などを算出して評価したり、
評価良好のときに実機(ロボット)にデータを送信した
りすることを目的としている。
The present invention solves these problems.
Calculate and evaluate the posture / trajectory of the robot along with the movement of the robot arm and the joint angle of the robot arm.
The purpose is to send data to the actual machine (robot) when the evaluation is good.

【0014】[0014]

【課題を解決するための手段】図1を参照して課題を解
決するための手段を説明する。図1において、ロボット
運動模擬部22は、ロボットアームの目標値をもとに、
ロボットの姿勢角/軌道位置を算出するものである。
[Means for Solving the Problems] Means for solving the problems will be described with reference to FIG. In FIG. 1, the robot motion simulation unit 22 uses the target value of the robot arm as a basis.
The posture angle / trajectory position of the robot is calculated.

【0015】ロボットアーム動作模擬部23は、ロボッ
トアームの目標値をもとに、ロボットアーム状態量(例
えば関節角など)を算出するものである。誤差検出部3
5は、算出されたロボットの姿勢角/軌道位置およびロ
ボットアーム状態量と上記目標値(あるいは予め指定し
た目標値)との誤差を検出するものである。
The robot arm operation simulation unit 23 calculates a robot arm state quantity (for example, a joint angle) based on a target value of the robot arm. Error detector 3
Reference numeral 5 is for detecting an error between the calculated posture angle / trajectory position and robot arm state quantity and the target value (or a target value designated in advance).

【0016】[0016]

【作用】本発明は、図1に示すように、ロボット運動模
擬部22がロボットアームの目標値をもとにロボットの
姿勢角/軌道位置を算出し、ロボットアーム動作模擬部
23がロボットアームの目標値をもとにロボットアーム
状態量を算出し、誤差検出部35が算出されたロボット
の姿勢角/軌道位置およびロボットアーム状態量と目標
値(あるいは予め指定した目標値)との誤差を検出し、
この検出した誤差を出力するようにしている。
In the present invention, as shown in FIG. 1, the robot motion simulating section 22 calculates the posture angle / trajectory position of the robot based on the target value of the robot arm, and the robot arm motion simulating section 23 determines the robot arm motion. The robot arm state quantity is calculated based on the target value, and the error detection unit 35 detects an error between the calculated posture angle / trajectory position of the robot and the robot arm state quantity and the target value (or a preset target value). Then
The detected error is output.

【0017】この際、誤差検出部35が検出した誤差に
ついて予め規定した誤差許容値範囲内のときに良好、誤
差許容値範囲外のときに不良と評価して出力するように
している。
At this time, the error detected by the error detection unit 35 is evaluated as good when it is within the predetermined error allowable value range, and is judged as bad when it is outside the error allowable value range, and is output.

【0018】また、誤差検出部35が検出した誤差につ
いて予め規定した誤差許容値範囲内のときに良好と評価
してロボットアームの目標値を遠隔操作対象のロボット
に向けて送信し(あるいはロボットを駆動し)、一方、
誤差許容値範囲外のときに不良と評価してロボットアー
ムの目標値を遠隔操作対象のロボットに向けて送信する
ことを抑止(あるいはロボットを駆動することを抑止)
するようにしている。
Further, the error detected by the error detection unit 35 is evaluated as good when it is within a predetermined error allowable value range, and the target value of the robot arm is transmitted to the remote operation target robot (or Drive), meanwhile,
Suppress sending of the target value of the robot arm to the remotely operated robot that is evaluated as defective when it is out of the allowable error range (or suppress driving of the robot)
I am trying to do it.

【0019】従って、ロボットアームの移動に伴うロボ
ットの姿勢/軌道およびロボットアーム状態量(例えば
関節角など)を算出して評価したり、評価良好のときに
実機(ロボット)にデータを送信したりすることが可能
となる。
Therefore, the posture / trajectory of the robot and the robot arm state quantity (for example, joint angle) accompanying the movement of the robot arm are calculated and evaluated, or data is transmitted to the actual machine (robot) when the evaluation is good. It becomes possible to do.

【0020】[0020]

【実施例】次に、図1から図9を用いて本発明の実施例
の構成および動作を順次詳細に説明する。以下宇宙ロボ
ットを例に説明する。
DESCRIPTION OF THE PREFERRED EMBODIMENTS Next, the construction and operation of an embodiment of the present invention will be described in detail with reference to FIGS. A space robot will be described below as an example.

【0021】図1は、本発明の1実施例構成図を示す。
図1において、模擬部10は、ここでは地上模擬部であ
って、関節角出力部11および遠隔操作指令送信部12
から構成されるものである。
FIG. 1 shows a block diagram of an embodiment of the present invention.
In FIG. 1, the simulation unit 10 is a ground simulation unit here, and includes a joint angle output unit 11 and a remote operation command transmission unit 12.
It is composed of

【0022】関節角出力部11は、マスタアーム装置あ
るいはこれと同等の装置によりロボットアーム状態量
(ロボットアーム関節角など)の目標値を出力するもの
である。
The joint angle output unit 11 outputs a target value of the robot arm state quantity (robot arm joint angle or the like) by a master arm device or a device equivalent thereto.

【0023】遠隔操作指令送信部12は、ロボットアー
ム状態量の目標値のデータ圧縮および地上からこのデー
タ圧縮後のデータの送信を模擬するものである。ロボッ
ト模擬部20は、ここでは宇宙ロボット模擬部であっ
て、遠隔操作指令受信部21、ロボット運動模擬部2
2、およびロボットアーム動作模擬部23から構成され
るものである。
The remote control command transmitter 12 simulates data compression of the target value of the robot arm state quantity and transmission of data after this data compression from the ground. The robot simulating unit 20 is a space robot simulating unit here, and includes a remote operation command receiving unit 21 and a robot motion simulating unit 2.
2 and the robot arm operation simulation unit 23.

【0024】遠隔操作指令受信部21は、遠隔操作指令
送信部12から送信された宇宙ロボットのロボットアー
ム状態量の目標値を受信し、受信した目標値から元の目
標値の再生を模擬するものである。
The remote operation command receiving section 21 receives the target value of the robot arm state quantity of the space robot transmitted from the remote operation command transmitting section 12, and simulates the reproduction of the original target value from the received target value. Is.

【0025】ロボット運動模擬部22は、ここでは宇宙
ロボット運動模擬部であって、ロボットアームの動作/
姿勢制御/軌道制御による影響を含む宇宙ロボットの姿
勢角および軌道位置を模擬するものであり、ロボットア
ーム状態量の目標値をもとにロボットの姿勢角/軌道位
置を算出するものである。
The robot motion simulating unit 22 is a space robot motion simulating unit in this case, and operates / moves the robot arm.
It simulates the attitude angle and the orbit position of the space robot including the influence of the attitude control / orbit control, and calculates the attitude angle / orbit position of the robot based on the target value of the state quantity of the robot arm.

【0026】ロボットアーム動作模擬部23は、宇宙ロ
ボットに搭載のロボットアームの動作を模擬するもので
あって、ロボットアーム状態量の目標値をもとにロボッ
トアームの状態量(関節角、先端位置、姿勢)を算出す
るものである。
The robot arm operation simulation unit 23 simulates the operation of the robot arm mounted on the space robot, and based on the target value of the robot arm state quantity, the robot arm state quantity (joint angle, tip position). , Posture) is calculated.

【0027】遠隔操作指令評価部30は、遠隔操作の指
令を評価するものであって、誤差検出部35、評価表示
部33、および送信判定部34から構成されるものであ
る。誤差検出部35は、算出されたロボットの姿勢角/
軌道位置およびロボットアーム状態量と目標値(あるい
は予め指定した目標値)との誤差を検出するものであっ
て、姿勢誤差/軌道誤差検出部31およびアーム状態量
誤差検出部32から構成されるものである。
The remote operation command evaluation section 30 evaluates a remote operation command, and comprises an error detection section 35, an evaluation display section 33, and a transmission determination section 34. The error detection unit 35 calculates the calculated posture angle of the robot /
An error detector for detecting an error between a trajectory position and a robot arm state quantity and a target value (or a preset target value), which is composed of a posture error / trajectory error detecting section 31 and an arm state quantity error detecting section 32. Is.

【0028】姿勢誤差/軌道誤差検出部31は、ロボッ
トの姿勢誤差および軌道誤差を検出するものであって、
ロボット運動模擬部22が模擬して算出した姿勢角およ
び軌道位置をもとに、予め指定された目標値との誤差を
検出するものである(図2参照)。
The posture error / trajectory error detection unit 31 detects a posture error and a trajectory error of the robot.
Based on the posture angle and the trajectory position which are simulated by the robot motion simulating unit 22, an error from a preset target value is detected (see FIG. 2).

【0029】アーム状態量誤差検出部32は、ロボット
アームの状態量の誤差を検出するものであって、ロボッ
トアーム動作模擬部23が模擬して算出したロボットア
ームの状態量(関節角、先端の位置、姿勢)をもとに、
指令された目標値との誤差を検出するものである(図2
参照)。
The arm state amount error detection unit 32 detects an error in the state amount of the robot arm, and the state amount of the robot arm (joint angle, tip end Position, posture)
This is to detect an error from the commanded target value (Fig. 2
reference).

【0030】評価表示部33は、誤差検出部35によっ
て検出された誤差を表示したり、目標値を越えたときの
その旨を併せて表示したりなどするものである。送信判
定部34は、評価結果が良好のときにロボットアーム状
態量目標値をロボット実機40に送信し、評価結果が不
良のときにロボットアーム状態量の目標値の送信を抑止
したりするものである。
The evaluation display section 33 displays the error detected by the error detection section 35, and also displays the fact when the target value is exceeded. The transmission determination unit 34 transmits the robot arm state quantity target value to the actual robot 40 when the evaluation result is good, and suppresses the transmission of the robot arm state quantity target value when the evaluation result is bad. is there.

【0031】ロボット実機40は、ロボットの実機であ
って、ここでは、宇宙ロボットである。次に、図2を用
いて図1の構成の動作を詳細に説明する。
The actual robot 40 is an actual robot, and is a space robot here. Next, the operation of the configuration of FIG. 1 will be described in detail with reference to FIG.

【0032】図2において、S1は、図1の地上模擬部
10がロボットアーム関節角の目標値を生成する。これ
は、例えばマスタアーム装置のロボットアームをオペレ
ータが操作してロボットアーム関節角の目標値を生成す
る。
In FIG. 2, in S1, the ground simulator 10 of FIG. 1 generates a target value of the robot arm joint angle. For example, an operator operates a robot arm of a master arm device to generate a target value of a robot arm joint angle.

【0033】S2は、データをサンプリングする。これ
は、S1で生成したロボットアーム関節角の目標値を、
データ圧縮するために所定周期でサンプリングする。こ
のサンプリングして圧縮した後のロボットアーム関節角
の目標値をロボット模擬部20に通知する。
S2 samples the data. This is the target value of the robot arm joint angle generated in S1,
Sampling is performed at a predetermined cycle for data compression. The robot simulation unit 20 is notified of the target value of the robot arm joint angle after this sampling and compression.

【0034】S3は、S2で通知を受けた圧縮したロボ
ットアーム関節角の目標値について、データ補間して元
のロボットアーム関節角の目標値を再生する。S4は、
宇宙ロボットの運動模擬する。これにより、ロボットア
ーム関節角の目標値へロボットアームが移動することの
反作用としてロボット自身の姿勢角および軌道位置を計
算機上で模擬する。
In S3, the compressed target value of the robot arm joint angle notified in S2 is interpolated to reproduce the original target value of the robot arm joint angle. S4 is
Simulate the motion of a space robot. Thereby, the posture angle and the trajectory position of the robot itself are simulated on the computer as a reaction of the movement of the robot arm to the target value of the joint angle of the robot arm.

【0035】S5は、ロボットアームの動作模擬する。
これは、ロボットアーム関節角の目標値への移動指令に
対応して、ロボットアームの関節角を計算機上で模擬す
る。S6は、S4の宇宙ロボット運動模擬によって生成
したロボットの姿勢角/軌道位置について、事前に入力
した姿勢角/軌道位置の目標値と比較し、その誤差とし
て姿勢角誤差/軌道位置誤差を検出する。
At S5, the operation of the robot arm is simulated.
This simulates the joint angle of the robot arm on a computer in response to the movement command to the target value of the robot arm joint angle. In S6, the attitude angle / orbit position of the robot generated by the space robot motion simulation in S4 is compared with the target value of the attitude angle / orbit position input in advance, and the attitude angle error / orbit position error is detected as the error. .

【0036】S7は、S5のロボットアーム運動模擬に
よって生成したロボットアームの関節角について、目標
値と比較し、その誤差としてロボットアーム関節角誤差
を検出する。
In S7, the joint angle of the robot arm generated by the robot arm motion simulation in S5 is compared with a target value, and a robot arm joint angle error is detected as the error.

【0037】S8は、S6およびS7で検出した誤差を
表示する(図3の(a)参照)。S9は、S6、S7で
検出したそれぞれの誤差(ロボットの姿勢角誤差/軌道
位置誤差、ロボットアーム関節角誤差)がそれぞれ事前
入力された誤差許容範囲内か判別する。
At S8, the error detected at S6 and S7 is displayed (see (a) of FIG. 3). In step S9, it is determined whether the respective errors (robot angle error / trajectory position error, robot arm joint angle error) detected in steps S6 and S7 are within pre-input error allowable ranges.

【0038】S10は、S9で誤差許容範囲内か判別
し、その評価結果を表示する。例えば図3に示すように
評価を表示する。S11は、S9の評価結果をもとに、
全て「良好」か判定する。YESの場合には、全て良好
であって、当該ロボットアーム関節角の目標値によって
実機のロボットに搭載したロボットアームを駆動しても
アンテナの向きがずれて送信不可となったりの事態が発
生しないと模擬によって判明したので、この模擬後のロ
ボットアーム関節角の目標値をS12で実機の宇宙ロボ
ットに送信する。一方、評価結果が「不良」の場合に
は、ロボットアーム関節角の目標値を宇宙ロボットに送
信することを抑止する。
In step S10, it is determined in step S9 whether the error is within the allowable range, and the evaluation result is displayed. For example, the evaluation is displayed as shown in FIG. S11 is based on the evaluation result of S9.
Determine whether all are “good”. In the case of YES, all are good, and even if the robot arm mounted on the actual robot is driven by the target value of the joint angle of the robot arm, the situation in which the antenna is misaligned and transmission becomes impossible does not occur. The target value of the robot arm joint angle after the simulation is transmitted to the actual space robot in S12. On the other hand, when the evaluation result is "poor", the transmission of the target value of the robot arm joint angle to the space robot is suppressed.

【0039】以上によって、ロボットアーム関節角の目
標値について、計算機上でロボットの姿勢や軌道位置に
与える影響が誤差許容範囲内であり、かつロボットアー
ムの目標値との誤差が誤差許容範囲内であって駆動可能
な範囲内であると模擬して判明したので、当該ロボット
アーム関節角の目標値を実機の宇宙ロボットに送信す
る。これを受け取った実機の宇宙ロボットは、指令され
た目標値にロボットアームを駆動する。
As described above, regarding the target value of the robot arm joint angle, the influence on the posture and the trajectory position of the robot on the computer is within the error allowable range, and the error with the target value of the robot arm is within the error allowable range. Since it was found by simulating that it is within the driveable range, the target value of the robot arm joint angle is transmitted to the actual space robot. Upon receiving this, the actual space robot drives the robot arm to the commanded target value.

【0040】図3は、本発明の評価結果例を示す。これ
は、図2のS8の誤差表示およびS10の評価結果表示
の例である。図3の(a)は、個別評価結果例を示す。
ここで、宇宙ロボットは、無重力の状態で宇宙を飛行す
るロボットであって、 ・姿勢角:Φ、Θ、Ψ ・軌道位置:X、Y、Z の6つのパラメタで表現する。ここでは、各値は宇宙ロ
ボットの重心の値である。
FIG. 3 shows an example of the evaluation result of the present invention. This is an example of the error display in S8 and the evaluation result display in S10 of FIG. FIG. 3A shows an example of the individual evaluation result.
Here, the space robot is a robot that flies in the universe in a weightless state, and is represented by six parameters: posture angle: Φ, Θ, Ψ, orbital position: X, Y, Z. Here, each value is the value of the center of gravity of the space robot.

【0041】ロボットアームは、宇宙ロボットに搭載し
たロボットアームであって、 ・関節角:θ1、θ2、θ3、θ4、θ5、θ6 の6つのパラメタ(関節角)で表現する。
The robot arm is a robot arm mounted on a space robot. Joint angles are represented by six parameters (joint angles) of θ1, θ2, θ3, θ4, θ5 and θ6.

【0042】模擬計算値は、図2のS4、S5で模擬し
たロボットの姿勢角/軌道位置、ロボットアーム関節角
である。目標値は、事前に入力した目標値あるいは指令
されたロボットアーム関節角目標値である。
The simulated calculated values are the posture angle / trajectory position and the robot arm joint angle of the robot simulated in S4 and S5 of FIG. The target value is a previously input target value or a commanded robot arm joint angle target value.

【0043】誤差Δは、模擬計算値と目標値との誤差で
ある。誤差許容範囲は、事前入力した誤差許容範囲であ
る。評価は、誤差Δが誤差許容範囲内のときに良好、そ
れ以外のときに不良と評価したものである。
The error Δ is an error between the simulated calculation value and the target value. The error allowable range is a pre-input error allowable range. The evaluation is evaluated as good when the error Δ is within the error allowable range, and is evaluated as bad otherwise.

【0044】以上の図3の(a)に示す誤差Δを図2の
S8の誤差表示として表示すると共に、個別の評価を図
2のS10の評価結果表示として表示する。図3の
(b)は、組み合わせ評価例を示す。ここで、状態量
は、図示のようにΦ、Θ、Ψ、X、Y、Z、θ1、θ
2、θ3、θ4、θ5、θ6であって、図3の(a)の
状態量をそれぞれ表す。
The error Δ shown in FIG. 3A is displayed as the error display in S8 of FIG. 2 and the individual evaluation is displayed as the evaluation result display in S10 of FIG. FIG. 3B shows an example of combination evaluation. Here, the state quantities are Φ, Θ, Ψ, X, Y, Z, θ1, θ as shown in the figure.
2, θ3, θ4, θ5, θ6, which represent the state quantities of FIG.

【0045】組み合わせ1は、図示の○の各状態量が全
て良好のときに組み合わせ評価として良好と判定する。
図3の(a)の場合には、「良好」となる。組み合わせ
2は、同様に、図示の○の各状態量が全て良好のときに
組み合わせ評価として良好と判定する。図3の(a)の
場合には、「不良」となる。
The combination 1 is judged as good as the combination evaluation when all the state quantities of the circles in the figure are good.
In the case of FIG. 3A, it is “good”. Similarly, the combination 2 is determined to be good as a combination evaluation when all the state quantities of the circles in the figure are good. In the case of (a) of FIG. 3, it is “defective”.

【0046】総合評価は、図示の○の各状態量(全部の
状態量)が全て良好のときに組み合わせ評価として良好
と判定する。図3の(a)の場合には、「不良」とな
る。図3の(c)は、サンプリング周期評価例を示す。
ここで、サプリング時間幅(秒)はロボットアーム関節
角の目標値のサンプリング時間幅(秒)である。評価
は、図示のように評価する。
In the comprehensive evaluation, when all the state quantities (all state quantities) shown in the figure are all good, the combination evaluation is judged to be good. In the case of (a) of FIG. 3, it is “defective”. FIG. 3C shows an example of sampling period evaluation.
Here, the sampling time width (second) is the sampling time width (second) of the target value of the robot arm joint angle. The evaluation is performed as shown.

【0047】図3の(d)は、サンプリング周期評価の
説明図を示す。 ・一般に、T1>T2のときΔ1>Δ2である。 ・サンプリング時間幅Tを小さくすれば、誤差Δが小さ
くなるが、データ量は多くなる。Δをむやみに増加させ
ずにデータ量を少なくするためにTが必要となり、適度
なTの値を決める必要がある。上記図3の(c)の場合
には、サンプリング時間幅(秒)が0.001、0.0
1のときは評価「良好」、0.1、1.0のとき評価
「不良」と決めている。
FIG. 3D is an explanatory diagram of the sampling cycle evaluation. -Generally, when T1> T2, Δ1> Δ2. The smaller the sampling time width T, the smaller the error Δ, but the larger the amount of data. T is required in order to reduce the data amount without increasing Δ unnecessarily, and it is necessary to determine an appropriate value of T. In the case of FIG. 3C, the sampling time width (second) is 0.001, 0.0
The evaluation is "good" when 1 and "bad" when 0.1 and 1.0.

【0048】次に、図4および図5を用いて本発明の他
の実施例構成および動作を詳細に説明する。これは、関
節角出力部11、地上模擬計算機13、宇宙ロボット運
動模擬/遠隔操作指令評価計算機、およびロボットアー
ム動作模擬装置26を使用したときの他の実施例構成お
よび動作である。
Next, the configuration and operation of another embodiment of the present invention will be described in detail with reference to FIGS. This is another embodiment configuration and operation when the joint angle output unit 11, the ground simulation computer 13, the space robot motion simulation / remote operation command evaluation computer, and the robot arm operation simulation device 26 are used.

【0049】図4において、関節角出力部(関節角出力
装置)11は、マスタアーム装置を使用してロボットア
ーム関節角の目標値を生成するものである。地上模擬計
算機13は、ロボットアーム関節角データのサンプリン
グを行い、サンプリング後のロボットアーム関節角の目
標値を生成するものである。
In FIG. 4, a joint angle output unit (joint angle output device) 11 uses a master arm device to generate a target value of a robot arm joint angle. The ground simulation computer 13 samples the robot arm joint angle data and generates a target value of the sampled robot arm joint angle.

【0050】宇宙ロボット運動模擬/遠隔操作指令評価
計算機は、ロボットアーム関節角データ補間部24、宇
宙ロボット運動模擬部25、姿勢誤差/軌道誤差検出部
31、アーム関節角誤差検出部32、評価表示部33、
および送信判定部34などから構成されるものである。
ここで、31、32、33、34は、図1の構成の同一
のものと同じであるので説明を省略する。
The space robot motion simulation / remote operation command evaluation computer includes a robot arm joint angle data interpolation unit 24, a space robot motion simulation unit 25, a posture error / trajectory error detection unit 31, an arm joint angle error detection unit 32, and an evaluation display. Part 33,
And a transmission determination unit 34 and the like.
Here, 31, 32, 33, and 34 are the same as those in the configuration of FIG.

【0051】ロボットアーム関節角データ補間部24
は、地上模擬計算機13から送信されてきた、サンプリ
ング後のロボットアーム関節角の目標値を受信し、補間
して元のロボットアーム関節角の目標値を生成するもの
である。
Robot arm joint angle data interpolation unit 24
Is to receive the sampled robot arm joint angle target value transmitted from the ground simulation computer 13 and interpolate it to generate the original robot arm joint angle target value.

【0052】宇宙ロボット運動模擬部25は、ロボット
アーム関節角データ補間部24によって補間されたロボ
ットアーム関節角の目標値をもとに、宇宙ロボットの姿
勢角/軌道位置を模擬するものである。
The space robot motion simulation unit 25 simulates the attitude angle / orbit position of the space robot based on the target value of the robot arm joint angle interpolated by the robot arm joint angle data interpolation unit 24.

【0053】ロボットアーム動作模擬装置26は、ロボ
ットアーム関節角データ補間部24からのロボットアー
ム関節角の目標値をもとに、ロボットアームの動作を模
擬し、ロボットアーム関節角を生成するものである。
The robot arm operation simulation device 26 simulates the operation of the robot arm based on the target value of the robot arm joint angle from the robot arm joint angle data interpolating section 24, and generates the robot arm joint angle. is there.

【0054】図5において、S21は、地上模擬計算機
13を初期設定する。S22は、ロボットアーム関節角
データをサンプリングする。これは、関節角出力部11
からロボットアーム関節角の目標値を取り込み、サンプ
リングする。
In FIG. 5, S21 initializes the ground simulation computer 13. In S22, the robot arm joint angle data is sampled. This is the joint angle output unit 11
The target value of the robot arm joint angle is fetched from and sampled.

【0055】S23は、終了か判別する。YESの場合
には、終了する。NOの場合には、S22を繰り返す。
以上のS21からS23によって、マスタアームの動き
につれてロボットアーム関節角の目標値をサンプリング
し、サンプリング後のロボットアーム関節角の目標値を
宇宙ロボット運動模擬/遠隔操作指令評価計算機に送信
する。
In step S23, it is determined whether or not the process is completed. If YES, then end. If NO, S22 is repeated.
Through S21 to S23 described above, the target value of the robot arm joint angle is sampled as the master arm moves, and the sampled target value of the robot arm joint angle is transmitted to the space robot motion simulation / remote operation command evaluation computer.

【0056】S31は、ロボットアーム動作模擬装置2
6を初期設定する。S32は、ロボットアームを駆動/
関節角計測する。これらは、S42で補間して再生した
元のロボットアーム関節角の目標値をもとに、ロボット
アーム駆動装置27を駆動し、そのときの関節角を測定
してこれをロボットアーム関節角としてS45に通知す
る。
S31 is a robot arm operation simulator 2
Initialize 6. S32 drives the robot arm /
Measure the joint angle. These drive the robot arm drive device 27 based on the target value of the original robot arm joint angle which is interpolated and reproduced in S42, measures the joint angle at that time, and uses this as the robot arm joint angle in S45. To notify.

【0057】S33は、終了か判別する。これは、S3
2のロボットアーム駆動/関節角計測が終了したか判別
する。YESの場合には、終了する。NOの場合には、
S32を繰り返し行う。
In step S33, it is determined whether or not the process is completed. This is S3
It is determined whether the robot arm drive / joint angle measurement of No. 2 is completed. If YES, then end. If no,
S32 is repeated.

【0058】以上によって、補間後のロボットアーム関
節角の目標値をもとに、宇宙ロボットのロボットアーム
の動きの模擬を行い、そのときのロボットアーム関節角
を生成してS45に送信する。これらにより、ロボット
アームの動きの模擬が実行されたこととなる。
As described above, the movement of the robot arm of the space robot is simulated based on the target value of the robot arm joint angle after interpolation, and the robot arm joint angle at that time is generated and transmitted to S45. By these, the simulation of the movement of the robot arm is executed.

【0059】S41は、宇宙ロボット運動模擬/遠隔操
作指令評価計算機を初期設定する。S42は、ロボット
アーム関節角データを補間し、元のロボットアーム関節
角の目標値を生成する。この補間して生成したロボット
アーム関節角の目標値は、S32およびS43に通知す
る。
In step S41, the space robot motion simulation / remote operation command evaluation computer is initialized. In S42, the robot arm joint angle data is interpolated to generate a target value of the original robot arm joint angle. The target value of the robot arm joint angle generated by this interpolation is notified to S32 and S43.

【0060】S43は、S42から通知されたロボット
アーム関節角の目標値をもとに、宇宙ロボットの姿勢角
/軌道位置を計算する。S44は、姿勢角誤差/軌道位
置誤差を計算する。これは、S43で計算した宇宙ロボ
ットの姿勢角/軌道位置と、予め入力された目標値との
誤差をそれぞれ計算する。
In S43, the attitude angle / orbit position of the space robot is calculated based on the target value of the robot arm joint angle notified from S42. In S44, the attitude angle error / trajectory position error is calculated. This calculates the error between the attitude angle / orbit position of the space robot calculated in S43 and the target value input in advance.

【0061】S45は、ロボットアーム関節角誤差を計
算する。これは、S32で計測したロボットアームの関
節角と、目標値との誤差をロボットアーム関節角誤差と
して計算する。
In step S45, the robot arm joint angle error is calculated. This calculates the error between the robot arm joint angle measured in S32 and the target value as the robot arm joint angle error.

【0062】S46は、誤差評価/結果表示する。これ
は、図3で説明したように、誤差について目標値の比較
を行って評価(良好、不良)を表示する。S47は、送
信判定する。これは、図3で説明したように、S46の
評価結果をもとに、送信するか否かを判別する。送信と
判定したときは、サンプリング後のロボットアーム関節
角の目標値を宇宙ロボット実機40に送信し、実際にロ
ボットアームを駆動する。
In S46, the error evaluation / result is displayed. As described with reference to FIG. 3, this displays the evaluation (good or bad) by comparing the target values with respect to the error. In S47, the transmission determination is made. As described with reference to FIG. 3, this is based on the evaluation result of S46, and it is determined whether or not to transmit. When it is determined to be transmitted, the target value of the robot arm joint angle after sampling is transmitted to the space robot actual machine 40, and the robot arm is actually driven.

【0063】S48は、終了か判別する。YESの場合
には、終了する。NOの場合には、S42以降を繰り返
し実行する。以上によって、地上模擬計算機13、宇宙
ロボット運動模擬/遠隔操作指令評価計算機、およびロ
ボットアーム動作模擬装置26の3台でロボットアーム
関節角の目標値をもとに、評価を行って評価良好のとき
に宇宙ロボット実機40にロボットアーム関節角の目標
値を送信し、評価不良のときに送信を抑止する。
In step S48, it is determined whether the process is finished. If YES, then end. In the case of NO, S42 and subsequent steps are repeatedly executed. Based on the above, when the ground simulation computer 13, the space robot motion simulation / remote control command evaluation computer, and the robot arm motion simulation device 26 are evaluated based on the target value of the robot arm joint angle, the evaluation is good. Then, the target value of the joint angle of the robot arm is transmitted to the actual space robot 40, and the transmission is suppressed when the evaluation is not good.

【0064】次に、図6および図7を用いて本発明の他
の実施例構成および動作を詳細に説明する。これは、関
節角出力部11、地上模擬計算機13、および宇宙ロボ
ット模擬/遠隔操作指令評価計算機を使用したときの他
の実施例構成および動作である。ここで、図6の11、
13、24、25、31、32、33、34、40は、
図4のものと同一であるので、説明を省略する。
Next, the configuration and operation of another embodiment of the present invention will be described in detail with reference to FIGS. 6 and 7. This is another embodiment configuration and operation when the joint angle output unit 11, the ground simulation computer 13, and the space robot simulation / remote operation command evaluation computer are used. Here, 11 in FIG.
13, 24, 25, 31, 32, 33, 34, 40 are
Since it is the same as that of FIG. 4, description thereof will be omitted.

【0065】図6において、ロボットアーム動作模擬部
23は、図4のロボットアーム動作模擬装置26の代わ
りに設けたものであって、計算機上でロボットアームの
動作を模擬するようにしたものである。このロボットア
ーム動作模擬部23は、ロボットアーム関節角データ補
間部24によって補間された後のロボットアーム関節角
の目標値をもとに、計算機上でロボットアーム関節角を
計算するものである。この計算したロボットアーム関節
角は、アーム関節角誤差検出部32に通知する。
In FIG. 6, the robot arm motion simulating section 23 is provided in place of the robot arm motion simulating device 26 of FIG. 4 and simulates the motion of the robot arm on a computer. . The robot arm motion simulation unit 23 calculates the robot arm joint angle on a computer based on the target value of the robot arm joint angle after being interpolated by the robot arm joint angle data interpolation unit 24. The calculated robot arm joint angle is notified to the arm joint angle error detection unit 32.

【0066】図7を用いて図6の構成の動作を詳細に説
明する。ここで、S51からS53は、図5のS21か
らS23と同一であるので、説明を省略する。図7にお
いて、S61は、宇宙ロボット模擬/遠隔操作指令評価
計算機を初期設定する。
The operation of the configuration of FIG. 6 will be described in detail with reference to FIG. Here, since S51 to S53 are the same as S21 to S23 of FIG. 5, the description thereof will be omitted. In FIG. 7, S61 initializes the space robot simulation / remote operation command evaluation computer.

【0067】S62は、ロボットアーム関節角データを
補間し、元のロボットアーム関節角の目標値を生成す
る。この補間して生成したロボットアーム関節角の目標
値は、S63およびS65に通知する。
In S62, the robot arm joint angle data is interpolated to generate a target value of the original robot arm joint angle. The target value of the robot arm joint angle generated by this interpolation is notified to S63 and S65.

【0068】S63は、ロボットアーム関節角を計算す
る。これは、S62から通知されたロボットアーム関節
角の目標値をもとにロボットアーム関節角を計算する。
S64は、ロボットアーム関節角の誤差を計算する。こ
れは、図2で説明したように、S63で計算したロボッ
トアーム関節角と、目標値との誤差を計算する。
In S63, the robot arm joint angle is calculated. This calculates the robot arm joint angle based on the target value of the robot arm joint angle notified from S62.
S64 calculates the error of the joint angle of the robot arm. This calculates the error between the robot arm joint angle calculated in S63 and the target value, as described with reference to FIG.

【0069】S65は、S62から通知されたロボット
アーム関節角の目標値をもとに、宇宙ロボットの姿勢角
/軌道位置を計算する。S66は、姿勢角誤差/軌道位
置誤差を計算する。これは、S653で計算した宇宙ロ
ボットの姿勢角/軌道位置と、予め入力された目標値と
の誤差をそれぞれ計算する。
In S65, the attitude angle / orbit position of the space robot is calculated based on the target value of the robot arm joint angle notified from S62. In S66, the attitude angle error / trajectory position error is calculated. This calculates the error between the attitude angle / orbit position of the space robot calculated in S653 and the target value input in advance.

【0070】S67は、誤差評価/結果表示する。これ
は、図3で説明したように、誤差について目標値と比較
を行って評価(良好、不良)を表示する。S68は、送
信判定する。これは、図3で説明したように、S67の
評価結果をもとに、送信するか否かを判別する。送信と
判定したときは、サンプリング後のロボットアーム関節
角の目標値を宇宙ロボット実機40に送信し、実際にロ
ボットアームを駆動する。
In S67, the error evaluation / result is displayed. As described with reference to FIG. 3, this displays the evaluation (good or bad) by comparing the error with the target value. In S68, the transmission determination is made. As described with reference to FIG. 3, this is based on the evaluation result of S67, and determines whether or not to transmit. When it is determined to be transmitted, the target value of the robot arm joint angle after sampling is transmitted to the space robot actual machine 40, and the robot arm is actually driven.

【0071】S69は、終了か判別する。YESの場合
には、終了する。NOの場合には、S62以降を繰り返
し実行する。以上によって、地上模擬計算機13と宇宙
ロボット模擬/遠隔操作指令評価計算機の2台でロボッ
トアーム関節角の目標値をもとに、評価を行って評価良
好のときに宇宙ロボット実機40にロボットアーム関節
角の目標値を送信し、評価不良のときに送信を抑止す
る。
In step S69, it is determined whether the process is finished. If YES, then end. In the case of NO, S62 and subsequent steps are repeatedly executed. Based on the above, the ground simulation computer 13 and the space robot simulation / remote control command evaluation computer perform evaluation based on the target value of the robot arm joint angle, and when the evaluation is good, the space robot real machine 40 is connected to the robot arm joint. The target value of the corner is transmitted, and when the evaluation is bad, the transmission is suppressed.

【0072】次に、図8および図9を用いて本発明の他
の実施例構成および動作を詳細に説明する。これは、関
節角出力部11、および宇宙ロボット遠隔操作指令評価
計算機を使用したときの他の実施例構成および動作であ
る。ここで、図8の11、23、24、25、31、3
2、33、34、40は、図6のものと同一であるの
で、説明を省略する。
Next, the configuration and operation of another embodiment of the present invention will be described in detail with reference to FIGS. This is another embodiment configuration and operation when the joint angle output unit 11 and the space robot remote control command evaluation computer are used. Here, 11, 23, 24, 25, 31, 3 in FIG.
2, 33, 34, and 40 are the same as those in FIG. 6, so description thereof will be omitted.

【0073】図8において、ロボットアーム関節角デー
タサンプリング部14は、関節角出力部11によって生
成したロボットアーム関節角の目標値について、データ
圧縮するためにサンプリングするものである。このロボ
ットアーム関節角データサンプリング部14によってサ
ンプリングした後のロボットアーム関節角の目標値は、
ロボットアーム関節角データ補間部24に通知する。
In FIG. 8, the robot arm joint angle data sampling unit 14 samples the target value of the robot arm joint angle generated by the joint angle output unit 11 for data compression. The target value of the robot arm joint angle after sampling by the robot arm joint angle data sampling unit 14 is
The robot arm joint angle data interpolation unit 24 is notified.

【0074】図9を用いて図8の構成の動作を詳細に説
明する。ここで、S71、S72からS79は、図7の
S61からS69と同一であるので、説明を省略する。
図9において、S71−1は、ロボットアーム関節角デ
ータをサンプリングする。サンプリング後のロボットア
ーム関節角の目標値を、S72およびS78に通知す
る。
The operation of the configuration of FIG. 8 will be described in detail with reference to FIG. Here, S71 and S72 to S79 are the same as S61 to S69 in FIG.
In FIG. 9, in S71-1, the robot arm joint angle data is sampled. The target value of the robot arm joint angle after sampling is notified to S72 and S78.

【0075】以上によって、宇宙ロボット遠隔操作指令
評価計算機の1台でロボットアーム関節角の目標値をも
とに、評価を行って評価良好のときに宇宙ロボット実機
40にロボットアーム関節角の目標値を送信し、評価不
良のときに送信を抑止する。
Based on the above, one of the space robot remote control command evaluation computers performs evaluation based on the target value of the robot arm joint angle, and when the evaluation is good, the target value of the robot arm joint angle is set in the space robot actual machine 40. Is transmitted, and the transmission is suppressed when the evaluation is bad.

【0076】[0076]

【発明の効果】以上説明したように、本発明によれば、
ロボットアーム状態量(関節角、先端位置、姿勢)の目
標値をもとに、ロボットの姿勢角/軌道位置を算出およ
びロボットアームの状態量を算出し、算出したロボット
の姿勢角/軌道位置およびロボットアームの状態量と目
標値(あるいは予め指定した目標値)との誤差を検出
し、誤差が予め規定した誤差許容値範囲内のときに良
好、誤差許容値範囲外のときに不良と評価し、更に評価
が良好のときにロボット実機にロボットアームの目標値
を送信する構成を採用しているため、ロボットアームの
移動に伴うロボットの姿勢/軌道およびロボットアーム
の関節角などを算出して評価したり、評価良好のときに
実機(ロボット)にデータを送信したりすることができ
る。これらにより、ロボットアームの動作だけでなく、
宇宙ロボットなどのロボットアームの駆動によって発生
するロボットの姿勢運動や軌道運動も考慮して、遠隔操
作指令であるロボットアーム関節角の目標値の妥当性を
評価したり、更にデータ圧縮やデータ補間などの妥当性
を評価したりすることができると共に、宇宙ロボットな
どの遠隔操作中に発生する可能性のある通信途絶を未然
に防ぐことができ、宇宙ロボットなどの遠隔操作性能の
向上に大きく寄与することができる。
As described above, according to the present invention,
Based on the target value of the robot arm state quantity (joint angle, tip position, posture), the posture angle / trajectory position of the robot is calculated, the state quantity of the robot arm is calculated, and the calculated posture angle / trajectory position of the robot and The error between the state quantity of the robot arm and the target value (or the target value specified in advance) is detected, and it is evaluated as good when the error is within the predetermined error allowable value range and evaluated as bad when it is outside the error allowable value range. Since the configuration is such that the target value of the robot arm is transmitted to the actual robot when the evaluation is good, the posture and trajectory of the robot accompanying the movement of the robot arm and the joint angle of the robot arm are calculated and evaluated. Alternatively, data can be transmitted to the actual machine (robot) when the evaluation is good. With these, not only the movement of the robot arm,
In consideration of the posture motion and orbital motion of the robot generated by driving the robot arm such as a space robot, the validity of the target value of the robot arm joint angle which is a remote control command is evaluated, and further data compression and data interpolation are performed. It is possible to evaluate the adequacy of the space robot and prevent the communication interruption that may occur during remote control of the space robot, which greatly contributes to the improvement of the remote control performance of the space robot. be able to.

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

【図1】本発明の1実施例構成図である。FIG. 1 is a configuration diagram of an embodiment of the present invention.

【図2】本発明の動作説明図である。FIG. 2 is an operation explanatory diagram of the present invention.

【図3】本発明の評価結果例である。FIG. 3 is an example of an evaluation result of the present invention.

【図4】本発明の他の実施例構成図である。FIG. 4 is a configuration diagram of another embodiment of the present invention.

【図5】図4の動作説明図である。5 is an operation explanatory diagram of FIG. 4;

【図6】本発明の他の実施例構成図である。FIG. 6 is a configuration diagram of another embodiment of the present invention.

【図7】図6の動作説明図である。FIG. 7 is an operation explanatory diagram of FIG. 6;

【図8】本発明の他の実施例構成図である。FIG. 8 is a configuration diagram of another embodiment of the present invention.

【図9】図8の動作説明図である。9 is an operation explanatory diagram of FIG. 8;

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

10:模擬部 11:関節角出力部 12:遠隔操作指令送信部 13:地上模擬計算機 14:ロボットアーム関節角データサンプリング部 20:ロボット模擬部 21:遠隔操作指令受信部 22:ロボット運動模擬部 23:ロボットアーム動作模擬部 24:ロボットアーム関節角データ補間部 25:宇宙ロボット運動模擬部 26:ロボットアーム動作模擬装置 27:ロボットアーム駆動装置 30:遠隔操作指令評価部 31:姿勢誤差/軌道誤差検出部 32:アーム状態量誤差検出部 33:評価表示部 34:送信判定部 35:誤差検出部 40:ロボット実機 10: Simulation unit 11: Joint angle output unit 12: Remote operation command transmission unit 13: Ground simulation computer 14: Robot arm joint angle data sampling unit 20: Robot simulation unit 21: Remote operation command reception unit 22: Robot motion simulation unit 23 : Robot arm motion simulation part 24: Robot arm joint angle data interpolation part 25: Space robot motion simulation part 26: Robot arm motion simulation device 27: Robot arm drive device 30: Remote operation command evaluation part 31: Attitude error / trajectory error detection Part 32: Arm state amount error detection part 33: Evaluation display part 34: Transmission determination part 35: Error detection part 40: Robot actual machine

Claims (3)

【特許請求の範囲】[Claims] 【請求項1】ロボットの遠隔操作を評価するロボット遠
隔操作評価装置において、 ロボットアームの目標値をもとに、ロボットの姿勢角/
軌道位置を算出するロボット運動模擬部(22)と、 ロボットアームの目標値をもとに、ロボットアームの状
態量を算出するロボットアーム動作模擬部(23)と、 算出されたロボットの姿勢角/軌道位置およびロボット
アームの状態量と上記目標値(あるいは予め指定した目
標値)との誤差を検出する誤差検出部(35)とを備
え、 この誤差検出部(35)によって検出した誤差を出力す
るように構成したことを特徴とするロボット遠隔操作評
価装置。
1. A robot remote control evaluation device for evaluating remote control of a robot, comprising: a posture angle of a robot based on a target value of a robot arm;
A robot motion simulation unit (22) that calculates the trajectory position, a robot arm motion simulation unit (23) that calculates the state amount of the robot arm based on the target value of the robot arm, and the calculated posture angle / An error detection unit (35) for detecting an error between the trajectory position and the state amount of the robot arm and the target value (or a target value designated in advance) is provided, and the error detected by the error detection unit (35) is output. A robot remote control evaluation device having the above structure.
【請求項2】上記誤差検出部(35)によって検出した
誤差が予め規定した誤差許容値範囲内のときに良好、誤
差許容値範囲外のときに不良と評価して出力するように
構成したことを特徴とする請求項1記載のロボット遠隔
操作評価装置。
2. The error detecting section (35) is configured to evaluate and output as good when the error detected is within a predetermined error allowable value range and defective when outside the error allowable value range. The robot remote-operation evaluation device according to claim 1, wherein
【請求項3】上記誤差検出部(35)によって検出した
誤差が予め規定した誤差許容値範囲内のときに良好と評
価して上記ロボットアームの目標値を遠隔操作対象のロ
ボットに向けて送信し(あるいはロボットを駆動し)、
一方、誤差許容値範囲外のときに不良と評価して上記ロ
ボットアームの目標値を遠隔操作対象のロボットに向け
て送信することを抑止(あるいはロボットを駆動するこ
とを抑止)するように構成したことを特徴とする請求項
1記載のロボット遠隔操作評価装置。
3. When the error detected by the error detection unit (35) is within a predetermined error tolerance value range, it is evaluated as good and the target value of the robot arm is transmitted to the remote controlled robot. (Or drive a robot),
On the other hand, when the error is out of the allowable error range, it is configured to be evaluated as defective and to prevent the target value of the robot arm from being transmitted to the remotely operated robot (or to prevent the robot from being driven). The robot remote control evaluation device according to claim 1, wherein
JP33829692A 1992-12-18 1992-12-18 Robot remote operation evaluation device Expired - Fee Related JP3208687B2 (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP33829692A JP3208687B2 (en) 1992-12-18 1992-12-18 Robot remote operation evaluation device

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP33829692A JP3208687B2 (en) 1992-12-18 1992-12-18 Robot remote operation evaluation device

Publications (2)

Publication Number Publication Date
JPH06182681A true JPH06182681A (en) 1994-07-05
JP3208687B2 JP3208687B2 (en) 2001-09-17

Family

ID=18316802

Family Applications (1)

Application Number Title Priority Date Filing Date
JP33829692A Expired - Fee Related JP3208687B2 (en) 1992-12-18 1992-12-18 Robot remote operation evaluation device

Country Status (1)

Country Link
JP (1) JP3208687B2 (en)

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2019009685A (en) * 2017-06-27 2019-01-17 日本精工株式会社 Apparatus control system and remote adjustment system

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2019009685A (en) * 2017-06-27 2019-01-17 日本精工株式会社 Apparatus control system and remote adjustment system

Also Published As

Publication number Publication date
JP3208687B2 (en) 2001-09-17

Similar Documents

Publication Publication Date Title
Sweet et al. Re-definition of the robot motion control problem: Effects of plant dynamics, drive system constraints, and user requirements
US20110093119A1 (en) Teaching and playback method based on control of redundancy resolution for robot and computer-readable medium controlling the same
WO1996030171A1 (en) Method and device for calibration of movement axes of an industrial robot
EP0519081B1 (en) Method of correcting deflection of robot
Slawiñski et al. PD-like controller with impedance for delayed bilateral teleoperation of mobile robots
CN100408433C (en) Real-time prediction method for satellite flight parameter
JPH06182681A (en) Robot remote control evaluating device
JP3913666B2 (en) Simulation device
Sanders The modification of pre-planned manipulator paths to improve the gross motions associated with the pick and place task
Hirche et al. Transparent exploration of remote environments by internet telepresence
CN111546344A (en) Mechanical arm control method for alignment
US20240017427A1 (en) Systems and methods for designing, testing, and validating a robotic system
CN115014824A (en) Robot test system, method and computer readable storage medium
JP2004148434A (en) Simulation device
Xu et al. Case studies on nonlinear control theory of the inverted pendulum
JPH11161311A (en) Remote operation type robot controller
Hill et al. Cartesian control of robotic manipulators with joint compliance
KR19990023810A (en) Structural description of robots and components of robots and robots
CN112987691B (en) Soft landing closed-loop follow-up control test method for surface of extraterrestrial celestial body
Borst et al. Telerobotic ground control of a space free-flyer
Peñín et al. ETS-7 space robot teleoperation through virtual force reflection
Scultz et al. Robust visualization for web-based control mobile robots
MoafiMadani et al. Implementation of wave-based teleoperation system by improved trajectory tracking method
JP2000218576A (en) Manipulator
Bill et al. Department of Electric81 Ehgineering University of mode Island Kingston, RI 02881

Legal Events

Date Code Title Description
A01 Written decision to grant a patent or to grant a registration (utility model)

Free format text: JAPANESE INTERMEDIATE CODE: A01

Effective date: 20010605

FPAY Renewal fee payment (event date is renewal date of database)

Free format text: PAYMENT UNTIL: 20080713

Year of fee payment: 7

FPAY Renewal fee payment (event date is renewal date of database)

Free format text: PAYMENT UNTIL: 20090713

Year of fee payment: 8

FPAY Renewal fee payment (event date is renewal date of database)

Free format text: PAYMENT UNTIL: 20100713

Year of fee payment: 9

FPAY Renewal fee payment (event date is renewal date of database)

Free format text: PAYMENT UNTIL: 20100713

Year of fee payment: 9

FPAY Renewal fee payment (event date is renewal date of database)

Free format text: PAYMENT UNTIL: 20110713

Year of fee payment: 10

LAPS Cancellation because of no payment of annual fees