(57)【特許請求の範囲】
【請求項１】
空間内で工具を手動により案内する装置であって、
少なくとも２つのアーム部分(3)を有する回動アーム(2)を備え、
それらのアーム部分(3)を、アーム部分相互間で、回転若しくは走行または回転且つ走行をさせる駆動ユニット(4)を備え、
この駆動ユニット(4)に結合された制御装置(6)を備え、
この制御装置(6)に接続された第１メモリ(9)を備え、
前記制御装置(6)に接続されていて、工具(1)の位置および姿勢を検知する第１測定装置(7)を備え、
工具(1)は、前記回動アーム(2)の自由端(2.1)に結合でき;
前記第１メモリ(9)には、工具(1)の運動範囲を予め定めるために、前記運動範囲内の点それぞれについての、アーム部分相互間での回転角度および走行位置の少なくとも一方に関する第１情報が記憶され；
工具を手動により案内する際に使用される第２測定装置(8)にして、前記制御装置(6)に結合され、工具(1)および前記回動アーム(2)の少なくとも一方に加えられる作動力(F)を検知する第２測定装置(8)を備え；
前記制御装置(6)が次のように構成されている、すなわち、検知された作動力および工具(1)の検知された工具位置に依存して、前記制御装置(6)は、前記検知された作動力が所定の第１閾値を越すと案内動作を開始させ、前記第１閾値より小さい所定の第２閾値を下回ると案内動作を終了させ、且つ、前記制御装置(6)は、案内動作を、前記駆動ユニット(4)から工具(1)を駆動してその工具(1)を前記運動範囲内で前記作動力の方向へ移動させることによって行う、ように構成されている
ことを特徴とする装置。
【請求項２】
請求項１に記載の装置において、
前記制御装置(6)によって、前記運動範囲内における、検知された工具位置に近接する点であって、その点へと前記工具位置から延びる位置ベクトルが前記作動力の方向に対して最小の偏差を示す点について、前記アーム部分(3)で、上記点に対応する角度位置への回転、対応する走行位置への走行を行わせる、ことを特徴とする装置。
【請求項３】
請求項１または２に記載の装置において、
前記運動範囲が、少なくとも１つの空間曲線または少なくとも１つの自由形状面または少なくとも１つの空間範囲を含む、ことを特徴とする装置。
【請求項４】
請求項１，２または３に記載の装置において、
前記制御装置(6)には、制御入力(14.1)を持つ処理ユニット(14)と、前記制御入力(14.1)および前記第２測定装置(8)に接続された第１比較ユニット(17)と、その第１比較ユニット(17)に接続された第２メモリ(18)および第３メモリ(19)とが含まれ、
前記第２メモリ(18)には前記第１閾値の情報が記憶され、作動力が前記第１閾値を越えた際には、前記処理ユニット(14)の制御で、前記駆動ユニット(4)の作動を前記第１比較ユニット(17)によって開始させ、
前記第３メモリ(19)には前記第２閾値の情報が記憶され、作動力が前記第２閾値を下回った際には、前記処理ユニット(14)の制御で、前記駆動ユニット(4)の作動を前記第１比較ユニット(17)によって終了させる、
ことを特徴とする装置。
【請求項５】
請求項１〜４の何れか１項に記載の装置において、
前記処理ユニット(14)に結合され、作動力が前記第２閾値を下回った際に、前記処理ユニット(14)によって制御されて、前記アーム部分(3)をアーム部分相互間で固定する装置(20)が設けてある、ことを特徴とする装置。
【請求項６】
請求項１〜５の何れか１項に記載の装置において、
前記制御装置(6)には、前記第１測定装置(7)に接続された第２比較ユニット(22)が含まれ、
前記第１メモリ(9)には、前記第１情報の記憶された第１部分(9.1)が含まれ、さらに、前記第２比較ユニット(22)に接続され且つ、前記運動範囲内に副範囲を定める第２情報の記憶された第２部分(9.2)が含まれ、
前記副範囲内への移行時に第１音響信号および第１光学信号の少なくとも一方を発生し、前記副範囲外への移行時に第２音響信号および第２光学信号の少なくとも一方を発生するため、第１音響信号装置および第１光学信号装置の少なくとも一方が前記第２比較ユニット(22)に接続して設けてある、
ことを特徴とする装置。
【請求項７】
請求項１〜６の何れか１項に記載の装置において、
前記第１メモリ(9)には、第１情報の記憶された第１部分(9.1)と、前記回動アーム(2)に設けた工具(1)の到達可能な空間内の点それぞれについての、アーム部分相互間の回転角度および走行位置に関する第３情報を記憶した第３部分(9.3)とが含まれ、
前記制御装置(6)には、前記処理ユニット(14)と、切換スイッチ(15)と、この切換スイッチ(15)の第１切換入力(15.4)および第２測定装置(8)に接続された第３比較ユニット(24)と、この第３比較ユニット(24)に接続された第４メモリ(23)とが含まれ、
前記第１部分(9.1)が前記切換スイッチ(15)の第１入力(15.1)に接続され、前記第３部分(9.3)が前記切換スイッチ(15)の第２入力(15.2)に接続され、前記切換スイッチ(15)の出力(15.3)が前記処理ユニット(14)に接続され、
前記第４メモリ(23)には作動力の大きさに関する第３閾値の情報が含まれ、作動力が前記第３閾値を越えた際には、前記第３比較ユニット(24)の制御で、前記切換スイッチ(15)を介して前記第３部分(9.3)が前記処理ユニット(14)に接続されるよう、構成されている、
ことを特徴とする装置。
【請求項８】
請求項７に記載の装置において、
前記制御装置(6)には、前記第１測定装置(7)および前記第１メモリ(9)に接続された第４比較ユニット(25)が含まれ、さらに、前記運動範囲内への移行時に第３音響信号および第３光学信号の少なくとも一方を発生し、前記運動範囲外への移行時に第４音響信号および第４光学信号の少なくとも一方を発生するため、第２音響信号装置および第２光学信号装置の少なくとも一方が前記第４比較ユニット(22)に接続して設けてある、
ことを特徴とする装置。
【請求項９】
請求項７又は８に記載の装置において、
前記切換スイッチ(15)には第２入力(15.5)があり、前記第３比較ユニット(24)には出力があり、
前記制御装置(6)には、前記第１測定装置(7)および前記第１メモリ(9)の第１部分(9.1)に接続された第５比較ユニット(26)と、切換スイッチ(15)の第２切換入力(15.5)に接続された出力(27.3)を持つＡＮＤ回路(27)とが含まれ、
前記ＡＮＤ回路(27)には、前記第５比較ユニット(26)の出力(26.1)に接続された第１入力(27.1)と、前記第３比較ユニット(24)の出力(24.1)に接続された第１否定入力(27.2)とが含まれ、
作動力が第３閾値情報の閾値以下にあり且つ工具の位置が前記運動範囲内にある場合には、前記第１部分(9.1)が前記切換スイッチ(15)を介して前記処理ユニット(14)に接続されるよう、前記第３比較ユニット(24)と前記第５比較ユニット(26)および前記切換スイッチ(15)が構成されている、
ことを特徴とする装置。
【請求項１０】
請求項１〜９の何れか１項に記載の装置において、
工具(1)の位置および姿勢を検知する前記第１測定装置(7)が、アーム部分相互間の回転角度および走行位置を検知する第１測定ユニットを含む、ことを特徴とする装置。
【請求項１１】
請求項１０に記載の装置において、
前記第１測定ユニットが、アーム部分相互間の連結部に設けた位置検知器を含む、ことを特徴とする装置。
【請求項１２】
請求項１１に記載の装置において、
前記位置検知器は、アーム部分相互間の角度検知器からなることを特徴とする装置。
【請求項１３】
請求項１〜９の何れか１項に記載の装置において、
工具(1)の位置および姿勢を検知する前記第１測定装置(7)には、相互に離間させて空間的に固定された少なくとも３つの高周波送信器(10.1, 10.2, 10.3, 10.4, 10.5)と、アーム部分(3)相互の接続部に設けた少なくとも１つの受信器(11)とが含まれ、
前記第１測定装置(7)には、前記接続部から工具(1)までの間のアーム部分(3)の回転角度および走行位置を検知する第１測定ユニットが含まれる、
ことを特徴とする装置。
【請求項１４】
請求項１〜９の何れか１項に記載の装置において、
工具(1)の位置および姿勢を検知する前記第１測定装置(7)には、相互に離間させて空間的に固定された少なくとも３つの高周波送信器(10.1, 10.2, 10.3, 10.4, 10.5)と、工具(1)との接続部分に設けた少なくとも１つの受信器(11)とが含まれる、ことを特徴とする装置。
【請求項１５】
請求項１３又は１４に記載の装置において、
前記第１測定装置(7)には、異なる変調周波数で送信を行う５つの高周波送信器(10.1, 10.2, 10.3, 10.4, 10.5)と、それらの高周波送信器の位相位置を検知するよう構成された受信器(11)とが含まれている、ことを特徴とする記載の装置。
【請求項１６】
請求項１３，１４，又は１５に記載の装置において、
前記高周波送信器が、１ＭＨｚ〜１０ＧＨｚの範囲の変調周波数を有するレーザダイオード(10.1, 10.2, 10.3, 10.4, 10.5)からなる、ことを特徴とする装置。
【請求項１７】
請求項１〜１６の何れか１項に記載の装置において、
作動力を検知する前記第２測定装置(8)が、前記アーム部分(3)相互の接続部に設けた力センサおよび／またはトルクセンサを含む、ことを特徴とする装置。
【発明の詳細な説明】
【０００１】
【発明の属する技術分野】
本発明は、空間内を工具、特に、測定工具および／または加工工具を案内する方法及び装置に関するものである。
【０００２】
【従来の技術】
測定技術、材料加工および、特に、医学では、しばしば、変形可能なまたは不均一な試料などの三次元自由形状面を測定または加工する必要がある。この場合、一般に、その測定すべき空間曲線、面または空間範囲に沿って測定工具または加工工具を案内する各種の方法を使用する。例えば、工具を回動アームの自由端に設置し、各アーム部分を相互に回転または走行させて所定の運動範囲を工具を走行させる。
【０００３】
即ち、例えば、このような回動アームの自由端に設けた機器を所定の軌道曲線に沿って走行させることは、ミクロ外科学、特に、神経外科学の分野で知られている。この場合、軌道曲線は、核スピン断層撮影またはコンピュータ断層撮影の診断結果から、処置前に計画し、定める。外科医は、処置中、回動アーム駆動装置の制御装置に接続された作動ユニット（例えば、操縦桿など）によって工具を走行させる。この場合、外科医は、常に、事前に定めた経路上にいるか否かに関する視覚的情報を得る。
【０００４】
即ち、この場合、所定の軌道曲線に沿う工具の案内は、直接、外科医によって行われる。しかしながら、かくして、一方では、全処置中、機器の走行が、外科医の特に高度の集中力を必要とし、処置に必要な時間が増大し、不注意または集中力低下がなくとも、所定の軌道曲線に対する著しい偏差が生じ、かくして、恐らく、重大な作用が誘起されることになる。他方では、操縦桿による制御にもとづき、機器に対する外科医の直接的な接触感触は得られない。かくして、操縦桿の双方の主運動方向（前−後、左−右）に制限されない運動の場合、処置中に比較的長い作業時間および高い集中力を必要とし、従って、操作エラーを誘発する部分的に複雑な制御運動推移が必要となる。
【０００５】
工業用ロボットによって実施されるような他の操作の場合、事前にプログラミングした経過にもとづき、所定の軌道曲線などを走行するが、この場合、オペレータは、経過に関与しない。この場合、工具は、所定の軌道曲線に沿って比較的正確に案内されるが、工具で加工または検査されるボデー、その他の形状の変化に対しては、多額の経費をかけなければ検知、補償できないという欠点がある。即ち、このような方法は、例えば、外科医が、軌道曲線の設計後に現れる偏差または組織変化に起因する複雑さに応答できなければならないミクロ外科学における使用には不適である。
【０００６】
【発明が解決しようとする課題】
従って、本発明の課題は、上述の欠点が全くないか、あったとしても極く僅かであり、特に、所定の運動範囲において工具を簡単に且つできる限り正確に案内できる、冒頭に述べた種類の方法および装置を提供することにある。
【０００７】
【課題を解決するための手段】
この課題は、制御装置に結合された駆動ユニットを介して相互に回転または走行させられるアーム部分を有する回動アームの自由端に設けた工具を、制御装置によって制御して、駆動ユニットを介して限定された少なくとも１つの運動範囲を走行させ、その運動範囲にある第１点に対する工具の限定された運動範囲を規定するため、それぞれ、当該アーム部分の間の回転角度および／または走行位置を決定し、少なくとも１つの第１測定装置によって工具の位置および姿勢を検知するようにした方法装置であって、工具の手動制御案内のために、第２測定装置によって、工具と回動アームのいずれか一方または双方に加えられる作動力を検知し、アーム部分を、検知された作動力、検知された工具の位置および所定の運動範囲に依存して、制御装置によって制御して、相互に回転または走行させ、かくして、工具を所定の運動範囲内で本質的に作動力の方向へ駆動させることを特徴とする方法と装置とによって解決される。
【０００８】
本発明は、工具の手動制御案内のために、工具および／または回動アームに加えられる作動力を第２測定装置によって検知し、アーム部分を、検知された作動力、検知された工具の位置および所定の運動範囲に依存して、制御装置によって制御して、相互に回転および／または走行させ、かくして、工具を所定の運動範囲内を作動力の方向へ駆動すれば、工具を特に簡単に案内し、しかも、正確に案内できる。
【０００９】
工具または回動アームに対する検知した作動力による工具の運動を分解することによって、一方では、オペレータと工具との間の直接的接触を達成でき、かくして、複雑な運動推移においても、操作が、明らかに容易化される。なぜならば、複雑な制御運動を実施する必要はなく、工具または回動アームに、所望の運動方向の作動力を加えるだけでよいからである。
【００１０】
各アーム部分の駆動ユニットの本発明に係る制御によって、工具は、事前に定めた運動範囲を走行される。所定の運動範囲の不測な離脱は、確実に排除されるので、オペレータは、所定の運動範囲における工具の案内に殆ど集中する必要はなく、例えば、工具の案内中、その集中力を他の問題なそに有利に向けることができる。まさに神経外科学では、治具として作用する工具案内が、特に有利である。なぜならば、この場合、外科医は、周囲の組織により多くの注意を向けることができ、常時、コース修正に注力する必要はないからである。
【００１１】
オペレータが選択できる複数の運動範囲を定めることができれば好ましい。その選択を工具の案内中も行うことができ、代替方策としてまたは補足して、既に開始した工具の案内中にも、更に新しい運動範囲を定め、選択することもできれば好ましい。
【００１２】
【発明の実施の形態】
更に、本発明の好ましい実施形態では、もちろん、工具の走行速度を調節できる。オペレータが、操作の実施中も、工具の走行速度を調節できれば好ましく、かくして、当該の状況に適合したナビゲーションが可能となる。即ち、例えば、外科処置の場合、重要でない箇所では迅速に走行し、一方、重要な箇所では、注意深い低速な進行が可能である。
【００１３】
駆動ユニットの制御のため、工具の実位置および作動力の方向を連続的または間欠的に求め、求めた実位置に対して、それに隣接する点のうち、実位置から出発し作動力の方向に対する偏差が最小である位置ベクトルを有するような第１点を求めるのが好ましい。次いで、求めた上記第１点に対応する角度位置に駆動ユニットによってアーム部分を回転するおよび／または対応する走行位置に走行させる。更に、選択された第１点に対応する位置にアーム部分を回転または走行させる毎に、工具の実位置および作動力の方向を確認するのが好ましい。なぜならば、かくして、特に簡単な制御を達成できるからである。
【００１４】
第１点における運動範囲の最高分解細度は、駆動ユニットの運動増分に依存する。回転駆動において角度増分が小さければ小さいほど、あるいは、線形駆動において長さ増分が小さければ小さいほど、運動範囲の達成可能な分解度はより微細となり、かくして、任意の曲率の運動路に対する工具の運動の近似度も向上する。
【００１５】
運動範囲が、少なくとも１つの空間曲線、少なくとも１つの自由形状面または少なくとも１つの限定された空間範囲またはこれらの組合せであれば好ましい。本発明の好ましい実施形態の場合、更に、運動範囲内に第１副範囲を定める。この場合、第１点から第１副範囲内の走行を少なくとも１つの第１音響信号および／または光学信号によって表示する。かくして、所定の理想的運動範囲に対する公差範囲、即ち、工具を運動させ得る範囲を定めることができる。この場合、オペレータは、当該の音響信号または光学信号によって、公差範囲にいるか否かに関する判断基準を得る。
【００１６】
例えば、第１副範囲を、理想的運動範囲を自由形状面として定め、その自由形状面に対して若干の垂直距離を置いて自由形状面の両側に広がる運動範囲によって定めることができる。しかしながら、他の実施形態にもとづき、第１副範囲は、空間範囲または空間曲線またはこれらの方式の組合せであってもよい。この場合も、更に、オペレータが選択できる複数の副範囲を定めることができる。工具の案内中に上記選択を実施でき、更に、代替方策としてまたは補足して、既に開始した工具案内中に、他の新しい副範囲を定め、選択できれば好ましい。
【００１７】
本発明に係る方法の好ましい実施形態の場合、求めた作動力の大きさに対して、第１閾値を定め、第１閾値を越えた場合にアーム部分の回転が行われる。かくして、工具の正確な案内および位置決めが可能である。なぜならば、例えば、工具または回動アームに案内の手を置いた状態において、僅かな作動力による工具の不測の運動を確実に回避できるからである。代替方策として、更に好ましくは、補足して、第２閾値を下回った場合には、アーム部分の回転および／または走行が終了し、アーム部分が当該回転位置および／または走行位置に固定されるよう、第２閾値を定めることである。かくして、工具が、僅かな作動力にもとづき、不測に更に駆動されるのが回避される。
【００１８】
駆動ユニットが、自己ロック性に構成されてないか、駆動ユニットの自己ロック性が、アーム部分を当該の回転位置および／または走行位置に固定するのに不十分である場合は、第２閾値を下回った際に、アーム部分の位置を固定するためアクティブにされ、第１閾値を越えた際には、再び解放される対応する装置（例えば、ブレーキなど）を設けることができる。かくして、回動アームおよび工具の重力起因の偶発的運動は、確実に排除される。
【００１９】
本発明に係る方法の実施形態に基づいて、回動アームに取り付けられた工具が到達できる空間内にある第２点について、それぞれ、当該のアーム部分の間の回転角度および／または走行位置を定める。求めた作動力の大きさについて、第３閾値を定め、第３閾値を越えた場合には、実位置から出発し作動力の方向に対する偏差が最小である位置ベクトルを有し、確認された実位置に隣接する第２点に工具が移動されるよう、アーム部分の回転および／または走行を行う。即ち、第３閾値を越えた場合、所定の運動範囲から離れることができる。かくして、運動範囲の場合による変化に簡単に応答できる。従って、この実施形態の場合、工具の運動範囲における強制案内は、不変ではなく、当該の状況にもとづき、対応して大きい作動力を単に加えることによって克服できる。
【００２０】
所定の運動範囲内にいるという判断基準をオペレータに与えるため、第２点から所定運動範囲内の走行を少なくとも１つの第３音響信号および／または光学信号によって表示するのが好ましい。補足してまたは代替方策として、第２点から所定運動範囲外への走行を少なくとも１つの第４音響信号および／または光学信号によって表示する。この場合、オペレータは、所定の運動範囲から離れたことを直ちに知り得る。即ち、所定の運動範囲からの離脱は、直ちに知られる。
【００２１】
この実施形態の場合、制御装置は、第３閾値を再び下回ると直ちに、工具を所定の運動範囲の方向へ再び走行させて所定の運動範囲内にもどすよう、構成されている。しかしながら、運動範囲外のナビゲーションが、第３閾値以下の作動力によっても可能であり、オペレータが、新たに、工具を所定の運動範囲に走行させて始めて、所定の運動範囲における強制案内が再び始まるよう、制御装置を構成するのが好ましい。この場合、オペレータは、最短コースで所定の運動範囲にもどる方策に関する指示を得ることができる。
【００２２】
本発明の好ましい実施形態にもとづき、もちろん、第１副範囲の離脱する運動、および第１副範囲内である公差範囲内の運動についても、作動力に関して同様に作用する閾値を設けることができる。
【００２３】
本発明に係る方法の好ましい実施形態の場合、工具の位置および姿勢の検知のため、当該のアーム部分の間の回転角度および走行位置を求め、これらデータから、アーム部分および工具の既知のジォメトリによって工具の位置および姿勢を簡単に決定できる。特に簡単な実施形態の場合、当該のアーム部分の間の回転角度および走行位置の検知は、当該のアーム部分の間の接続範囲に設けた位置検知器によって、例えば、当該連結部分に設けた角度検知器によって行うのが好ましい。しかしながら、もちろん、各アーム部分の位置決定するため他の公知の測定法を使用することもできる。
【００２４】
本発明に係る特に有利な実施形態は、工具の位置および姿勢の検知を連結ナビゲーションの態様で行うことを特徴とする。これは、相互に離隔された空間的に移動しない少なくとも３つの高周波送信器および回動アームの２つのアーム部分の間の第１連結の箇所に設けた少なくとも１つの受信器によって空間内の２つのアーム部分の間の第１連結の位置を測定し且つ第１連結と工具との間のアーム部分の回転角度および走行位置を検知して行う。相互に離隔された空間的に移動しない複数の高周波送信器および決定すべき点に設けた１つの受信器によって点の位置を決定することは、周知である。この場合、工具の位置は、第１連結の位置および第１連結と工具との間のアーム部分の回転位置または走行位置を参照してアーム部分および工具の既知のジォメトリにもとづいて決定できる。
【００２５】
かくして、上述の実施形態の場合に位置検知器の誤差にもとづき生ずる誤差が減少される。即ち、例えば、連結の箇所に設けた角度検知器の角度誤差は、回動アームの自由端へ向かって指数関数的に増大し、従って、この実施形態の場合、上記誤差を小さくするため、回動アームを比較的剛に構成しなければならず、経費増が結果する。回動アームに設置した受信器の位置決定と、第１連結と工具との間のアーム部分の回転角度または走行位置の検知とを上述の如く関連させた場合、上記誤差は減少される。なぜならば、回動アームの固定部分から第１接続までの位置検知器の誤差は、工具位置の計算に関与しないからである。従って、回動アームを安価に構成でき、しかも、工具の位置決定の精度が損なわれることはない。他の有利な実施形態の場合、相互に離隔された空間的に移動しない少なくとも３つの高周波送信器および工具に設けた１つの受信器によって空間内の工具の位置および姿勢を検知することによって、位置検知器の誤差から生ずる上記誤差を完全に除去できる。この場合、回動アームは、特に簡単に且つ容易に構成できる。なぜならば、位置検知器の誤差および自重による回動アームの変形による影響は、位置決定に関与しないからである。
【００２６】
もちろん、このようなすべての実施形態の場合、点の位置決定およびこの点について決定されたアーム部分の回転角度および走行位置が相互に一致するよう、校正を行わなければならない。
高周波送信器による位置決定の上記実施形態の場合、異なる変調周波数で送信を行う５つの高周波送信器および高周波送信器の位相位置を検知するよう構成された受信器を使用する。高周波送信器の空間的に不変の既知の位置にもとづき、受信器によって検知される各高周波送信器の変調周波数の異なる位相位置から、受信器の位置を正確に決定できる。更に、１ＭＨｚ〜１０ＧＨｚの範囲の変調周波数を有するレーザダイオードを高周波送信器として使用するのが好ましい。この場合、変調周波数の高さは、設定課題および所要の測定精度に応じて決まる。
【００２７】
作動力の検知は、よく知られている態様で、回動アームに設けた力測定ボックス、トルクセンサなどによって行うことがきる。この場合、作動力にもとづき回動アームに作用する力の大きさ、即ち、力と偶力（トルク）を３つの直交空間方向へ完全に検知できるということのみが重要である。これは、作動力の検知のため、アーム部分の間の接続の範囲に力センサおよび／またはトルクセンサを設けることによって行うのが好ましい。
【００２８】
更に、本発明の１実施形態は、工具の手動制御案内のため、制御装置に結合され工具および／または回動アームに加えられる作動力を求める第２測定装置を含み、検知された作動力、検知された工具の位置に依存して工具を所定の運動範囲内を作動力の方向へ走行させるように制御装置を構成した装置である。この場合、工具の求めた実位置に対して、隣接の第１点のうち、実位置から出発し作動力の方向に対する偏差が最小である位置ベクトルを有するような点を求め、駆動ユニットによってアーム部分を上記第１点に対応する角度位置に回転させるおよび／または対応する走行位置に走行させるよう、制御装置を構成するのが好ましい。かくして、上述の方法のすべての利点が、対応する装置に転換される。
【００２９】
この場合、制御装置は、処理ユニットと、処理装置の制御入力結合された第１比較ユニットと、上記比較ユニットに結合された第２メモリと、この代替として、好ましくは、補足して、第１比較ユニットに結合された第３メモリとを含む。この場合、第１比較ユニットは、第２測定装置に接続されている。第２メモリは、作動力の大きさに関する第１閾値情報を含む。この第１閾値を越えると、第１比較ユニットが、処理ユニットによって駆動ユニットの作動を開始する。他方、第３メモリは、作動力の大きさに関する第２閾値情報を含む。この第２閾値を下回ると、処理ユニットが、第１比較ユニットによって制御されて駆動ユニットの作動を終了する。この場合、第１，第２閾値情報は、例えば、対応する入力装置によってまたはオペレータによる対応するメモリモジュールの交換によって定めることができる。既述の如く、作動力の上記閾値の基準によって、工具の正確な案内および位置決めが簡単に可能である。
【００３０】
本発明に係る装置の有利な実施形態では、各駆動ユニットが自己ロック性を有していないか、駆動ユニットの自己ロック性が回動アームを当該の位置に固定するのに不十分である場合は、第２閾値を下回った際に、アーム部分を相互に固定する装置を設ける。この場合、例えば、簡単なブレーキなどを設ければよい。
【００３１】
本発明に係る装置の有利な実施形態の場合、運動範囲内の公差範囲の決定のため、制御装置は、第１測定装置に接続された第２比較ユニットを含み、第１メモリは、第１情報を記憶した第１部分範囲と、第２比較ユニットに接続され、運動範囲内に第１副範囲を決定する第２情報を含む第２部分範囲とを含む。更に、第１点から第１副範囲内の走行時に少なくとも１つの第１音響信号および／または光学信号を発生させるため、および／または、第１点から第１副範囲外への走行時に少なくとも１つの第２音響信号および／または光学信号を発生させるため第２比較ユニットに接続された第１音響信号および／または光学信号装置が設けてある。かくして、装置のオペレータは、簡単に、第１副範囲にいるか否かを直ちに知ることができる。
【００３２】
本発明に係る装置の好ましい実施形態の場合、所定の運動範囲において上述の如き強制案内の停止を実現するため、第１メモリは、第１情報を記憶した第１部分範囲のほかに、回動アームに設けた工具が到達可能な空間内にある点について当該アーム部分の間の回転角度および／または走行位置に関する第３情報を含む第３部分範囲を含む。この場合、制御装置は、更に、処理ユニットと、第１切換スイッチと、第１切換スイッチの第１切換入力および第２測定装置に接続された第３比較ユニットと、第３比較ユニットに接続された第４メモリとを含む。第４メモリは、作動力の大きさに関する第３閾値情報を含む。この場合、第１部分範囲は、第１切換スイッチの第１入力に接続され、第３部分範囲は、第１切換スイッチの第２入力に接続され、第１切換スイッチの出力は、処理ユニットに接続されている。作動力の第３閾値情報の閾値を越えた際に、第１メモリの第３部分範囲は、第３比較ユニットによって制御されて、第１切換スイッチを介して処理ユニットに接続され、かくして、処理ユニットは、駆動ユニットの制御のため、第３部分範囲にファイルされた第３情報を使用し、所定の運動範囲外の点にも走行できる。
【００３３】
この場合も、所定の運動範囲内にいるか所定の運動範囲外にいるかに関する情報をオペレータに与える光学的および／または音響的表示装置を設けるのが好ましい。このため、制御装置は、第１測定装置および第１メモリに接続された第４比較ユニットを含み、第２音響信号および／または光学信号装置が設けてある。この信号装置は、第１点から第１副範囲内の走行時に少なくとも１つの第３音響信号および／または光学信号を発生するため、および／または、第１点から第１副範囲外への走行時に少なくとも１つの第４音響信号および／または光学信号を発生するため第４比較ユニットに接続されている。
【００３４】
本発明に係る装置の特に好ましい実施形態の場合、制御装置は、第１測定装置および第１メモリの第１部分範囲に接続された第５比較ユニットと、第１切換スイッチの第２切換入力に出力を接続したＡＮＤ回路とを含む。ＡＮＤ回路は、第５比較ユニットの出力に接続された第１入力と、第３比較ユニットの出力に接続された否定第２入力とを有する。作動力が第３閾値情報の閾値以下にあり、同時に、所定の運動範囲内にある点に走行する場合、第１部分範囲は、第１切換スイッチを介して処理ユニットに接続され、かくして、処理ユニットは、駆動ユニットの制御のため第１部分範囲にファイルされた第１情報にアクセスし、従って、所定の運動範囲において強制案内が行われる。即ち、所定の運動範囲を離れ、次いで、対応して小さい作動力で新たに走行された場合、所定の運動範囲に入ると、所定の運動範囲における強制案内が再開される。
【００３５】
本発明の有利な実施形態にもとづき、もちろん、すべてのメモリの情報は、例えば、対応する入力装置を介して入力でき、オペレータによる対応するメモリモジュールの交換によって変更できる。上記操作を装置の運転中も実施できれば好ましい。
以下さらに図面に基づいて実施形態を詳細に説明する。
【００３６】
図１に、本発明に係る方法を実施するための装置の好ましい実施形態の略図を示した。この実施形態の場合、工具１は回動アーム２の自由端２．１に設けてある。回動アーム２のアーム部分３は、駆動ユニット４を介して相互に回転されるか、相互に走行できるように構成されている。この場合、第１アーム部分３．１と第２アーム部分３．２は、第１駆動ユニット４．１によって第１回転軸線５．１のまわりで相互に回転される。第２アーム部分３．２と第３アーム部分３．３は、第２駆動ユニット４．２によって第２回転軸線５．２のまわりで相互に回転される。第３アーム部分３．３と第４アーム部分３．４は、第３駆動ユニット４．３によって第３回転軸線５．３のまわりで相互に回転される。第４アーム部分３．４と第５アーム部分３．５は、第４駆動ユニット４．４によって第４回転軸線５．４のまわりで相互に回転される。第５アーム部分３．５と第６アーム部分３．６は、第５駆動ユニット４．５によって第５軸線５．５に沿って相互に走行され、同じく、第６アーム部分３，６は、底部に固定の第７アーム部分３．７へ第６駆動ユニット４，６によって第６軸線５．６に沿って走行できるように取り付けられている。駆動ユニット４．１〜４．６は、制御装置６に接続され、アーム部分３．１〜３．６の相互回転または相互走行のための制御パルスをこの制御装置６から得ている。
【００３７】
駆動ユニット４．１〜４．６は、それぞれ、当該アーム部分の回転角度または走行位置を検知して制御ユニット６に伝送する増分位置検知器（図１には示してない）を備えている。各アーム部分の回転角度または走行位置に関する上記情報は、駆動ユニットの調節時、回転時または走行時に当該アーム部分の目標位置の到達を検知するために使用される。図示の実施形態の場合、駆動ユニットとしてステッピングモータを使用する。使用したモータのステッピング量または使用した位置検知器の増分は、それぞれ、アーム部分の間の所定の回転増分または走行増分を伴って現れる。この場合、双方の増分のうち大きい方の増分から、各走行点において、工具の運動範囲の最高分解度が得られる。
【００３８】
更に、工具１の当該の位置および姿勢を検知する第１測定装置７と、工具１に加えられる作動力Ｆを検知する第２測定装置８と、所定の運動範囲の工具１の第１走行点に対するアーム部分３．１〜３．７の回転角度および走行位置に関する第１情報を記憶した第１メモリ９とが設けてある。双方の測定装置７，８および第１メモリ９は、制御装置６に接続されている。
【００３９】
図示の実施形態の場合、測定装置７は、信号処理装置７．１と、レーザダイオード１０．１〜１０．５からなり信号処理装置に接続された５つの高周波送信器とを含む。レーザダイオードは１ＭＨｚ〜１０ＧＨｚの範囲のそれぞれ異なる変調周波数で送信し、それぞれ相互に離して空間的に移動しないように配置されている。更に、測定装置７は、レーザダイオード１０．１〜１０．５の位相を検知するよう構成され、工具１に設置された光電受信器１１を含む。第１信号処理装置７．１は、受信器１１によって検知された各レーザダイオード１０．１〜１０．５の異なる位相およびレーザダイオード１０．１〜１０．５の空間的な既知の位置から、受信器１１の位置を決定し、工具１の位置を正確に決定する。
【００４０】
もちろん、他の構成にもとづき、異なる態様で工具位置を決定できる。即ち、例えば、駆動ユニットの位置検知器の情報を使用し、その情報およびアーム部分および工具の既知のジォメトリから工具位置を決定できる。更に、例えば、スペースがない場合などには、受信器を工具ではなく、例えば、第２アーム部分に設置する。その場合、受信器の位置と、第１，第２駆動ユニットの位置検知器の情報と、そのアーム部分および工具の既知のジォメトリとから工具の位置および姿勢を計算できる。
【００４１】
図示の実施形態の場合、第２測定装置８は、第２信号処理装置８．１と測定ユニット１２とを含む。測定ユニット１２は、第２信号処理装置に接続され、工具１の連結箇所で第１アーム部分３．１に設置され、それぞれ３つの直交軸の方向へ工具１に作用する力およびモーメントを測定する。この第２信号処理装置８．１は、測定ユニット１２の測定値と、第１信号処理装置７．１において計算された工具の姿勢および位置と、上記位置で測定されたアーム部分３．１〜３．７の回転角度または走行位置とから、作動力Ｆの量および方向を計算する。このため、第２信号処理装置８．１は、第１信号処理装置７．１と第１メモリ９に接続されている。
【００４２】
もちろん、他の構成にもとづき、異なる態様で工具位置を決定できる。即ち、例えば、アーム部分の連結箇所に、それぞれ、力検知器および／またはトルク検知器を設け、その検知器の測定値と、アーム部分および工具の既知のジォメトリと、アーム部分および工具の姿勢とから、公知の態様で、作動力を決定できる。
更に、制御装置６に接続され、第１メモリの内容または制御パラメータを変更するための入力ユニット１３が設けてある。
制御装置６、第１、第２信号処理装置７．１、８．１、第１メモリ９および入力ユニット１３は、対応する入力装置（例えば、キーボード、マウス、その他）を有し、信号処理および制御を対応するソフトウエアによって実施する公知のコンピュータで形成できる。
【００４３】
図２に、図１の実施形態の回路の構成ブロック図を示した。この場合、制御装置６は、第１測定装置７と第２測定装置８と第１メモリ９と駆動ユニット４とに接続された処理ユニット１４を含む。
第１メモリ９は、所定の運動範囲内で工具１が走行できる各点について、回動アーム２の各アーム部分３の間の回転角度または走行位置に関する第１情報を記憶した第１部分範囲９．１を含む。更に、第１メモリ９は、工具１の所定の運動範囲の第１副範囲内の走行点に関する情報を保持した第２部分範囲９．２を含む。従って、第２情報は、第１情報の部分量をなす。
【００４４】
第１副範囲によって、工具１の所定の運動範囲に目標運動範囲を決定する。所定の運動範囲からのずれは工具の運動の公差範囲とする。図示の実施形態の場合、所定の運動範囲は、工具１を走行させる空間的自由形状面であり、他方、第１副範囲は、所定の運動範囲の自由形状面の両側で自由形状面に対して一定の間隔を置いて広がる境界を有する運動空間である。
【００４５】
第１メモリ９は、更に、所定の運動範囲内で工具１が走行できる各点について、回動アーム２の各アーム部分３の間の回転角度または走行位置に関する第３情報を記憶した第３部分範囲９．３を含む。従って、第１情報は、第３情報の部分量をなす。
この場合、装置の始動前に、入力ユニット１３を使用して対応する入力を行うことによって、第１メモリの部分範囲９．１〜９．３の内容を決定する。この場合、もちろん、アーム部分の所定の回転角度または走行位置において、実際に、対応する点に工具１を走行させることを確認するため、まず、系の校正を行う。更に、他の実施形態にもとづいて、異なる運動範囲を定めることができ、装置のオペレータが装置運転中に選択できる複数の第１，第２，第３部分範囲を設けることもできる。
【００４６】
第１部分範囲９．１は、第１切換スイッチ１５の第１入力１５．１に接続され、他方、第３部分範囲９．３は、第１切換スイッチ１５の第２入力１５．２に接続されている。第１切換スイッチ１５の出力１５．３は、処理ユニット１４に接続されている。
装置の運転中、処理ユニット１４は駆動ユニット４に制御パルスを送信する。この場合、その制御パルスは、第１測定装置７によって検知された工具１の位置と、第２測定装置８によって検知された作動力Ｆと、さらに、第１メモリ９の双方の部分範囲のどの部分範囲が第１切換スイッチ１５を介して処理ユニット１４に接続されたかに応じて第１部分範囲９．１の内容または第３部分範囲９．３の内容とに依存する。この場合、処理ユニット１４は、その処理ユニット１４に接続されたプログラムメモリ１６にファイルされたプログラムにアクセスして、処理ユニット１４に接続された部分範囲９．１または９．３における、第１測定装置７によって検知された工具の実位置に隣接し、検知された実位置から出発し第２測定装置８によって検知された作動力Ｆの方向に対する偏差が最小である位置ベクトルを有するような点、すなわち第１点を求める。次いで、処理ユニット１４は、求めた上記点に対応する制御パルスを駆動ユニット４に送信する。かくして、アーム部分は、駆動ユニット４によって、上記点に対応する角度位置に回転されるか、対応する走行位置に走行される。かくして、新たな進行が始まる。
【００４７】
図２に示した如く、第１メモリ９の第１部分範囲９．１は、処理ユニット１４に接続されており、かくして、工具１は、第１部分範囲９．１の基準に対応して所定の運動範囲内にある点のみで走行する。
工具１の正確で確実な位置決めを保証するため、作動力について、工具１の走行を開始するため作動力が越えなければならない第１閾値を定める。更に、作動力の第２閾値を定める。この場合、第２閾値を下回ると工具１の走行が停止される。
【００４８】
このため、制御装置は、処理ユニットの制御入力１４．１に接続された第１比較ユニット１７と、上記比較ユニットに接続された第２メモリ１８と、第１比較ユニット１７に接続された第３メモリ１９とを含む。第１比較ユニット１７は第２測定装置８の出力にも接続されている。第２メモリは、作動力の大きさに関して第１閾値に対応する第１閾値情報を含む。第２測定装置８によって検知された作動力が、上記第１閾値を越えると、第１比較ユニット１７の出力１７．１および第１処理ユニット１４の制御入力１４．１に、処理ユニット１４による制御信号が形成され、駆動ユニット４の作動が開始される第１状態が現れる。一方、第３メモリ１９は、作動力の大きさに関して第２閾値に対応する第２閾値情報を含む。上記第２閾値を下回ると、第１比較ユニット１７の出力１７．１および第１処理ユニット１４の制御入力１４．１には、処理ユニット１４による制御信号の形成および駆動ユニット４の作動が終了する第２状態が現れる。
【００４９】
オペレータは、装置の運転中も、入力装置１３によって、第１，第２閾値情報を入力できる。この場合、第１閾値は、第２閾値よりも大きい。しかしながら、他の実施形態にもとづき、もちろん、第１閾値は、第２閾値に等しくてよく、従って、この場合、これらの閾値について１つのメモリを設けるだけでよい。
【００５０】
図示の実施形態の場合、各駆動ユニット４は、工具１の走行終了後に回動アーム２を当該位置に固定するのに十分な自己ロック性を有していない。そのため、上述の装置の場合、作動力の第２閾値を下回った際に処理ユニット１４によって制御されてアーム部分を相互に固定するブレーキ２０（図１には示してない）を設けてある。作動力の第１閾値を再び越えると、上記ブレーキ２０は、処理ユニット１４によって制御されて解放される。
【００５１】
更に、図示の装置の場合、第１測定装置７によって検知された工具１の位置が第１メモリ９の第２部分範囲９．２にファイルされた運動範囲の第２副範囲内にある場合には、装置のオペレータに、信号装置２１から第１光学信号および第１音響信号のいずれかまたは双方が与えられる。このため、第１測定装置７および第１メモリ９の第２部分範囲９．２に接続され、信号装置２１に出力２２．１を接続した第２比較ユニット２２が設けてある。
図示の装置の場合、更に、第１メモリ９の第３部分範囲９．３を切換スイッチ１５を介して処理ユニット１４に接続することによって、第１部分範囲９．１の内容によって定められた運動範囲において、第３閾値を越える作動力を加えて強制案内を停止できる。このため、制御装置は、作動力の大きさに関して第３閾値に対応する第３閾値情報を含む第４メモリ２３を含む。更に、第２測定装置８および第４メモリ２３に接続され、第１切換スイッチ１５の第１切換入力１５．４に出力２４．１を接続した第３比較ユニット２４が設けてある。第２測定装置８によって検知された作動力が第３閾値を越えると、第３比較ユニット２４の出力２４．１および第１切換スイッチ１５の第１切換入力１５．４には、第１切換スイッチ１５を介して第１メモリ９の第３部分範囲９．３を処理ユニット１４に接続させる切換パルスが印加され、かくして、処理ユニットは、駆動ユニットの制御のために第３部分範囲にファイルされた第３情報を使用し、従って、第１部分範囲９．１に定められた運動範囲外の点にも走行できる。
【００５２】
もちろん、装置の運転中も、オペレータは、入力装置１３を介して第４メモリ２３の内容を入力または変更できる。
この場合も、所定の運動範囲内にいるか、所定の運動範囲外にいるかに関する情報をオペレータに与える光学的および／または音響的表示装置が設けてある。このため、第１測定装置７および第１メモリ９の第１部分範囲９．１に接続され、信号装置２１に出力を接続した第４比較ユニット２５が制御装置に設けてある。
更に、対応する作動力を加えることによって所定の運動範囲から離し、次いで、対応して小さい作動力で新たに走行させた場合、所定の運動範囲に入ると、所定の運動範囲における強制案内が再開される。このため、第１測定装置７および第１メモリの第１部分範囲９．１に接続された第５比較ユニット２６および第１切換スイッチ１５の第２切換入力１５．５に出力２７．３を接続したＡＮＤ回路２７が設けてある。ＡＮＤ回路２７は、第５比較ユニット２６の出力２６．１に接続された第１入力２７．１と、第３比較ユニット２４の出力２４．１に接続された第２否定入力２７．２とを有する。作動力が第３閾値情報の閾値以下にあり、同時に、位置所定の運動範囲内にあり第１測定装置７によって検知された工具１の位置に走行した場合、ＡＮＤ回路２７の出力２７．３および第１切換スイッチ１５の第２切換入力１５．５に、第１切換スイッチ１５を介して第１部分範囲９．１を処理ユニット１４に接続させる切換パルスが印加される。かくして、処理ユニット１４は、駆動ユニット４の制御のため第１部分範囲９．１にファイルされた第１情報にアクセスし、従って、所定の運動範囲において強制案内が再開される。
本発明は、その構成に関して、上述の好ましい実施形態に制限されるものではない。基本的に異なる構成においても提示の解決法を使用できる多数の変更例が可能である。
【図面の簡単な説明】
【図１】  本発明に係る装置の好ましい実施形態の略図である。
【図２】  図１の実施形態の方式構成図である。
【符号の説明】
１  工具、２  回転アーム、３  回転アームの部分、４  駆動ユニット、５回転軸、６  制御装置、７  第１測定装置、８  第２測定装置、９  第１メモリ、１０  レーザダイオード、１１  受光装置、１２  測定ユニット。
【図１】
0004101965.tif 000002
【図２】
0004101965.tif 000003