(57)【特許請求の範囲】
【請求項１】
基準距離離間している切断対象を切断する切断器と、
切断器がロボット先端に取り付けられ、この切断器を移動させる切断マニピュレータと、
切断器の三次元空間上の位置および方向を決定するため、切断マニピュレータのロボット先端の位置制御を行う制御装置と、
レーザ光を発振するレーザ光発信器と、レーザ光発信器から出力されたレーザ光が入力され、同一平面内で並行な２本のレーザ光と交差する１本のレーザ光をそれぞれ照射するレンズシステムと、切断対象上に照射されるレーザ光を撮像して画像データを取得する撮像管カメラと、を有し、画像データを用いて、これらレーザ光が照射される切断対象における光点間の距離の比率を用いて切断対象までの距離を算出するような処理を行って切断対象までの先端距離検出値を出力する距離センサと、
それぞれ同軸上で１８０°反対方向に向けられて何れか一方のみが切断対象へ向くようになされた切断器と距離センサとをロボット先端で軸支してなる切り換え軸と、
を備える遠隔制御型切断ロボットであって、
前記制御装置は、
切断経路生成処理として、
切断マニピュレータのロボット先端を予め計画された切断経路上で移動させるための計画切断経路値を登録し、
距離センサを切断対象に向けた状態にし、計画切断経路値に基づいてロボット先端を移動させ、
距離センサが検出した先端距離検出値と距離指令値とが一致するようにロボット先端を移動させ、この一致したときのロボット先端の位置を修正切断経路値として登録し、
切断処理として、
切断器を切断対象に向けた状態にし、修正切断経路値に基づいて切断経路を辿るように制御装置が切断マニピュレータを制御し、切断器と切断対象とが基準距離を維持しつつ切断対象を切断する、
ことを特徴とする遠隔制御型切断ロボット。
【請求項２】
請求項１に記載の遠隔制御型切断ロボットにおいて、
前記制御装置は、
切断経路生成処理として、
切断マニピュレータのロボット先端を予め計画された切断経路上で移動させるため、この切断経路上の三次元座標である座標値、および、前記切断器の三次元方向ベクトルである方向ベクトル値を複数個所について定めた計画切断経路値を登録し、
前記距離センサを切断対象に向けた状態にし、計画切断経路値に基づいてある座標へ前記切断マニピュレータのロボット先端を移動させ、
切断対象から距離センサまでの距離である先端距離検出値を取得し、
この距離検出値と距離指令値との差分である距離補正値に切断器の方向ベクトル値を乗じて位置補正ベクトル値を算出し、
位置補正ベクトル値によりロボット先端を移動させ、この一致したときのロボット先端の位置を修正切断経路値として登録する、
ことを特徴とする遠隔制御型切断ロボット。
【請求項３】
請求項１または請求項２に記載の遠隔制御型切断ロボットにおいて、
前記制御装置は、
切断対象の平面部にある切断経路についての修正切断経路値で連続する３点の座標を抽出し、
この３点の座標を通過する平面と垂直な方向を示す法線ベクトルを算出し、
この法線ベクトルの方向と切断器の方向とが一致するようにロボット先端を制御することで、切断器が切断対象面に垂直となるように維持することを特徴とする遠隔制御型切断ロボット。
【請求項４】
請求項１または請求項２に記載の遠隔制御型切断ロボットにおいて、
前記制御装置は、
修正切断経路値が少なくとも４個所の座標値を有する場合、これら座標値から隣接する３個所の座標値を用いて法線ベクトルを複数求め、
この複数の法線ベクトルを用いて平均の法線ベクトルを算出し、
算出した平均の法線ベクトルの方向と切断器の方向とが一致するようにロボット先端を制御することで、切断器が切断対象面に垂直となるように維持することを特徴とする遠隔制御型切断ロボット。
【請求項５】
請求項１〜請求項４の何れか１項に記載の遠隔制御型切断ロボットにおいて、
前記切り換え手段に配置され、前記距離センサの距離検出点周辺の画像データを取得するカメラと、
カメラから出力された画像データによる画像を表示するモニタと、
操作員が操作入力して、前記切断マニピュレータの動作を制御するような指令を前記制御装置へ出力する操作入力盤と、
を備え、
切断経路生成処理において、モニタに表示される切断対象の状態に応じて操作員が操作入力盤を操作して切断経路の指定を行えるようにしたことを特徴とする遠隔制御型切断ロボット。
【請求項６】
請求項５に記載の遠隔制御型切断ロボットにおいて、
前記操作入力盤は、切断経路生成の中断・再開およびロボット先端の移動について操作入力できるようになされ、切断経路生成処理途中において、
操作入力盤で入力される経路生成中断指令により制御装置は切断経路生成処理を停止してこの点を経路変更開始点として登録し、
操作入力盤で入力される先端動作指令により制御装置はロボット先端を移動させるように制御して指定切断経路値を生成し、
操作入力盤で入力される通過点教示指令により制御装置は切断マニピュレータのロボット先端が計画切断経路上へ戻る直近点を経路変更復帰点として登録し、
操作入力盤で入力される経路生成再開指令により制御装置は経路変更開始点から経路変更復帰点までの切断経路に係る計画切断経路値を、指定切断経路値と交換して、
切断経路生成処理を再開することを特徴とする遠隔制御型切断ロボット。
【請求項７】
請求項５または請求項６に記載の遠隔制御型切断ロボットにおいて、
前記操作入力盤は、切断経路生成の開始・終了およびロボット先端の移動について操作入力できるようになされ、切断経路生成開始時において、
操作入力盤で入力される経路生成開始指令により制御装置はロボット先端を予め設定したロボット先端位置へ移動させた後に切断経路生成処理を中断し、
操作入力盤で入力される経路生成前進指令により制御装置は切断マニピュレータのロボット先端が切断対象上へ移動するように位置制御し、
操作入力盤で入力される経路生成再開指令により制御装置は切断マニピュレータが倣い制御開始点としてロボット先端を切断対象まで近づけて距離センサと切断対象とを基準距離離間させた状態とし、この時の補正量を用いて切断経路生成処理を再開して切断対象上の修正切断経路値を生成し、
操作入力盤で入力される経路生成終了指令により制御装置は倣い制御開始点から倣い制御終了点までの切断経路に係る計画切断経路値を、修正切断経路値と交換して、
切断経路生成処理を終了することを特徴とする遠隔制御型切断ロボット。
【請求項８】
請求項７に記載の遠隔制御型切断ロボットにおいて、
経路生成開始指令と経路生成開始終了指令との操作入力の代わりに、距離センサから出力される先端距離検出値が一定値以上から一定値未満に変化した場合にロボット先端が切断対象の外から上へ移動したと判別して経路生成再開指令が出力されたものとし、また、距離センサから出力される先端距離検出値が一定値未満から一定値以上に変化した場合にロボット先端が切断対象の上から外へ移動したと判別して経路生成終了指令が出力されたものとし、
指令を自動判別することを特徴とする遠隔制御型切断ロボット。
【発明の詳細な説明】
【０００１】
【発明の属する技術分野】
本発明は、遠隔地にいる操作員の遠隔制御により切断対象を切断する遠隔制御型切断ロボットに関する。
【０００２】
【従来の技術】
遠隔制御型切断ロボットは、遠隔地に離れた操作員が遠隔制御を行い、切断対象を切断するロボットである。このような切断作業を行う遠隔制御型切断ロボットに取り付けられる切断器は、例えば、ガス、プラズマ、レーザなどにより切断対象を溶断する機器である。このような切断器で切断する場合、一般的に、切断器と切断対象との間を一定距離に維持しなければならないという制約を伴うことが多い（以下このような距離を基準距離という）。
【０００３】
例えば、レーザによる熱溶断を行う切断器ならばレーザ照射口から出力されるレーザビームの光パワーが集中するビームスポット位置に切断対象が位置している必要があり、切断器と切断対象との間の基準距離は、焦点距離に一致している必要がある。上記のような理由から、遠隔制御型切断ロボットでは、切断器と切断対象との位置関係を厳密に設定するための各種配慮がなされる。
しかしながら、従来技術では上記した位置関係の設定が容易でない場合があった。
【０００４】
この位置関係の設定に関する設定困難な例とは、例えば、建物など大型構造物の解体時に行われる切断作業がある。この場合、切断対象の解体が進むにつれて遠隔制御型切断ロボットを切断しやすい個所に移動させる必要が生じることもある。したがって、遠隔制御型切断ロボットに予め登録していた切断対象の位置が移動により変化する。このような事情から切断器と切断対象との位置間関係を予め厳密に定めることは困難であった。
このように従来では遠隔制御型切断ロボットにおいて、切断器と切断対象との位置関係を予め厳密に定めることは困難である場合があり、上記した基準距離を維持することができなくなり、切断対象を切断ができないような場合があった。
【０００５】
上記したような遠隔制御・切断に係るものでない一般的なロボット制御では、切断経路が予め厳密に設定ができないような場合、従来より、（１）近くにいる操作員によりその都度ロボットに対して手動操縦による経路教示を行ったり、（２）対象の位置を検出するセンサにより倣い制御をかける方式を採用することが一般的に行われていた。
【０００６】
しかしながら、遠隔制御型切断ロボットの場合は、操作員が切断対象に近づくことができない等の事情（例えば、高放射線下など）により、切断対象の直近に操作員がいないことが前提である。したがって、切断器と切断対象との位置関係を確認するための、上記（１）の手動操作の経路教示という手法を採用できないという事情があった。
【０００７】
また、仮に切断器と切断対象との距離を検出するセンサを配置して倣い制御による切断作業を行う切断ロボットとすると、切断作業自体による環境悪化（高熱、切断クズの飛散など）によりセンサが破壊される恐れがあるとともに、切断対象上の細かい突起など距離センサによって検出しにくい状態変化により、切断器と切断対象との距離が正確に計測できない恐れがある。
【０００８】
さらに、一般的に切断を行う場合、殆ど切断対象の外側部から開始して切り込んでいく必要あるが、倣い制御では対象が必要であるため、切断対象の外側部においては倣い制御による経路の学習は不可能である。
これら理由により従来の遠隔制御型切断ロボットに上記（２）の倣い制御を単純に適用することは困難である。
【０００９】
以上説明したように、従来の遠隔制御型切断ロボットの制御において、切断対象と切断器との位置関係に制約があるにも拘わらず、切断作業時の位置関係を予め厳密に定めることが困難な事情（移動など）がある場合には、遠隔制御型切断ロボットを制御することは困難であった。
【００１０】
【発明が解決しようとする課題】
本発明は、上記した問題点を解決しようとするものであり、その目的は、ロボット切断器本体が移動する様な場合でも切断対象と切断器との位置関係の制約を守りつつ、遠隔制御による切断を実現するような遠隔制御型切断ロボットを提供することにある。
【００１１】
そして、上記課題実現のため、第一の手段として、遠隔制御での切断作業において、切断経路計画時には厳密に知ることができない切断器と切断対象との距離を一定に保ちつつ、切断する遠隔制御型切断ロボットを提供する。
【００１２】
また、第二の手段として、切断経路計画時に想定した切断対象に対する切断器の角度が垂直でない場合でも、切断器と切断対象との角度を垂直に近づける遠隔制御型切断ロボットを提供する。
【００１３】
また、第三の手段として、切断対象上にある突起・穴などの切断障害が発見された場合に、これら切断障害を回避する切断経路を生成する遠隔制御型切断ロボットを提供する。
【００１４】
また、第四の手段として、切断対象の端部など切断対象の切断開始時点と切断終了時点で距離センサが切断対象を捉えらなくなるような場合でも影響されることなく距離センサと切断対象と距離を一定に保つ制御を行い、確実に切断する遠隔制御型切断ロボットを提供する。
【００１５】
また、第五の手段として、高放射線下など、半導体を使用した距離センサをロボット先端に配置できない環境において、非接触で切断対象までの距離を測定する遠隔制御型切断ロボットを提供する。
【００１６】
また、第六の手段として、環境に影響されない機械的構造を有する距離センサをロボット先端に配置し、接触で切断対象までの距離を測定する遠隔制御型切断ロボットを提供する。
【００１７】
【課題を解決するための手段】
上記課題を解決するため、第五の手段に係る請求項１に記載の発明では、
基準距離離間している切断対象を切断する切断器と、
切断器がロボット先端に取り付けられ、この切断器を移動させる切断マニピュレータと、
切断器の三次元空間上の位置および方向を決定するため、切断マニピュレータのロボット先端の位置制御を行う制御装置と、
レーザ光を発振するレーザ光発信器と、レーザ光発信器から出力されたレーザ光が入力され、同一平面内で並行な２本のレーザ光と交差する１本のレーザ光をそれぞれ照射するレンズシステムと、切断対象上に照射されるレーザ光を撮像して画像データを取得する撮像管カメラと、を有し、画像データを用いて、これらレーザ光が照射される切断対象における光点間の距離の比率を用いて切断対象までの距離を算出するような処理を行って切断対象までの先端距離検出値を出力する距離センサと、
それぞれ同軸上で１８０°反対方向に向けられて何れか一方のみが切断対象へ向くようになされた切断器と距離センサとをロボット先端で軸支してなる切り換え軸と、
を備える遠隔制御型切断ロボットであって、
前記制御装置は、
切断経路生成処理として、
切断マニピュレータのロボット先端を予め計画された切断経路上で移動させるための計画切断経路値を登録し、
距離センサを切断対象に向けた状態にし、計画切断経路値に基づいてロボット先端を移動させ、
距離センサが検出した先端距離検出値と距離指令値とが一致するようにロボット先端を移動させ、この一致したときのロボット先端の位置を修正切断経路値として登録し、
切断処理として、
切断器を切断対象に向けた状態にし、修正切断経路値に基づいて切断経路を辿るように制御装置が切断マニピュレータを制御し、切断器と切断対象とが基準距離を維持しつつ切断対象を切断する、
ことを特徴とする。
【００１８】
また、第一の手段に係る請求項２に記載の発明では、
請求項１に記載の遠隔制御型切断ロボットにおいて、
前記制御装置は、
切断経路生成処理として、
切断マニピュレータのロボット先端を予め計画された切断経路上で移動させるため、この切断経路上の三次元座標である座標値、および、前記切断器の三次元方向ベクトルである方向ベクトル値を複数個所について定めた計画切断経路値を登録し、
前記距離センサを切断対象に向けた状態にし、計画切断経路値に基づいてある座標へ前記切断マニピュレータのロボット先端を移動させ、
切断対象から距離センサまでの距離である先端距離検出値を取得し、
この距離検出値と距離指令値との差分である距離補正値に切断器の方向ベクトル値を乗じて位置補正ベクトル値を算出し、
位置補正ベクトル値によりロボット先端を移動させ、この一致したときのロボット先端の位置を修正切断経路値として登録する、
ことを特徴とする。
【００１９】
また、第二の手段に係る請求項３に記載の発明では、
請求項１または請求項２に記載の遠隔制御型切断ロボットにおいて、
前記制御装置は、
切断対象の平面部にある切断経路についての修正切断経路値で連続する３点の座標を抽出し、
この３点の座標を通過する平面と垂直な方向を示す法線ベクトルを算出し、
この法線ベクトルの方向と切断器の方向とが一致するようにロボット先端を制御することで、切断器が切断対象面に垂直となるように維持することを特徴とする。
【００２０】
また、第二の手段に係る請求項４に記載の発明では、
請求項１または請求項２に記載の遠隔制御型切断ロボットにおいて、
前記制御装置は、
修正切断経路値が少なくとも４個所の座標値を有する場合、これら座標値から隣接する３個所の座標値を用いて法線ベクトルを複数求め、
この複数の法線ベクトルを用いて平均の法線ベクトルを算出し、
算出した平均の法線ベクトルの方向と切断器の方向とが一致するようにロボット先端を制御することで、切断器が切断対象面に垂直となるように維持することを特徴とする。
【００２１】
また、第三の手段に係る請求項５に記載の発明では、
請求項１〜請求項４の何れか１項に記載の遠隔制御型切断ロボットにおいて、
前記切り換え手段に配置され、前記距離センサの距離検出点周辺の画像データを取得するカメラと、
カメラから出力された画像データによる画像を表示するモニタと、
操作員が操作入力して、前記切断マニピュレータの動作を制御するような指令を前記制御装置へ出力する操作入力盤と、
を備え、
切断経路生成処理において、モニタに表示される切断対象の状態に応じて操作員が操作入力盤を操作して切断経路の指定を行えるようにしたことを特徴とする。
【００２２】
また、第三の手段に係る請求項６に記載の発明では、
請求項５に記載の遠隔制御型切断ロボットにおいて、
前記操作入力盤は、切断経路生成の中断・再開およびロボット先端の移動について操作入力できるようになされ、切断経路生成処理途中において、
操作入力盤で入力される経路生成中断指令により制御装置は切断経路生成処理を停止してこの点を経路変更開始点として登録し、
操作入力盤で入力される先端動作指令により制御装置はロボット先端を移動させるように制御して指定切断経路値を生成し、
操作入力盤で入力される通過点教示指令により制御装置は切断マニピュレータのロボット先端が計画切断経路上へ戻る直近点を経路変更復帰点として登録し、
操作入力盤で入力される経路生成再開指令により制御装置は経路変更開始点から経路変更復帰点までの切断経路に係る計画切断経路値を、指定切断経路値と交換して、
切断経路生成処理を再開することを特徴とする。
【００２３】
また、第四の手段に係る請求項７に記載の発明では、
請求項５または請求項６に記載の遠隔制御型切断ロボットにおいて、
前記操作入力盤は、切断経路生成の開始・終了およびロボット先端の移動について操作入力できるようになされ、切断経路生成開始時において、
操作入力盤で入力される経路生成開始指令により制御装置はロボット先端を予め設定したロボット先端位置へ移動させた後に切断経路生成処理を中断し、
操作入力盤で入力される経路生成前進指令により制御装置は切断マニピュレータのロボット先端が切断対象上へ移動するように位置制御し、
操作入力盤で入力される経路生成再開指令により制御装置は切断マニピュレータが倣い制御開始点としてロボット先端を切断対象まで近づけて距離センサと切断対象とを基準距離離間させた状態とし、この時の補正量を用いて切断経路生成処理を再開して切断対象上の修正切断経路値を生成し、
操作入力盤で入力される経路生成終了指令により制御装置は倣い制御開始点から倣い制御終了点までの切断経路に係る計画切断経路値を、修正切断経路値と交換して、
切断経路生成処理を終了することを特徴とする。
【００２４】
また、第四の手段に係る請求項８に記載の発明では、
請求項７に記載の遠隔制御型切断ロボットにおいて、
経路生成開始指令と経路生成開始終了指令との操作入力の代わりに、距離センサから出力される先端距離検出値が一定値以上から一定値未満に変化した場合にロボット先端が切断対象の外から上へ移動したと判別して経路生成再開指令が出力されたものとし、また、距離センサから出力される先端距離検出値が一定値未満から一定値以上に変化した場合にロボット先端が切断対象の上から外へ移動したと判別して経路生成終了指令が出力されたものとし、
指令を自動判別することを特徴とする。
【００３３】
【発明の実施の形態】
１）倣い制御自動ティーチングを実現する遠隔制御型切断ロボット
続いて本発明の各種実施形態について図を参照して説明する。まず請求項２に係る第１実施形態の遠隔制御型切断ロボットについて説明する。図１は本実施形態の遠隔制御型切断ロボットの構成図、図２は本実施形態の遠隔制御型切断ロボットによる切断経路を説明する説明図、図３は切断経路生成処理を行う制御ブロック図である。
図１で示すように、本実施形態では倣い制御自動ティーチングを実現する遠隔制御型切断ロボットであって、制御装置１、切断マニピュレータ２、切断器３、距離センサ４、切り換え軸５、切断対象６を備えている。
【００３４】
制御装置１は、切断マニピュレータ２および距離センサ４と信号を送受信するようになされている。
制御装置１から切断マニピュレータ２へは各軸位置指令値が送信され、また、切断マニピュレータ２から制御装置１へは各軸位置検出値が送信される。これにより制御装置１は切断マニピュレータ２の位置制御を行うようになされている。
【００３５】
さらに、距離センサ４から制御装置１へ先端距離検出値が送信される。これにより制御装置１は切断マニピュレータ２の先端（以下、ロボット先端という）に位置する距離センサ４の先端が切断対象６に対して離間する距離に関する情報（先端距離検出値）を取得する。なお、制御装置１による切断マニピュレータ２の位置制御については後述する。
【００３６】
切断マニピュレータ２のロボット先端には切り換え手段の一具体例である切り換え軸５を介して切断器３と距離センサ４が取り付けられている。この切断マニピュレータ２は、切断器３と距離センサ４とを所定の３次元空間内を自在に移動させることができる。
【００３７】
切断器３は、その一例として、ガス、プラズマ、レーザなどの熱溶断を行う装置が挙げられる。例えば、レーザによる熱溶断を行う機器ならばレーザ照射口から出力されるレーザビームの光パワーが集中するビームスポット位置に切断対象６が位置している必要があり、切断器３から切断対象６までの距離は、基準距離を保つように切断作業時には厳密に管理されることとなる。
【００３８】
距離センサ４は、切断対象６までの距離を検出し、先端距離検出値を制御装置１へ出力するようになされている。
ここに、切り換え軸５に取り付けられる切断器３と距離センサ４とは、角度を変えて取り付けられている（例えば、図１で示すように１８０゜反対方向である。）。切り換え軸５は図１で示す矢印Ａ方向に回転するようになされており、図１で示すような距離センサ４を切断対象６へ向けている状態と、図示しないが切断器３を切断対象６へ向けている状態とを切り換えて選択することができる。
【００３９】
このように切り換えを可能とする理由は、切断器３を切断対象６に向けて切断するときに発せられる熱から距離センサ４を保護するため、切断器３と距離センサ４とが直近にならないようにするためである。
この場合、切断器３の照射口から切断対象６までの距離と、距離センサ４から切断対象６までの距離とが一致するように機械的に位置決めされたうえで切り換え軸５に取り付けられることとなる。
【００４０】
続いて本実施形態による動作例について説明する。本実施形態では、特に、倣い制御自動ティーチング機能を果たすものである。
（１）切断経路の計画
まず、切断経路を計画する。計画時の切断経路１０は、図２（ａ）で示すように、計画時に想定した切断対象１１上に乗るような切断経路である。そして、この計画した切断経路に基づいて計画切断経路値を求め、図示しない入力装置（例えばキーボードなど）を用いて制御装置１に入力・登録する。
【００４１】
この計画時に入力される計画切断経路値は、切断経路上を移動する切断マニピュレータ２のロボット先端の三次元の座標値、および、この座標位置から切断器４の方向を決定する三次元方向ベクトルである方向ベクトル値であって、サンプリング時間ごとの複数個所についての値となる。入力された計画切断経路値は、図３で示すように計画切断経路値記憶部１ａにおいて登録される。この場合、計画切断経路値は、複数個所の座標値・方向ベクトル値が一括登録されることとなる。
なお、切断対象６から切断器４までの基準距離は基準距離記憶部１ｂに予め登録されているため、切断時における切断対象６上の切断経路を特定できることとなる。
【００４２】
（２）計画した切断経路の修正
しかし、実際の切断作業にあっては、先に説明したように、切断対象６が大きいため遠隔制御型切断ロボットをある場所から他の場所へ移動させた後に切断を継続するような場合がある。遠隔制御型切断ロボットの移動を伴う場合には、切断対象６と遠隔制御型切断ロボットとの位置関係を計画時に精度よく把握することは困難であるため、計画時の切断経路どおりに切断器４を制御しても、図２（ｂ）で示すように、実際の切断対象１３上における切断経路１２には乗らない恐れがある。
【００４３】
そこで、遠隔制御型切断ロボットをある場所から他の場所へ移動させた後に計画した切断経路の修正を行う。
まず、切り換え軸５を回転させて距離センサ４を切断対象６に向くようにする。そして、計画切断経路値に基づいて計画時の切断経路を辿らせるように切断マニピュレータ２を制御する。この場合、計画切断経路値として計画切断経路値記憶部１ａに登録されている、ある座標にロボット先端が到達するたび、距離センサ４と切断対象６との間の距離が所定距離となるように制御する。
【００４４】
具体的には、図３で示すように、制御装置１は距離センサ４から出力される先端距離検出値を基準距離となる距離指令値から引いて、距離補正値を出力する。この距離補正値に対して正規化手段１ｄを経て出力される切断器３の方向ベクトル値を乗じた量を計画時の経路と対象上の経路との間の誤差と考え、これを位置補正ベクトル値とする。
この位置補正ベクトル値を用いて、先端位置指令値として出力される計画切断経路値を修正して修正された先端位置指令値を先端→各軸座標変換器１ｅに出力し、切断マニピュレータ２のロボット先端の位置を修正する。そして、基準距離記憶部１ｂから出力される距離指令値と距離センサ４から出力される先端距離検出値が同じになった場合に、計画切断経路値を位置補正ベクトル値で修正した修正切断経路値を、修正切断経路値記憶部１ｃに登録する。
【００４５】
以下、他の座標に切断マニピュレータ２のロボット先端を移動させて同様の補正処理を行って全体の修正切断経路値を完成させる。最終的に切断対象６上の計画切断経路値に対応する修正断経路値が生成される。
これら修正切断経路値は制御装置１の修正切断経路値記憶部１ｃに全て登録されることとなる。
【００４６】
（３）切断
上記過程を経て生成された修正切断経路値を用いて切断を行う。まず、切り換え軸５を回転させて距離センサ４に代えて切断器３を切断対象６に向けて、修正切断経路値に沿って切断経路を辿りつつ切断器３を作動させる。この場合、切断器３と切断対象６との基準距離は一定に保たれており、切断が確実に行われる。
【００４７】
以上、本実施形態の倣い制御自動ティーチングを実現する遠隔制御型切断ロボットによれば、切断に先立って距離センサ４を用いた倣い制御による経路教示を自動的に行うことで、経路計画時には厳密に知ることができない切断器と切断対象との基準距離を、一定に保つような修正切断経路を生成して切断を行うため、切断を確実に行うことができる。
また、切り換え軸５を回動させることで、距離センサ４と切断器３との位置を入れ替えることができ、切断時の熱から距離センサ４を保護することができる。
【００４８】
２）切断対象上の切断経路から切断器の方向ベクトル値を生成するシステム１
続いて、請求項３に係る第２実施形態の遠隔制御型切断ロボットについて説明する。第１実施形態では、方向ベクトル値は特に補正しない実施形態であったが、本実施形態では、第１実施形態に加え、さらに、方向ベクトル値も修正するような構成を採用した。これらは制御装置１内の図示しない演算制御装置により実行される。第１実施形態として説明した倣い制御自動ティーチングにより、生成完了した切断対象６上の修正切断経路値から、連続する３個所の座標Ｐ0，Ｐ1，Ｐ2の座標値を抽出する。このような座標値を以下に示すような数１，数２，数３で表す。
【００４９】
【数１】
0003972244.tif 000002
【００５０】
【数２】
0003972244.tif 000003
【００５１】
【数３】
0003972244.tif 000004
【００５２】
これら３個所の座標Ｐ0，Ｐ1，Ｐ2を含む平面に対する法線ベクトルＶを導出することとなる。法線ベクトルＶは以下に示す数４のようになる。
【００５３】
【数４】
0003972244.tif 000005
【００５４】
この法線ベクトルは、その性質上、Ｐ0，Ｐ1，Ｐ2の３点において、切断対象６に対して垂直方向に向かうものであり、切断器３の方向ベクトル値とする。算出は、３点の座標を通る平面に垂直となるような法線ベクトルを、数５を用いて算出する。
【００５５】
【数５】
0003972244.tif 000006
【００５６】
本実施形態ではこのように方向ベクトル値を算出するようにしたため、距離センサ４を用いて生成した修正切断経路値から、切断経路が乗る平面の法線ベクトルを求めることが可能となり、切断器３と切断対象６との角度を垂直に近づけることができる。
【００５７】
３）切断対象上の切断経路から切断器の方向ベクトル値を生成するシステム２
続いて、請求項４に係る第３実施形態の遠隔制御型切断ロボットについて説明する。前述した第２実施形態では、方向ベクトル値を修正するような構成を採用したが、本実施形態では方向ベクトル値の他の修正手法に関するものである。これらは制御装置１内の図示しない演算制御装置により実行される。
第２実施形態として説明した遠隔制御型切断ロボットにおいて、修正切断経路値がｎ（ｎ＝４，５・・）個所ある場合（例えばｎ＝５）の座標値を有する場合、これら座標値から隣接する３個所の座標値を用い、数５により法線ベクトルを求める。そして、以下同様にしてｎ−２個所（ｎ＝５で３個所）について法線ベクトルを求める。そしてｎ−２（ｎ＝５で３個）の法線ベクトルを用いて、平均の法線ベクトルを算出して方向ベクトル値を算出する。そして、算出した方向ベクトル値と切断器３の方向とが一致するようにロボット先端を制御することで、切断器３が切断対象６の表面で垂直となるように維持する。
【００５８】
以上説明した第３実施形態によれば、生成した修正切断経路値から、切断経路が乗る平面の法線ベクトルを複数求めて平均をとることで、細かいうねりなどの影響を排除しつつ、切断器３と切断対象６との角度を垂直に近づけることができる。
【００５９】
４）切断対象上の切断障害の回避を実現する遠隔制御型切断ロボット続いて請求項５，６に係り、他の機能を実現する第４実施形態の遠隔制御型切断ロボットについて図を参照しつつ説明する。図４は本実施形態の遠隔制御型切断ロボットの構成図である。
本実施形態では、計画した切断経路に予め想定していなかったような突起や穴などの切断障害があることを発見した場合に、操作員の手動により切断障害を回避するような指定切断経路を生成できるようにした遠隔制御型切断ロボットである。
【００６０】
本実施形態では障害物回避を実現する遠隔制御型切断ロボットであって、第１実施形態で説明した制御装置１、切断マニピュレータ２、切断器３、距離センサ４、切り換え軸５、切断対象６に加え、監視カメラ３１、モニタ３２、操作入力盤３３を備えている。なお、第１実施形態で説明したものは同様の符号を付するとともに、重複する説明を省略する。
【００６１】
監視カメラ３１は、距離センサ４と略同一方向となるように切り換え軸５に配置され、距離センサ４の距離検出点周辺の切断対象６の表面を映した画像データを出力する。
モニタ３２は、監視カメラ３１から出力された画像データを処理して画像を表示する通常の映像表示装置である。
操作入力盤３３は、切断経路生成処理途中で操作員が操作入力すると、切断経路生成の中断・再開およびロボット先端の移動について操作入力できるようになされている。詳しくは、切断マニピュレータ２の動作を制御するような指令を制御装置１へ出力するものであり、経路生成中断指令、先端動作指令、通過点教示指令、経路生成再開指令を制御装置１へ出力する。
【００６２】
続いて、このような遠隔制御型切断ロボットによる切断障害の回避について説明する。操作員は切断対象６上の経路生成中、モニタ３２で監視カメラ３１が送信する画像を監視し、切断対象６上の突起や穴などの切断障害の有無を常時監視する。操作員が切断対象６上に切断障害があると判定した場合、操作入力盤３３に対し経路生成中断操作を行う。操作入力盤３３は、制御装置１へ経路生成中断指令を送信し、制御装置１は切断マニピュレータ２を制御してある点で停止させる。この場合の点を特に経路変更開始点という。
【００６３】
経路生成中断したならば、操作員は、モニタ３２で切断マニピュレータ２のロボット先端に対向する切断対象６の表面の状況を確認しながら、操作入力盤３３を操作し、切断マニピュレータ２のロボット先端を上下左右方向に移動させるような先端動作操作を行う。操作入力盤３３は、制御装置１へ先端動作指令を送信し、制御装置１は切断マニピュレータ２を制御して、切断障害を回避するよう切断マニピュレータ２の先端を移動させる。
上下左右方向への先端動作指令入力に対応するロボット先端の移動制御は、既知の工具座標系制御により行う。また、切断対象６と切断マニピュレータ２の先端との距離を一定に保つ制御も合わせて行う。
【００６４】
操作員は、モニタ３２で切断マニピュレータ２の先端が回避経路を移動させ、回避が終了したと判断するならば、操作員は操作入力盤３３を操作して通過点教示指令を入力すると、制御装置１は、最後に教示された通過点から最も近い計画時の切断経路上の点を経路変更復帰点とする。このような経路変更開始点から経路変更復帰点までの経路を指定切断経路とし、この指定切断経路を表す指定切断経路値を図示しない記憶部に一時的に登録する。
【００６５】
操作員は操作入力盤３３を操作して経路生成再開指令を入力すると、制御装置１は今まで登録されていた経路変更開始点から経路変更復帰点までの切断経路に係る計画切断経路値を、取得した指定切断経路値と入れ換えて計画切断経路記憶部１ａに登録する処理を行う。それから、制御装置１は、経路変更復帰点から経路生成処理を再開する。
【００６６】
以上、本実施形態の切断対象６上の切断障害を回避する遠隔制御型切断ロボットによれば、切断対象６上に突起・穴という切断障害を回避した切断経路を生成することができ、良好な切断を実現することができる。
【００６７】
５）距離センサが切断対象を検出できない領域での経路生成機能を実現する遠隔制御型切断ロボット
続いて請求項７に係る第５実施形態の遠隔制御型切断ロボットについて図を参照しつつ説明する。図５は本実施形態の遠隔制御型切断ロボットの構成図、図６は、距離センサが切断対象を検出できない領域での切断経路生成動作を説明する説明図である。
【００６８】
本実施形態では、距離センサ４が切断対象を検出できない領域においても、切断経路を生成する遠隔制御型切断ロボットである。距離センサ４が切断対象を検出できないような状態で切断マニピュレータ２を移動させると、切断対象６に切断マニピュレータ２の先頭が衝突するような場合が起こりうる。そこで、切断マニピュレータ２の移動当初において、切断マニピュレータ２が切断対象６へ衝突しないで近づくように誘導される切断経路を設定できるようにするというものである。
【００６９】
本実施形態では、第４実施形態で説明した遠隔制御型切断ロボットと同じく、制御装置１、切断マニピュレータ２、切断器３、距離センサ４、切り換え軸５、切断対象６、監視カメラ３１、モニタ３２、操作入力盤３３を備える点は同様であるが、操作入力盤３３は、第４実施形態として説明した以外にも、経路生成開始指令、経路生成前進指令、経路生成再開指令、経路生成終了指令を制御装置１へ出力できるようになされている。
【００７０】
続いて、このような遠隔制御型切断ロボットによる経路生成について図５，図６を参照しつつ説明する。
操作入力盤３３から経路生成開始指令信号が制御装置１へ出力されると、制御装置１は切断マニピュレータのロボット先端を予め設定した先端位置へ移動させた後、経路生成を中断する（図６の▲１▼から▲２▼まで移動し、▲２▼の位置で停止する。）。この先端位置は安全距離から生成される。
【００７１】
操作員は、モニタ３２で監視カメラ３１が送信する切断対象の端周辺画像を監視し、操作入力盤３３を操作して経路生成前進操作を行うと、操作入力盤３３は制御装置１へ経路生成前進指令を出力する。制御装置１は切断マニピュレータ２のロボット先端を移動させる。この場合、操作員は切断マニピュレータ２のロボット先端が切断対象６の上に入るまで、経路生成前進操作を続け、ロボット先端が切断対象６の内部へ所定距離以上入れるものとする（図６の▲２▼から▲３▼まで移動し、▲３▼の位置で停止する。）。
【００７２】
そして、切断マニピュレータ２のロボット先端が切断対象６上にある点を倣い制御開始点とし、操作員は、操作入力盤３３を操作して経路生成再開操作を行うと、操作入力盤３３は制御装置１へ経路生成再開指令を出力する。
制御装置１は、経路生成再開指令により距離センサ４が距離基準値になるまで切断マニピュレータ２のロボット先端を切断対象６まで近づける。切断マニピュレータ２のロボット先端が距離基準値になったとき、計画時の切断経路と切断対象上の切断経路とが一致しない場合があり、この場合のずれ量を補正量とする。その時の補正量を用いて登録済みの計画切断経路値の最初からその点までを新たな計画切断経路値として生成する。
【００７３】
その後、倣い制御自動ティーチングを開始する。そして操作員３４による経路生成終了指令入力があるまで、倣い制御自動ティーチングを続ける（図６の▲３▼から▲４▼まで移動する）。経路生成終了指令により、制御装置１は距離センサ４を用いた倣い制御を終了する。（図６の▲４▼参照）そして、倣い制御開始点から倣い制御終了点までの切断経路（倣い制御が可能な範囲）を修正切断経路値として求め、計画切断経路値と入れ換える。また、最初から倣い制御開始点までの経路（倣い制御が不可能な範囲）が修正切断経路値として加えられる。
【００７４】
以上、本実施形態で説明した、距離センサ４が切断対象６を検出できない領域での経路生成機能を有する遠隔制御型切断ロボットによれば、モニタ３２に表示される監視カメラ画像に基づく操作員の判断で、倣い制御を実施する範囲を指定し、倣い制御ができない範囲の経路は操作員が指定することとしたので、切り残しが出ないように切断経路を生成することができる。この方式では、接触式の距離センサを用いた場合でも、有効に経路生成を行うことができる。
【００７５】
６）距離センサが切断対象を検出できない領域での経路生成機能を実現する遠隔制御型切断ロボット
続いて請求項８に係る本発明の第６実施形態の遠隔制御型切断ロボットについて説明する。第５実施形態においては、接触式の距離センサを用いていたが、本実施形態では、例えば、レーザ光線を用いるなどした非接触式の距離センサを用いるものとする。この非接触式の距離センサは、先に説明した安全距離以上の距離を検出でき、距離センサが切断対象を検出できないような遠方にある場合には検出限界距離以上の先端距離検出値を出力する（つまり、検出不能であることを判別する検出値である）を出力するようにしてある。なお、本実施形態の遠隔制御型切断ロボットの構成については図５，図６を用いて示した第５実施形態と同様であるとしてその説明を省略する。
本実施形態の操作入力盤３３は、経路生成開始指令のみ出力できるようになされ、経路生成前進指令、経路生成再開指令、経路生成終了指令は出力しないようになされているものとする。
【００７６】
続いて本実施形態による経路生成について説明する。操作員が操作入力盤３３を操作して経路生成開始指令を入力すると、制御装置１は、自動的に経路生成前進指令がなされているとして、切断マニピュレータ２のロボット先端を前進移動させる（図６の▲２▼〜▲３▼の移動）。
距離センサ４の先端距離検出値が一定値以上から一定値未満になると、距離センサ４が切断対象６の上側にある（図６の▲３▼）ものとして、制御装置１は、経路生成再開指令がなされたと判定し、自動的に経路生成を再開する。
同様に距離センサ４の先端距離検出値が一定値未満から一定値以上になると、距離センサ４が切断対象６の外側にあるものとして、制御装置１は、経路生成終了指令がなされたと判定し、自動的に経路生成を終了する。
【００７７】
以上、本実施形態で説明したように、距離センサ４が切断対象６を検出できない領域での経路生成機能を有する遠隔制御型切断ロボットによれば、自動的に倣い制御を実施する範囲を指定することで、倣い制御ができない範囲の経路も生成可能とし、切り残しが出ないように切断経路を生成することができる。
【００７８】
７）レーザ光と画像から距離を算出するシステム１
続いて、第７実施形態の遠隔制御型切断ロボットについて説明する。図７は、本実施形態の遠隔制御型切断ロボットの構成図である。第７実施形態では、制御装置１、切断マニピュレータ２、切断器３、距離センサ４、切り換え軸５、切断対象６、レーザ光発振器６１、光ファイバ６２、レンズシステム６３、撮像管カメラ６４、画像処理装置６５を備えている。なお、先に説明した構成には同一の符号を付するとともにその説明を省略する。
【００７９】
図７で示すように、本実施形態は、１本のレーザ光と画像処理により切断対象までの距離を求めるシステムの構成である。レーザ光発振器６１で発生したレーザ光を光ファイバ６２でロボット先端まで送り、予め定めた撮像管カメラ６４と切断対象６との距離でカメラ画像の中心に光点が位置するように調整したレンズシステム６３を通過させる。画像上の光点位置と画像中心から、画像処理装置６５は、撮像管カメラ６４と切断対象６との距離を次式により算出する。
【００８０】
ｌ＝ｌ０ ＋ｋ・ｄＳ
但し、
ｌ０   ：撮像管カメラ６４と切断対象６との基準距離
ｄＳ   ：画像中心と画像上の光点位置との画像上での符号距離
ｋ    ：撮像カメラ６４とレンズシステム６３との位置関係と撮像管カメラ６４の視野角から求まる定数
ｌ    ：撮像カメラ６４と切断対象６との距離
本実施形態ではこの距離ｌを用いて上記した各種の処理を行うことが可能となる。
【００８１】
以上本実施形態によれば、レーザ光と画像処理による距離検出により、半導体を使用した距離センサを用いずに、非接触で切断対象までの距離を求めることができる。このため、半導体を用いることができない環境、例えば高放射線下で特に好適な遠隔制御型切断ロボットとすることができる。
【００８２】
８）レーザ光と画像から距離を算出するシステム２
続いて請求項１に係る本発明の第８実施形態の遠隔制御型切断ロボットについて説明する。図８は、３本のレーザ光と画像処理により切断対象までの距離を求めるシステムの原理図である。第７実施形態で説明したような、１本のレーザ光と画像処理により切断対象までの距離を求めるシステムと同様に、ロボット先端に設置されたレンズシステム６３により、レーザ光７１を３分岐して２本の平行なレーザ光７１と、それらと同一平面上にあって角度を持った１本のレーザ光７１を切断対象表面７２に当てる。それらの光点を撮像管カメラ６４で捕らえ、画像上の光点間の距離から次式数６により、距離を求める。
【００８３】
【数６】
0003972244.tif 000007
【００８４】
但し、
ｄＳ１   ：角度を持ったレーザ光７１の光点と、角度を持ったレーザ光７１と遠くで交差するレーザ光７１の光点との画像上の距離
ｄＳ２   ：角度を持ったレーザ光７１の光点と、角度を持ったレーザ光７１と近くで交差するレーザ光７１の光点との画像上の距離
ｌ０   ：ｄＳ２＝０となる位置から、ｄＳ１ ＝ ｄＳ２  となる位置までの距離
ｌ   ：ｄＳ２＝０となる位置と切断対象との距離
となる。
本実施形態ではこの距離ｌを用いて上記した各種の処理を行うことが可能となる。
【００８５】
以上本実施形態によれば、レーザ光と画像処理による距離検出により、半導体を使用した距離センサを用いずに、非接触で切断対象までの距離を求めることができる。この方式では、カメラの視野角の影響なく距離を求めることができる。このため、半導体を用いることができない環境、例えば高放射線下で特に好適な遠隔制御型切断ロボットとすることができる。
【００８６】
９）機械的構造を有する距離センサにより距離を算出するシステム
続いて本発明の第９実施形態の遠隔制御型切断ロボットについて説明する。図９は機械的構造を有する距離センサの構造図、図１０は終端位置の認識処理を説明するタイムチャートである。
図９で示すように距離センサ８０は、ポテンショメータ８１（センサ部に相当）、押付けバネ８２（付勢部に相当）、ロッド８３、車輪８４（従動子に相当）を備えている。
【００８７】
距離センサ８０では、押付けバネ８２によりロッド８３および車輪８４が切断対象６に押し付けられる構造を有し、ロッド８３の変位をポテンショメータ８１で電気信号に変換しているため、車輪８４が切断対象６に接触しない場合に先端距離検出値は最大値のまま固定される。
【００８８】
また、車輪８４が切断対象６の終端近傍にあり、切断対象６から車輪８４が離脱して接触しない状態になった瞬間、押付けバネ８２のバネ係数、摩擦、車輪８４とロッド８３の質量で決定される速度で車輪８４が突出し、先端距離検出値が変化する。一般に車輪８４とロッド８３との質量は小さく、摩擦も小さいと考えられるので、この場合の車輪８４が突出する速度は切断マニピュレータ２のロボット先端における移動速度を超える。
【００８９】
そこで、これら現象を利用し、先端距離検出値、または、先端距離検出値の距離変化率（以下単に距離変化率という）を用いて切断対象の終端位置における認識処理を行う。
例えば、図１０に示すように先端距離検出値が大きくなった時点を検出したり、図１１で示すように先端距離検出値の距離変化率が大きくなった時点を検出したり、または、図１２で示すように先端距離検出値および先端距離検出値の距離変化率を組み合わせて検出する。
【００９０】
なお、このような検出では切断対象６の細かい凹凸によっても先端距離検出値または距離変化率が変化する。そこで、これら凹凸によって終端位置を検出しないようにするため、先端距離検出値または距離変化率が所定値以上になってから一定時間連続するような場合の位置を切断対象の経路終端であると認識する。この際、先端距離検出値または距離変化率が変化した時点の位置を記憶することで、切断対象の経路終端を終端位置として認識する。このため、図示しないが、メモリ等の記憶装置と、このような認識処理を行う中央処理装置が、制御装置１内に設けられているものとする。
これにより、凹凸等を終端位置であると判断して切断マニピュレータを停止し、不正値による誤動作が長時間続いて衝突等の障害を起こさないようにすることができる。
【００９１】
続いて、経路終端位置の自動認識について図を参照しつつ説明する。
まず距離の変化による車輪の状態の検出について、図１０を参照しつつ説明する。
まず距離検出限界値を設定する。切断対象６から車輪８４が逸脱した場合、この距離検出限界値を超える時間が長期間続く点に着目して経路の終端位置を認識する。
【００９２】
位置Ａで距離が予め定められた距離検出限界値を超えたとき、位置Ａに係るデータを記録するとともに経過時間の計測（以下、単に計時という）を開始する。なお先端距離検出値の検出は続けられているものとする。このような状況下、経過時間が予め定められた端検出時間を超えない場合には、切断対象６の凹凸による突発的なものと判断して位置Ａに係るデータの記録を破棄する。
【００９３】
そして、位置Ｂで距離検出限界値を超えたとき、位置Ｂに係るデータを記録するとともに計時を開始し、経過時間が予め定められた端検出時間を超える場合には、切断対象６上から車輪８４が逸脱したものであると判断され、この位置Ｂが経路の終端位置であるとして登録される。この場合検出に関するフラグがＯＮ状態となる。
【００９４】
続いて、経路の終端位置の自動認識のうち、検出した先端距離検出値の距離変化率による車輪の状態の検出について図１１を参照しつつ説明する。
まず、変化率閾値を設定する。切断対象６から車輪８４が逸脱した場合、付勢力により車輪８４が高速度で突出するため、検出した距離変化率が上昇する。そして、それ以降距離変化率が変化しない時間が長期間続く点に着目して経路の終端位置を認識する。
【００９５】
位置Ａで距離変化率が予め定められた変化率閾値を超えたとき、位置Ａに係るデータを記録するとともに計時を開始する。なお距離変化率の検出は続けられているものとする。
このような状況下、その後も距離変化率の増減が続くような場合には、依然切断対象６上を車輪８４が従動していると判断して位置Ａに係るデータの記録を破棄する。
【００９６】
そして、位置Ｂで変化率閾値を超えたときに位置Ｂに係るデータを記録し、その後変化率が変化しない期間が予め定められた期間である端検出時間を超えるときには、切断対象６上から車輪８４が逸脱したものであると検出され、この位置Ｂが経路の終端位置であるとして登録される。この場合検出に関するフラグがＯＮ状態となる。
【００９７】
続いて、経路の終端位置の自動認識のうち、先端距離検出値と距離変化率とを組み合わせた車輪の状態の検出について図１２を参照しつつ説明する。
距離変化率用の変化率閾値と、先端距離検出値用の距離検出限界値と、をそれぞれ設定する。切断対象６から車輪８４が逸脱した場合、付勢力により車輪８４が高速度で突出するため、距離変化率が上昇する。このように最初の検出では即応性がある距離変化率を採用する。しかし、その後は距離が距離検出限界値を超える状態が長期間続く点に着目して先端距離検出値を観察して経路の終端位置であるか否かを認識する。
【００９８】
位置Ａで、距離変化率が予め定められた変化率閾値を超えたとき、位置Ａに係るデータを記録するとともに計時を開始する。なお、先端距離検出値および距離変化率の検出は続けられているものとする。
このような状況下、その後に距離が距離検出限界値を下回るような場合には、依然切断対象６上を車輪８４が従動していると判断して位置Ａに係るデータの記録を破棄する。
【００９９】
そして、位置Ｂにおいて、距離変化率が変化率閾値を超えたときに位置Ｂに係るデータを記録し、先端距離検出値が距離検出限界値を上回る期間が予め定められた期間である端検出時間を超えるときには、切断対象６上から車輪８４が逸脱したものであると判断され、この位置Ｂが経路の終端位置であるとして登録される。この場合検出に関するフラグがＯＮ状態となる。
【０１００】
【発明の効果】
以上、本発明によれば、ロボット切断器本体が移動する様な場合でも切断対象と切断器との位置関係の制約を守りつつ、遠隔制御による切断を実現するような遠隔制御型切断ロボットを提供することができる。
【０１０１】
詳しくは、遠隔制御での切断作業において、切断経路計画時には厳密に知ることができない切断器と切断対象との距離を一定に保ちつつ、切断する遠隔制御型切断ロボットを提供することができる。
【０１０２】
また、経路計画時に想定した切断対象の角度と実際の切断対象の角度との差により垂直でない場合でも、切断器と切断対象との角度を垂直に近づける遠隔制御型切断ロボットを提供することができる。
【０１０３】
また、切断対象上にある突起・穴などの障害が発見された場合に、これら障害を回避する切断経路を生成するような遠隔制御型切断ロボットを提供することができる。
【０１０４】
また、切断対象の端部など切断対象の切断開始時点と切断終了時点で距離センサが切断対象を捉えらなくなるような場合でも影響されることなく距離センサと切断対象と距離を一定に保つ制御を行い、確実に切断する遠隔制御型切断ロボットを提供することができる。
【０１０５】
また、高放射線下など、半導体を使用した距離センサをロボット先端に配置できない環境において、非接触で切断対象までの距離を測定する遠隔制御型切断ロボットを提供することができる。
【０１０６】
また、環境に影響されない機械的構造を有する距離センサをロボット先端に配置し、接触で切断対象までの距離を測定する遠隔制御型切断ロボットを提供することができる。
【図面の簡単な説明】
【図１】本発明の第１実施形態の遠隔制御型切断ロボットの構成図である。
【図２】本発明の第１実施形態の遠隔制御型切断ロボットによる切断経路を説明する説明図である。
【図３】切断経路生成処理を行う制御ブロック図である。
【図４】本発明の第４実施形態の遠隔制御型切断ロボットの構成図である。
【図５】本発明の第５実施形態の遠隔制御型切断ロボットの構成図である。
【図６】距離センサが切断対象を検出できない領域での切断経路生成動作を説明する説明図である。
【図７】本発明の第７実施形態の遠隔制御型切断ロボットの構成図である。
【図８】３本のレーザ光と画像処理により切断対象までの距離を求めるシステムの原理図である。
【図９】機械的構造を有する距離センサの構造図である。
【図１０】終端位置の認識処理を説明するタイムチャートである。
【図１１】終端位置の認識処理を説明するタイムチャートである。
【図１２】終端位置の認識処理を説明するタイムチャートである。
【符号の説明】
１      制御装置
１ａ  計画切断経路値記憶部
１ｂ  基準距離記憶部
１ｃ  修正切断経路値記憶部
１ｄ  正規化手段
１ｅ  先端→各軸座標変換器
２      切断マニピュレータ
３      切断器
４      距離センサ
５      切り換え軸
６      切断対象
１０    計画時の切断経路
１１    計画時に想定した切断対象
１２    実際の切断対象上の切断経路
１３    実際の切断対象
３１    監視カメラ
３２    モニタ
３３    操作入力盤
６１    レーザ光発振器
６２    光ファイバ
６３    レンズシステム
６４    撮像管カメラ
６５    画像処理装置
７１    レーザ光
７２    切断対象表面
８０    距離センサ
８１    ポテンショメータ
８２    押付けバネ
８３    ロッド
８４    車輪
【図１】
0003972244.tif 000008
【図２】
0003972244.tif 000009
【図３】
0003972244.tif 000010
【図４】
0003972244.tif 000011
【図５】
0003972244.tif 000012
【図６】
0003972244.tif 000013
【図７】
0003972244.tif 000014
【図８】
0003972244.tif 000015
【図９】
0003972244.tif 000016
【図１０】
0003972244.tif 000017
【図１１】
0003972244.tif 000018
【図１２】
0003972244.tif 000019