(57)【要約】【課題】アーム及びツールを含む集合体を移動させる、ロボットを制御するための方法を提供すること。【解決手段】この方法は、ロボットから、１つ以上の時間に、ロボットのロボット座標系（ＲＣＳ）に対するアームのアームポーズを示すアーム追跡信号を受信することと、アーム追跡信号から、それらの時間における、ＲＣＳに対する、集合体の少なくとも１つの部分のそれぞれのＲＣＳポーズを導出することと、追跡システムから、追跡システムの追跡システム座標系（ＴＣＳ）に対する、追跡システムに属し、集合体に連結されている少なくとも１つのセンサのセンサポーズを示すセンサ追跡信号を受信することと、センサ追跡信号から、それらの時間における、ＴＣＳに対する、集合体の部分のそれぞれのＴＣＳポーズを導出することと、ＲＣＳポーズ及びＴＣＳポーズに基づいて、ＲＣＳ及びＴＣＳを位置合わせすることと、位置合わせに基づいて、ロボットを制御することと、を含む。【選択図】図１
2020089731.tif 000002
【特許請求の範囲】
【請求項１】
外科用ロボットが、前記ロボットのアームと、前記アームによって保持されるツールと、を含む集合体を移動させる間に、前記ロボットを制御するためのシステムであって、前記システムは、
通信インターフェースと、
プロセッサであって、
１つ以上の時間に、前記ロボットのロボット座標系（ＲＣＳ）に対する前記アームのアームポーズを示すアーム追跡信号を、前記通信インターフェースを介して前記ロボットから受信し、
前記アーム追跡信号から、前記１つ以上の時間における、前記ＲＣＳに対する、前記集合体の少なくとも１つの特定の部分のそれぞれのＲＣＳポーズを導出し、
追跡システムから、前記追跡システムの追跡システム座標系（ＴＣＳ）に対する、前記追跡システムに属し、前記集合体に連結されている少なくとも１つのセンサのセンサポーズを示す、センサ追跡信号を受信し、
前記センサ追跡信号から、前記１つ以上の時間における、前記ＴＣＳに対する、前記集合体の前記特定の部分のそれぞれのＴＣＳポーズを導出し、
前記ＲＣＳポーズ及び前記ＴＣＳポーズに基づいて、前記ＲＣＳ及び前記ＴＣＳを互いに位置合わせし、かつ
前記位置合わせに基づいて、前記ロボットを制御するように構成されている、プロセッサと、を備える、システム。
【請求項２】
前記センサがコイルを含み、前記追跡システムは、前記コイル内に前記センサ追跡信号を誘発する磁場を発生させる複数の磁場発生器を含む、請求項１に記載のシステム。
【請求項３】
前記センサが前記ツールに連結されている、請求項１に記載のシステム。
【請求項４】
前記センサが前記アームに連結されている、請求項１に記載のシステム。
【請求項５】
前記時間が第１の時間であり、前記ＲＣＳポーズが第１の時間のＲＣＳポーズであり、前記ＴＣＳポーズが第１の時間のＴＣＳポーズであり、前記プロセッサは、
第２の時間に、前記アーム追跡信号を受信し、
前記アーム追跡信号から、前記第２の時間における、前記ＲＣＳに対する、前記集合体の前記特定の部分の第２の時間のＲＣＳポーズを導出し、
前記センサ追跡信号から、前記第２の時間における、前記ＴＣＳに対する、前記集合体の前記特定の部分の第２の時間のＴＣＳポーズを導出し、
前記位置合わせに基づいて、前記第２の時間のＴＣＳポーズを前記ＲＣＳに変換することによって、変換されたポーズを計算し、
前記変換されたポーズと前記第２の時間のＲＣＳポーズとの間の距離を計算し、かつ、
前記距離が既定の閾値を超えていることに応答して、前記第１の時間のＲＣＳポーズを使用せず、また前記第１の時間のＴＣＳポーズを使用せず、前記第２の時間のＲＣＳポーズ及び前記第２の時間のＴＣＳポーズを使用して、前記ＲＣＳ及び前記ＴＣＳを互いに再位置合わせするように更に構成されている、請求項１に記載のシステム。
【請求項６】
前記時間が第１の時間であり、前記ＲＣＳポーズが第１の時間のＲＣＳポーズであり、前記ＴＣＳポーズが第１の時間のＴＣＳポーズであり、前記プロセッサは、
第２の時間に、前記アーム追跡信号を受信し、
前記アーム追跡信号から、前記第２の時間における、前記ＲＣＳに対する、前記集合体の前記特定の部分の第２の時間のＲＣＳポーズを導出し、
前記センサ追跡信号から、前記第２の時間における、前記ＴＣＳに対する、前記集合体の前記特定の部分の第２の時間のＴＣＳポーズを導出し、
前記位置合わせに基づいて、前記第２の時間のＴＣＳポーズを前記ＲＣＳに変換することによって、変換されたポーズを計算し、
前記変換されたポーズと前記第２の時間のＲＣＳポーズとの間の距離を計算し、かつ、
前記距離が既定の閾値を超えていないことに応答して、前記第２の時間のＲＣＳポーズ、前記第２の時間のＴＣＳポーズ、前記第１の時間のＲＣＳポーズ、及び前記第１の時間のＴＣＳポーズを使用して、前記ＲＣＳ及び前記ＴＣＳを互いに再位置合わせするように更に構成されている、請求項１に記載のシステム。
【請求項７】
前記時間が第１の時間であり、前記ＲＣＳポーズが第１の時間のＲＣＳポーズであり、前記ＴＣＳポーズが第１の時間のＴＣＳポーズであり、前記プロセッサは、
第２の時間に、前記アーム追跡信号を受信し、
前記アーム追跡信号から、前記第２の時間における、前記ＲＣＳに対する、前記集合体の前記特定の部分の第２の時間のＲＣＳポーズを導出し、
前記センサ追跡信号から、前記第２の時間における、前記ＴＣＳに対する、前記集合体の前記特定の部分の第２の時間のＴＣＳポーズを導出し、
前記位置合わせに基づいて、前記第２の時間のＲＣＳポーズを前記ＴＣＳに変換することによって、変換されたポーズを計算し、
前記変換されたポーズと前記第２の時間のＴＣＳポーズとの間の距離を計算し、かつ、
前記距離が既定の閾値を超えていることに応答して、前記第１の時間のＲＣＳポーズを使用せず、また前記第１の時間のＴＣＳポーズを使用せず、前記第２の時間のＲＣＳポーズ及び前記第２の時間のＴＣＳポーズを使用して、前記ＲＣＳ及び前記ＴＣＳを互いに再位置合わせするように更に構成されている、請求項１に記載のシステム。
【請求項８】
前記時間が第１の時間であり、前記ＲＣＳポーズが第１の時間のＲＣＳポーズであり、前記ＴＣＳポーズが第１の時間のＴＣＳポーズであり、前記プロセッサは、
第２の時間に、前記アーム追跡信号を受信し、
前記アーム追跡信号から、前記第２の時間における、前記ＲＣＳに対する、前記集合体の前記特定の部分の第２の時間のＲＣＳポーズを導出し、
前記センサ追跡信号から、前記第２の時間における、前記ＴＣＳに対する、前記集合体の前記特定の部分の第２の時間のＴＣＳポーズを導出し、
前記位置合わせに基づいて、前記第２の時間のＲＣＳポーズを前記ＴＣＳに変換することによって、変換されたポーズを計算し、
前記変換されたポーズと前記第２の時間のＴＣＳポーズとの間の距離を計算し、かつ、
前記距離が既定の閾値を超えていないことに応答して、前記第２の時間のＲＣＳポーズ、前記第２の時間のＴＣＳポーズ、前記第１の時間のＲＣＳポーズ、及び前記第１の時間のＴＣＳポーズを使用して、前記ＲＣＳ及び前記ＴＣＳを互いに再位置合わせするように更に構成されている、請求項１に記載のシステム。
【請求項９】
前記プロセッサは、
前記ＴＣＳに対する標的アームポーズオフセットを計算すること、
前記位置合わせに基づいて、前記標的アームポーズオフセットを前記ＲＣＳに変換することによって、変換された標的アームポーズオフセットを計算すること、及び、
前記変換された標的アームポーズオフセットを前記ロボットに伝達することによって、前記ロボットに前記標的アームポーズオフセットの分だけ前記アームの前記アームポーズを変化させること、
によって、前記ロボットを制御するように構成されている、請求項１に記載のシステム。
【請求項１０】
前記ロボットが被験者上で動作しており、
前記追跡システムが、前記被験者に連結された少なくとも１つの被験者追跡センサを更に含み、
前記プロセッサが、
前記追跡システムから、前記ＴＣＳに対する前記被験者追跡センサの被験者追跡センサポーズを示す、被験者追跡信号を受信し、かつ
前記被験者追跡信号から、前記被験者の被験者ポーズの変化を導出するように更に構成されており、
前記プロセッサが、前記被験者の前記被験者ポーズの前記変化に応答して、前記標的アームポーズオフセットを計算するように構成されている、請求項９に記載のシステム。
【請求項１１】
外科用ロボットが、前記ロボットのアームと、前記アームによって保持されるツールと、を含む集合体を移動させる間に、前記ロボットを制御するための方法であって、前記方法は、
１つ以上の時間に、前記ロボットのロボット座標系（ＲＣＳ）に対する前記アームのアームポーズを示すアーム追跡信号を、前記ロボットから受信することと、
前記アーム追跡信号から、前記１つ以上の時間における、前記ＲＣＳに対する、前記集合体の少なくとも１つの特定の部分のそれぞれのＲＣＳポーズを導出することと、
追跡システムから、前記追跡システムの追跡システム座標系（ＴＣＳ）に対する、前記追跡システムに属し、前記集合体に連結されている少なくとも１つのセンサのセンサポーズを示す、センサ追跡信号を受信することと、
前記センサ追跡信号から、前記１つ以上の時間における、前記ＴＣＳに対する、前記集合体の前記特定の部分のそれぞれのＴＣＳポーズを導出することと、
前記ＲＣＳポーズ及び前記ＴＣＳポーズに基づいて、前記ＲＣＳ及び前記ＴＣＳを互いに位置合わせすることと、
前記位置合わせに基づいて、前記ロボットを制御することと、を含む、方法。
【請求項１２】
前記センサがコイルを含み、前記追跡システムが、前記コイル内に前記センサ追跡信号を誘発する磁場を発生させる複数の磁場発生器を含む、請求項１１に記載の方法。
【請求項１３】
前記センサが、前記ツールに連結されている、請求項１１に記載の方法。
【請求項１４】
前記センサが、前記アームに連結されている、請求項１１に記載の方法。
【請求項１５】
前記時間が第１の時間であり、前記ＲＣＳポーズが第１の時間のＲＣＳポーズであり、前記ＴＣＳポーズが第１の時間のＴＣＳポーズであり、前記方法は、
第２の時間に、前記アーム追跡信号を受信することと、
前記アーム追跡信号から、前記第２の時間における、前記ＲＣＳに対する、前記集合体の前記特定の部分の第２の時間のＲＣＳポーズを導出することと、
前記センサ追跡信号から、前記第２の時間における、前記ＴＣＳに対する、前記集合体の前記特定の部分の第２の時間のＴＣＳポーズを導出することと、
前記位置合わせに基づいて、前記第２の時間のＴＣＳポーズを前記ＲＣＳに変換することによって、変換されたポーズを計算することと、
前記変換されたポーズと前記第２の時間のＲＣＳポーズとの間の距離を計算することと、
前記距離が既定の閾値を超えていることに応答して、前記第１の時間のＲＣＳポーズを使用せず、また前記第１の時間のＴＣＳポーズを使用せず、前記第２の時間のＲＣＳポーズ及び前記第２の時間のＴＣＳポーズを使用して、前記ＲＣＳ及び前記ＴＣＳを互いに再位置合わせすることと、を更に含む、請求項１１に記載の方法。
【請求項１６】
前記時間が第１の時間であり、前記ＲＣＳポーズが第１の時間のＲＣＳポーズであり、前記ＴＣＳポーズが第１の時間のＴＣＳポーズであり、前記方法は、
第２の時間に、前記アーム追跡信号を受信することと、
前記アーム追跡信号から、前記第２の時間における、前記ＲＣＳに対する、前記集合体の前記特定の部分の第２の時間のＲＣＳポーズを導出することと、
前記センサ追跡信号から、前記第２の時間における、前記ＴＣＳに対する、前記集合体の前記特定の部分の第２の時間のＴＣＳポーズを導出することと、
前記位置合わせに基づいて、前記第２の時間のＴＣＳポーズを前記ＲＣＳに変換することによって、変換されたポーズを計算することと、
前記変換されたポーズと前記第２の時間のＲＣＳポーズとの間の距離を計算することと、
前記距離が既定の閾値を超えていないことに応答して、前記第２の時間のＲＣＳポーズ、前記第２の時間のＴＣＳポーズ、前記第１の時間のＲＣＳポーズ、及び前記第１の時間のＴＣＳポーズを使用して、前記ＲＣＳ及び前記ＴＣＳを互いに再位置合わせすることと、を更に含む、請求項１１に記載の方法。
【請求項１７】
前記時間が第１の時間であり、前記ＲＣＳポーズが第１の時間のＲＣＳポーズであり、前記ＴＣＳポーズが第１の時間のＴＣＳポーズであり、前記方法は、
第２の時間に、前記アーム追跡信号を受信することと、
前記アーム追跡信号から、前記第２の時間における、前記ＲＣＳに対する、前記集合体の前記特定の部分の第２の時間のＲＣＳポーズを導出することと、
前記センサ追跡信号から、前記第２の時間における、前記ＴＣＳに対する、前記集合体の前記特定の部分の第２の時間のＴＣＳポーズを導出することと、
前記位置合わせに基づいて、前記第２の時間のＲＣＳポーズを前記ＴＣＳに変換することによって、変換されたポーズを計算することと、
前記変換されたポーズと前記第２の時間のＴＣＳポーズとの間の距離を計算することと、
前記距離が既定の閾値を超えていることに応答して、前記第１の時間のＲＣＳポーズを使用せず、また前記第１の時間のＴＣＳポーズを使用せず、前記第２の時間のＲＣＳポーズ及び前記第２の時間のＴＣＳポーズを使用して、前記ＲＣＳ及び前記ＴＣＳを互いに再位置合わせすることと、を更に含む、請求項１１に記載の方法。
【請求項１８】
前記時間が第１の時間であり、前記ＲＣＳポーズが第１の時間のＲＣＳポーズであり、前記ＴＣＳポーズが第１の時間のＴＣＳポーズであり、前記方法は、
第２の時間に、前記アーム追跡信号を受信することと、
前記アーム追跡信号から、前記第２の時間における、前記ＲＣＳに対する、前記集合体の前記特定の部分の第２の時間のＲＣＳポーズを導出することと、
前記センサ追跡信号から、前記第２の時間における、前記ＴＣＳに対する、前記集合体の前記特定の部分の第２の時間のＴＣＳポーズを導出することと、
前記位置合わせに基づいて、前記第２の時間のＲＣＳポーズを前記ＴＣＳに変換することによって、変換されたポーズを計算することと、
前記変換されたポーズと前記第２の時間のＴＣＳポーズとの間の距離を計算することと、
前記距離が既定の閾値を超えていないことに応答して、前記第２の時間のＲＣＳポーズ、前記第２の時間のＴＣＳポーズ、前記第１の時間のＲＣＳポーズ、及び前記第１の時間のＴＣＳポーズを使用して、前記ＲＣＳ及び前記ＴＣＳを互いに再位置合わせすることと、を更に含む、請求項１１に記載の方法。
【請求項１９】
前記ロボットを制御することは、
前記ＴＣＳに対する標的アームポーズオフセットを計算することと、
前記位置合わせに基づいて、前記標的アームポーズオフセットを前記ＲＣＳに変換することによって、変換された標的アームポーズオフセットを計算することと、
前記変換された標的アームポーズオフセットを前記ロボットに伝達することによって、前記ロボットに前記標的アームポーズオフセットの分だけ前記アームの前記アームポーズを変化させることと、を含む、請求項１１に記載の方法。
【請求項２０】
前記ロボットが被験者上で動作しており、
前記追跡システムが、前記被験者に連結された少なくとも１つの被験者追跡センサを更に含み、
前記方法は、
前記追跡システムから、前記ＴＣＳに対する前記被験者追跡センサの被験者追跡センサポーズを示す、被験者追跡信号を受信することと、
前記被験者追跡信号から、前記被験者の被験者ポーズの変化を導出することと、を更に含み、
前記標的アームポーズオフセットを計算することは、前記被験者の前記被験者ポーズの前記変化に応答して前記アームポーズオフセットを計算することを含む、請求項１９に記載の方法。
【発明の詳細な説明】
【技術分野】
【０００１】
本発明は、内視鏡手術及び他の種類の診断手術を含む、ロボット手術の分野に関する。
【背景技術】
【０００２】
米国特許出願公開第２０１４／０３３０１１４号は、身体内の追跡要素を追跡するためのシステムについて記載している。このシステムは、第１の追跡センサに対する公称位置に対して身体内の追跡要素の現在の位置を検出するための第１の追跡センサを含む第１の追跡システムと、第２の追跡センサに対する第１の追跡システムの第１の追跡センサの位置を決定するための第２の追跡センサを含む第２の追跡システムと、制御ユニットと、を含む。第１の追跡センサは移動可能であり、制御ユニットは、第１の追跡センサを基準にして、公称位置に対する追跡要素の現在位置の偏差を示す補正信号を送達するように構成される。更に、それぞれの追跡方法が提供される。
【０００３】
米国特許出願公開第２０１５／０１１９６３７号は、外科医にロボット駆動式内視鏡装置を所望の解剖学的位置に駆動する能力を提供する、管腔内ロボットシステムについて記載している。デジタルカメラが内視鏡装置に取り付けられる。
【０００４】
米国特許出願公開第２０１７／０２５８５３５号は、物体の３次元位置を検出するための装置、システム、及び方法、並びにそれらを伴う外科用オートメーションについて記載している。外科用ロボットシステムは、ロボット基部と、ロボット基部に連結されたロボットアームと、ロボットアームに連結されたエンドエフェクタと、を有するロボットを含み得る。エンドエフェクタ、外科用器具、患者、及び／又は追跡される他の物体は、能動的及び／又は受動的追跡マーカーを含む。実体写真測量赤外線カメラなどのカメラは、追跡マーカーを検出することができ、ロボットは、追跡マーカーから物体の３次元位置を決定する。
【０００５】
米国特許出願公開第２０１７／０２９０６３１号は、浮遊電磁場発生器システム及び方法について記載している。システムは、外科用ベッド部分を備える。システムはまた、外科用ベッド部分内に配設されたブレース構成要素を備える。加えて、システムは、ブレース構成要素に取り付けられた第１のアームを備える。第１のアームは、外科用ベッド部分に隣接して位置付けられる。加えて、第１のアームは、内部に埋め込まれた少なくとも１つの磁場発生器コイルを有する。システムはまた、ブレース構成要素に取り付けられた第２のアームを備える。第２のアームは、外科用ベッド部分に隣接して位置付けられる。加えて、第２のアームは、内部に埋め込まれた少なくとも１つの磁場発生器コイルを有する。第２のアームは、第１のアームに平行して位置付けられる。
【発明の概要】
【課題を解決するための手段】
【０００６】
本発明の一部の実施形態によれば、外科用ロボットがロボットのアームと、アームによって保持されるツールと、を含む集合体を移動させる間に、ロボットを制御するためのシステムが提供される。システムは、通信インターフェース及びプロセッサを含む。プロセッサは、１つ以上の時間に、ロボットのロボット座標系（ＲＣＳ）に対するアームのアームポーズを示すアーム追跡信号を、通信インターフェースを介してロボットから受信するように構成される。プロセッサは、アーム追跡信号から、１つ以上の時間における、ＲＣＳに対する、集合体の少なくとも１つの特定部分のそれぞれのＲＣＳポーズを導出するように更に構成される。プロセッサは、追跡システムから、追跡システムの追跡システム座標系（ＴＣＳ）に対する、追跡システムに属し、集合体に連結されている少なくとも１つのセンサのセンサポーズを示すセンサ追跡信号を受信するように更に構成される。プロセッサは、センサ追跡信号から、１つ以上の時間における、ＴＣＳに対する、集合体の特定の部分のそれぞれのＴＣＳポーズを導出するように更に構成される。プロセッサは、ＲＣＳポーズ及びＴＣＳポーズに基づいて、ＲＣＳ及びＴＣＳを互いに位置合わせし、位置合わせに基づいて、ロボットを制御するように更に構成される。
【０００７】
一部の実施形態では、センサはコイルを含み、追跡システムは、コイル内にセンサ追跡信号を誘発する磁場を発生させる複数の磁場発生器を含む。
【０００８】
一部の実施形態では、センサはツールに連結されている。
【０００９】
一部の実施形態では、センサはアームに連結されている。
【００１０】
一部の実施形態では、時間は第１の時間であり、ＲＣＳポーズは第１の時間のＲＣＳポーズであり、ＴＣＳポーズは第１の時間のＴＣＳポーズであり、プロセッサは、
第２の時間に、アーム追跡信号を受信し、
アーム追跡信号から、第２の時間における、ＲＣＳに対する、集合体の特定の部分の第２の時間のＲＣＳポーズを導出し、
センサ追跡信号から、第２の時間における、ＴＣＳに対する、集合体の特定の部分の第２の時間のＴＣＳポーズを導出し、
位置合わせに基づいて、第２の時間のＴＣＳポーズをＲＣＳに変換することによって、変換されたポーズを計算し、
変換されたポーズと第２の時間のＲＣＳポーズとの間の距離を計算し、かつ、
距離が既定の閾値を超えていることに応答して、第１の時間のＲＣＳポーズを使用せず、また第１の時間のＴＣＳポーズを使用せず、第２の時間のＲＣＳポーズ及び第２の時間のＴＣＳポーズを使用してＲＣＳ及びＴＣＳを互いに再位置合わせするように更に構成される。
【００１１】
一部の実施形態では、時間は第１の時間であり、ＲＣＳポーズは第１の時間のＲＣＳポーズであり、ＴＣＳポーズは第１の時間のＴＣＳポーズであり、プロセッサは、
第２の時間に、アーム追跡信号を受信し、
アーム追跡信号から、第２の時間における、ＲＣＳに対する、集合体の特定の部分の第２の時間のＲＣＳポーズを導出し、
センサ追跡信号から、第２の時間における、ＴＣＳに対する、集合体の特定の部分の第２の時間のＴＣＳポーズを導出し、
位置合わせに基づいて、第２の時間のＴＣＳポーズをＲＣＳに変換することによって、変換されたポーズを計算し、
変換されたポーズと第２の時間のＲＣＳポーズとの間の距離を計算し、かつ、
距離が既定の閾値を超えていないことに応答して、第２の時間のＲＣＳポーズ、第２の時間のＴＣＳポーズ、第１の時間のＲＣＳポーズ、及び第１の時間のＴＣＳポーズを使用してＲＣＳ及びＴＣＳを互いに再位置合わせするように更に構成される。
【００１２】
一部の実施形態では、時間は第１の時間であり、ＲＣＳポーズは第１の時間のＲＣＳポーズであり、ＴＣＳポーズは第１の時間のＴＣＳポーズであり、プロセッサは、
第２の時間に、アーム追跡信号を受信し、
アーム追跡信号から、第２の時間における、ＲＣＳに対する、集合体の特定の部分の第２の時間のＲＣＳポーズを導出し、
センサ追跡信号から、第２の時間における、ＴＣＳに対する、集合体の特定の部分の第２の時間のＴＣＳポーズを導出し、
位置合わせに基づいて、第２の時間のＲＣＳポーズをＴＣＳに変換することによって、変換されたポーズを計算し、
変換されたポーズと第２の時間のＴＣＳポーズとの間の距離を計算し、かつ、
距離が既定の閾値を超えていることに応答して、第１の時間のＲＣＳポーズを使用せず、また第１の時間のＴＣＳポーズを使用せず、第２の時間のＲＣＳポーズ及び第２の時間のＴＣＳポーズを使用してＲＣＳ及びＴＣＳを互いに再位置合わせするように更に構成される。
【００１３】
一部の実施形態では、時間は第１の時間であり、ＲＣＳポーズは第１の時間のＲＣＳポーズであり、ＴＣＳポーズは第１の時間のＴＣＳポーズであり、プロセッサは、
第２の時間に、アーム追跡信号を受信し、
アーム追跡信号から、第２の時間における、ＲＣＳに対する、集合体の特定の部分の第２の時間のＲＣＳポーズを導出し、
センサ追跡信号から、第２の時間における、ＴＣＳに対する、集合体の特定の部分の第２の時間のＴＣＳポーズを導出し、
位置合わせに基づいて、第２の時間のＲＣＳポーズをＴＣＳに変換することによって、変換されたポーズを計算し、
変換されたポーズと第２の時間のＴＣＳポーズとの間の距離を計算し、かつ、
距離が既定の閾値を超えていないことに応答して、第２の時間のＲＣＳポーズ、第２の時間のＴＣＳポーズ、第１の時間のＲＣＳポーズ、及び第１の時間のＴＣＳポーズを使用してＲＣＳ及びＴＣＳを互いに再位置合わせするように更に構成される。
【００１４】
一部の実施形態では、プロセッサは、
ＴＣＳに対する標的アームポーズオフセットを計算することと、
位置合わせに基づいて、標的アームポーズオフセットをＲＣＳに変換することによって、変換された標的アームポーズオフセットを計算することと、
変換された標的アームポーズオフセットをロボットに伝達することによって、ロボットに標的アームポーズオフセットの分だけアームのアームポーズを変化させることと、によって、ロボットを制御するように構成される。
【００１５】
一部の実施形態では、
ロボットは、被験者上で動作しており、
追跡システムは、被験者に連結された少なくとも１つの被験者追跡センサを更に含み、
プロセッサは更に、
追跡システムから、ＴＣＳに対する被験者追跡センサの被験者追跡センサポーズを示す被験者追跡信号を受信し、かつ
被験者追跡信号から、被験者の被験者ポーズの変化を導出するように構成され、
プロセッサは、被験者の被験者ポーズの変化に応答して、標的アームポーズオフセットを計算するように構成される。
【００１６】
本発明の一部の実施形態によれば、外科用ロボットがロボットのアームと、アームによって保持されるツールと、を含む集合体を移動させる間に、ロボットを制御するための方法が更に提供される。この方法は、１つ以上の時間に、ロボットのロボット座標系（ＲＣＳ）に対するアームのアームポーズを示すアーム追跡信号を、ロボットから受信することを含む。この方法は、アーム追跡信号から、１つ以上の時間における、ＲＣＳに対する、集合体の少なくとも１つの特定の部分のそれぞれのＲＣＳポーズを導出することを更に含む。この方法は、追跡システムから、追跡システムの追跡システム座標系（ＴＣＳ）に対する、追跡システムに属し、集合体に連結されている少なくとも１つのセンサのセンサポーズを示す、センサ追跡信号を受信することを更に含む。この方法は、センサ追跡信号から、１つ以上の時間における、ＴＣＳに対する、集合体の特定の部分のそれぞれのＴＣＳポーズを導出することを更に含む。この方法は、ＲＣＳポーズ及びＴＣＳポーズに基づいて、ＲＣＳ及びＴＣＳを互いに位置合わせし、位置合わせに基づいてロボットを制御することを更に含む。
【００１７】
本発明は、その実施形態の以下の詳細な説明を図面と併せ読むことによって一層十分な理解がなされるであろう。
【図面の簡単な説明】
【００１８】
【図１】本発明の一部の実施形態による、被験者に対してロボット手術を実行するためのシステムの概略図である。
【図２】本発明の一部の実施形態による、２つの座標系を互いに位置合わせするための方法及びアルゴリズムのフローチャートである。
【図３】本発明の一部の実施形態による、外科用ロボットを制御するための方法及びアルゴリズムのフローチャートである。
【発明を実施するための形態】
【００１９】
用語集
特許請求の範囲を含む本出願の文脈において、物体の「ポーズ」は、（ｉ）物体の位置、及び（ｉｉ）物体の配向の組み合わせを指す。よって、例えば、３次元設定では、物体のポーズは、物体の位置を記述する位置ベクトル（ｘ、ｙ、ｚ）と、物体の配向を記述する配向ベクトル（ｘ’、ｙ’、ｚ’）と、を合わせたものによって記述され得る。（典型的には、配向ベクトルは、単位長さとなるように正規化される。）
【００２０】
概説
ロボット外科手術では、ロボットアームは外科用ツールを操作する。例えば、ロボット耳鼻咽喉内視鏡手術では、ロボットアームは、内視鏡を被験者の鼻腔又は副鼻腔内に挿入し、この腔内で内視鏡を操作し得る。
【００２１】
多くの場合、処置中、ツールのアイコンは、医師がツールの動きを追跡し得るように、被験者の術前スキャン上に重ね合わされる。医師は、アイコンを操作することによるか、ツールを手動で移動させることによるか、又は任意の他の好適な手法によって、ツールの標的ポーズを更に指定することができる。典型的には、ツールが標的ポーズを安全に達成することを確実にするために、追跡システムは、ツールのポーズを追跡し、追跡に応答してロボットへの命令を発行し、ツールが標的ポーズに向かって徐々に移動されるようにする。
【００２２】
いくつかの用途では、ツールのポーズの追跡を容易にするために、少なくとも１つの追跡センサがロボットのアームに及び／又はツールに連結される。例えば、内視鏡手術では、２つ又は３つのコイルが、内視鏡上の所定の位置で内視鏡に連結されてもよく、交流磁場は、異なるそれぞれの周波数で、被験者の付近にある複数の磁場発生器によって発生させられてもよい。コイル内に誘導された電圧の様々な周波数構成要素に基づいて、追跡システムは、コイルのそれぞれのポーズ、ひいてはツールのポーズを確認し得る。
【００２３】
課題は、上述のようにロボット手術を実行するとき、ロボットに送達される命令は、典型的には追跡システムの座標系とは異なるロボットの座標系に関して指定されなければならないことである。よって、典型的には、本明細書ではロボット座標系（ＲＣＳ）と称されるロボットの座標系を、本明細書では追跡座標系（ＴＣＳ）と称される追跡システムの座標系と位置合わせすることが必要である。換言すれば、ＴＣＳに対して指定されるように、任意のポーズをＲＣＳにマッピングする変換ＴＴＣＳ→ＲＣＳを見つけることが必要である。
【００２４】
２つの座標系を位置合わせするための１つの手法は、反復最近接ポイント（Iterative Closest Point（ＩＣＰ））アルゴリズムの使用を伴う。具体的には、追跡センサが様々な異なる位置に移動されると、センサの２つの座標のセット、一方はＲＣＳでの座標のセット、もう一方はＴＣＳでの座標のセットが記録され得る。続いて、座標のセットを使用して、ＩＣＰアルゴリズムを使用してＴＴＣＳ→ＲＣＳを見つけることができる。
【００２５】
しかしながら、本発明の実施形態は、ＩＣＰに勝るいくつかの利点をもたらす、改善された位置合わせ手法を利用する。具体的には、ロボットがツールを移動させると、プロセッサは、センサの座標だけでなく、センサの配向も確認する。よって、プロセッサは、センサのそれぞれのポーズについて、１対の対応するベクトル：（ｉ）ＴＣＳに対するセンサのポーズを記述する、ＰＴＣＳ＝（ｘ，ｙ，ｚ，ｘ’，ｙ’，ｚ’）ＴＣＳ、及び（ｉｉ）ＲＣＳに対するセンサのポーズを記述する、ＰＲＣＳ＝（ｘ，ｙ，ｚ，ｘ’，ｙ’，ｚ’）ＲＣＳを取得する。１つ以上のそのような対応するベクトルの対に基づいて、プロセッサは、２つの座標系間の変換を計算する。
【００２６】
有利には、センサのそれぞれのポーズは６つの変数を含み、位置合わせは６つの自由度のみを伴うため、単一のポーズでも、２つの座標系を位置合わせするのに十分である。更に、ＩＣＰに対して、反復アルゴリズム（最急降下法など）が変換を解決するために使用される場合であっても、必要とされる反復は少なくなり得る。よって、位置合わせは、比較的迅速に行われ得る。更に、ＩＣＰに対して、変換を解決する際に極小値に収束するリスクが少なくなる。
【００２７】
典型的には、対応するベクトルのそれぞれの対が取得されると、プロセッサは、ＴＴＣＳ→ＲＣＳをＰＴＣＳに適用し、それにより、変換されたベクトルＰＲＣＳ＊を生成する。続いて、プロセッサは、任意の好適な距離関数を使用して、ＰＲＣＳ＊とＰＲＣＳとの間の距離を計算する。ＰＲＣＳとＰＲＣＳ＊との間の距離が既定の閾値未満である場合、プロセッサは、対応するベクトルの対を、それまでに取得された対に追加する。次いで、全ての対を使用して、プロセッサは変換を計算する。例えば、プロセッサは、最急降下法などの最適化アルゴリズムを使用して、誤差関数
【００２８】
【数１】
2020089731.tif 000003
を最小化する変換ＴＴＣＳ→ＲＣＳを見つけることができる。式中、Ｄは、上述の距離関数である。
【００２９】
一方、距離が閾値よりも大きい場合、プロセッサは、ロボットの座標系が定義されているものに関して、ロボットアームの基部が移動されたと想定する。したがって、プロセッサは、予め取得されたベクトルの対を廃棄し、例えば、ＴＴＣＳ→ＲＣＳを分析的に解決することによって、現在の対を使用して変換を再初期化する。
【００３０】
典型的には、使用される距離関数は、残差平方和（ＳＳＥ）のタイプである。例えば、２つのポーズ（ｘｊ，ｙｊ，ｚｊ，ｘ’ｊ，ｙ’ｊ，ｚ’ｊ）及び（ｘｋ，ｙｋ，ｚｋ，ｘ’ｋ，ｙ’ｋ，ｚ’ｋ）間の距離は、好適な定数Ｃの場合、（ｘｊ−ｘｋ）２＋（ｙｊ−ｙｋ）２＋（ｚｊ−ｚｋ）２＋Ｃ（（ｘ’ｊ−ｘ’ｋ）２＋（ｙ’ｊ−ｙ’ｋ）２＋（ｚ’ｊ−ｚ’ｋ）２）に等しくなり得る。あるいは、配向角度α、β、及びγを使用して配向を指定すると、距離は、（ｘｊ−ｘｋ）２＋（ｙｊ−ｙｋ）２＋（ｚｊ−ｚｋ）２＋Ｃ（（αｊ−αｋ）２＋（βｊ−βｋ）２＋（γｊ−γｋ）２）に等しくなり得る。
【００３１】
処置の直前に、術前スキャンの座標系と追跡システムの座標系との間の追加の位置合わせが実行される。例えば、前述の磁場の存在下で、医師は、コイルを含むシャフトを使用して、被験者の顔面の指定された部分に触れることができる。次いで、コイルからの信号から確認されるように、これらの位置におけるシャフトの先端の座標は、術前スキャンの対応する座標と（例えば、ＩＣＰを使用して）位置合わせされ得る。換言すれば、プロセッサは、被験者座標系（ＳＣＳ）における任意のポーズをＴＣＳにマッピングする、変換ＴＳＣＳ→ＴＣＳを、逆変換ＴＴＣＳ→ＳＣＳと共に計算し得る。よって、処置中、ＳＣＳで指定された標的ポーズは、ＴＳＣＳ→ＴＣＳを指定された標的に適用することによって、ＴＣＳに変換され得る。反対に、ツールの現在のポーズは、ＴＴＣＳ→ＳＣＳの適用によって、術前スキャン上に表示され得る。
【００３２】
典型的には、少なくとも１つの他の追跡センサが被験者に（例えば、被験者の額に）取り付けられる。処置中、ＴＣＳに対する、このセンサの現在のポーズは、プロセッサによって継続的に計算される。センサの現在のポーズとセンサの直近のポーズとの間の差が既定の閾値を超える場合（被験者が移動したことを示す）、プロセッサはＴＳＣＳ→ＴＣＳを再計算する。代替として又は追加として、被験者の動きに応答して、プロセッサは、ＴＣＳに関連するツールの標的ポーズを再計算し得る。
【００３３】
システムの説明
はじめに図１を参照するが、図１は、本発明の一部の実施形態による、被験者２２に対するロボット手術を実行するためのシステム２０の概略図である。
【００３４】
システム２０は、アーム２６及びコントローラ４４を含む、外科用ロボット２４を含む。典型的にアーム２６に取り付けられたロボット２４の基部２５内に位置するコントローラ４４は、典型的に、制御（ＣＴＲＬ）インターフェース４６を介して１つ以上のモータ４８を動作させることによってアーム２６を制御するように構成される。（制御インターフェース４６は、例えば、１つ以上のドライバ、エンコーダ、及び／又は他の電子的構成要素を含んでもよい。）一部の実施形態では、基部２５は、接続アーム２７を介して、被験者２２が寄りかかる外科用椅子５２に、又は被検者が横たわるベッドに接続される。
【００３５】
アーム２６は、互いに対して（例えば、相互連結継手で旋回することによって）、かつ基部２５に対して移動するように構成された１つ以上の相互連結セグメントを含む。アーム２６の最遠位セグメントは、吸引ツール又は内視鏡などのツール２８を保持するように構成されている。したがって、アーム２６及びツール２８を含む集合体２９を移動させることによって、コントローラ４４は、被験者２２の身体内で任意の好適なポーズにツールを位置付け得る。例えば、コントローラ４４は、内視鏡が腔の画像を取得し得るように、患者の鼻腔又は副鼻腔内に内視鏡の遠位端を位置付け得る。
【００３６】
システム２０は、典型的にコンソール３６に位置するプロセッサ４０を更に備える。コントローラ４４は、プロセッサ４０から受信した命令に応答してアーム２６を操作する。加えて、アーム２６がツール２８を移動させる間、コントローラ４４は、アームの（特に、アームの最遠位セグメント上に指定されたポイントの）ポーズを示すアーム追跡信号５８をプロセッサ４０に伝達する。例えば、コントローラ４４は、アームのポーズを周期的に、かつ／又はプロセッサ４０からのクエリに応答して報告し得る。アーム追跡信号５８は、本明細書では、基部２５のポーズに対して定義される、「ＲＣＳ」という表記によって示されるロボットの座標系に対するアームのポーズを示す。
【００３７】
コンソール３６からロボット２４に延びるケーブル５４は、ロボットに電力を運ぶ電気配線を含む。コントローラ４４は、任意の好適な回路及び／又は他のハードウェアを含み得る通信（ＣＯＭＭ）インターフェース５０を介して、プロセッサ４０との通信を交換する。一部の実施形態では、通信インターフェース５０は、有線通信インターフェースであり、このような実施形態では、ケーブル５４は、コントローラとプロセッサとの間で通信信号を運ぶ配線を含んでもよい。他の実施形態では、通信インターフェースは、無線通信インターフェースである。
【００３８】
ケーブル５４は、第１の電気的インターフェース３８（例えば、ポート又はソケットを含む）を介してコンソール３６に接続され、第２の電気的インターフェースを介してロボット２４に接続される。一部の実施形態では、ケーブル５４のコンソールに面する端部は、本明細書に記載される様々な他のケーブルのそれぞれの端部と共に、中心ケーブル５６に束ねられる。
【００３９】
システム２０は、集合体２９（すなわち、ツール２８又はアーム２６のいずれか）に連結された少なくとも１つのツール追跡センサを含む、追跡システム６２を更に備える。ロボットが集合体を（ツール追跡センサと共に）移動させる間、追跡システム６２は、センサ追跡信号６０をプロセッサ４０に出力する。センサ追跡信号６０は、本明細書で「ＴＣＳ」という表記によって示される、追跡システムの座標系に対するツール追跡センサのポーズを示す。
【００４０】
一部の実施形態では、追跡システム６２は、センサ追跡信号６０が、ツールのポーズを示す１つ以上の電磁誘導電圧を含むことから、電磁追跡システムを含む。例えば、図１に示すように、追跡システム６２は、集合体２９に連結されたそれぞれの集合体連結コイル３４を含む、１つ以上の（典型的には２つ又は３つの）電磁ツール追跡センサを含んでもよい。追跡システム６２は、複数（例えば、１０〜２０）の固定コイル３２を更に含んでもよく、固定コイル３２は、例えば、椅子５２の頭部に位置付けられた支持体６４内で、被験者２２の付近の異なるそれぞれの位置に配設される。（簡潔化のために、１つの固定コイル３２のみが図１に示されている。）交流が、異なるそれぞれの周波数で固定コイル３２（又は固定コイルのサブセット）を通過し、それにより、固定コイルは、集合体連結コイル３４内にそれぞれの電圧を異なる周波数で誘導する磁場を発生させる。誘導電圧は、それぞれの集合体連結コイルのそれぞれのポーズ、ひいてはツールのポーズを示す。
【００４１】
あるいは、集合体連結コイル３４は、固定コイル３２内にそれぞれの電圧を誘導する磁場を発生させてもよい。（かかる実施形態では、センサ追跡信号６０は、集合体連結コイル３４ではなく、固定コイル３２によって出力される。）前述の実施形態と同様に、誘導電圧は、それぞれの集合体連結コイルのそれぞれのポーズを示す。
【００４２】
集合体連結コイル３４は、任意の好適な方法でアーム２６又はツール２８に結合されてもよい。例えば、図１に示すように、少なくとも１つのコイル３４は、ツールに連結されたフレキシブル回路３５の表面上に形成されたループ状トレースを含んでもよい。代替として又は追加として、図１に更に示すように、少なくとも１つのコイルがツール２８内に配設されてもよい。更に別の代替として、少なくとも１つのコイルは、アーム２６又はツール２８の周囲、例えばアーム２６又はツール２８の表面上に形成された溝内に巻かれてもよい。
【００４３】
電磁システムの代替として又は追加として、追跡システム６２は、集合体２９に連結された光学マーカー、及び１つ以上のカメラを含む、光学追跡システムを含んでもよい。このような実施形態では、センサ追跡信号６０は、カメラに対する光学マーカーのポーズを示す、カメラによって出力された画像を含む。
【００４４】
典型的には、追跡システム６２は、被験者２２に、例えば被験者の額に連結された被験者追跡センサ３０を更に含む。（センサ３０は、典型的には、接着パッチ３１内に収容される。）追跡システム６２は、ＴＣＳに対するセンサ３０のポーズを示す被験者センサ追跡信号６６を出力する。センサ３０は、例えば、ツール追跡センサについて上述したように、１つ以上の受信コイル又は発生コイルを含んでもよい。代替として又は追加として、光学追跡システムで使用するための光学マーカーは、被験者２２に連結されてもよい。
【００４５】
プロセッサ４０及び電気インターフェース３８に加えて、コンソール３６は、典型的には、ロボット２４と通信するための有線又は無線通信（ＣＯＭＭ）インターフェース７０と、被験者の術前スキャン６８を表示するように構成されたモニタ４２と、を含む。モニタ４２を使用して、医師は、処置中にツール２８の移動を視覚的に追跡し、かつ／又は、例えば、術前スキャン６８の上に重ね合わされたアイコンを描画若しくは移動することによって、ツールの標的ポーズを指定することができる。それぞれのケーブルは、集合体連結コイル３４、固定コイル３２、被検者追跡センサ３０、及びツール２８をコンソール３６に接続する。
【００４６】
一般に、プロセッサ４０は、単一のプロセッサとして、又は連携してネットワーク化若しくはクラスタ化されたプロセッサのセットとして、具現化されてもよい。一部の実施形態では、本明細書で説明されるプロセッサ４０の機能は、例えば１つ若しくは２つ以上の特定用途向け集積回路（ＡＳＩＣ）又はフィールドプログラマブルゲートアレイ（ＦＰＧＡ）を使用して、ハードウェア内にのみ実装される。他の実施形態では、プロセッサ４０の機能は、少なくとも部分的にソフトウェア内に実装される。例えば、一部の実施形態では、プロセッサ４０は、少なくとも中央演算処理装置（ＣＰＵ）及びランダムアクセスメモリ（ＲＡＭ）を含むプログラム済みデジタルコンピューティングデバイスとして具現化される。ソフトウェアプログラムを含むプログラムコード、及び／又はデータは、ＣＰＵによる実行及び処理のためにＲＡＭに読み込まれる。プログラムコード及び／又はデータは、例えば、ネットワークを介して、電子形態でプロセッサにダウンロード可能である。あるいは又は更に、プログラムコード及び／又はデータは、磁気、光学、又は電子メモリなどの非一時的有形媒体上に提供及び／又は記憶されてもよい。このようなプログラムコード及び／又はデータが、プロセッサに提供されると、本明細書に記載されているタスクを行うように構成されている、機械又は専用コンピュータが実現する。
【００４７】
ＴＣＳ及びＲＣＳを互いに位置合わせする
ロボットが集合体２９を移動させる間、プロセッサ４０は、ＴＣＳ及びＲＣＳを互いに繰り返し位置合わせする。この位置合わせは、集合体２９の少なくとも１つの特定の部分の、１対以上の対応するポーズに基づく。例えば、位置合わせは、コイル３４のうちの１つが連結される集合体のそれぞれの部分、及び／又はツール２８の遠位端の１対以上の対応するポーズに基づいてもよい。対応するポーズのそれぞれのｉ番目の対は、（ｉ）時間ｔｉにおけるＴＣＳに対する集合体の特定の部分のポーズＰｉＴＣＳと、（ｉｉ）時間ｔｉにおけるＲＣＳに対する集合体の特定の部分のポーズＰｉＲＣＳと、を含む。
【００４８】
（ＰｉＴＣＳ及びＰｉＲＣＳは、同じ目的のポーズ、すなわち、時間ｔｉにおける集合体の特定の部分のポーズを記述することによって、互いに「対応する」と言われることに留意されたい。ロボットアームは、典型的に比較的ゆっくり移動するので、ＰｉＴＣＳ及びＰｉＲＣＳは、数ミリ秒（例えば、０〜５又は５〜１０ミリ秒）が２つのポーズのそれぞれの時間を分離している場合であっても、互いに対応すると言われ得る。換言すれば、「時間ｔｉ」は、実際には数ミリ秒の間隔を含んでもよい。）
【００４９】
１対の対応するポーズでも、２つの座標系を互いに位置合わせするのに十分であるが、位置合わせの精度は一般に、位置合わせに使用される対の数と共に向上する。したがって、プロセッサは、典型的に対応するポーズの対を蓄積し、基部２５が対の取得中に移動しなかったことを条件として、それまでに蓄積された対の全てに基づいて２つの座標系を繰り返し位置合わせする。
【００５０】
換言すれば、プロセッサは、集合体の関連する部分毎に、対応するポーズの対のセット｛（ＰｉＴＣＳ，ＰｉＲＣＳ）｝を維持する。処置が実行されると、プロセッサが、ロボットの基部が移動されたことを確認するまで、プロセッサは、新たな対のポーズをセットに継続的に追加し、２つの座標系を互いに再位置合わせする。基部が移動されたことを確認したことに応答して、プロセッサはセットを空にし、次いで、セットを直近の対の対応するポーズで再初期化する。
【００５１】
より具体的には、それぞれの時間ｔｉにおいて、プロセッサは、ロボットからアーム追跡信号を受信し、アーム追跡信号に基づいて、集合体の特定の部分のＲＣＳポーズ（すなわち、ＲＣＳに対するポーズ）を計算する。プロセッサは更に、追跡システムからセンサ追跡信号６０を受信し、センサ追跡信号に基づいて、時間｛ｔｉ｝における集合体の特定の部分のそれぞれのＴＣＳポーズを計算する。（典型的には、プロセッサは、処置が実行される際に、センサ追跡信号６０を連続的に受信する。）ＲＣＳポーズ及びＴＣＳポーズに基づいて、プロセッサは、ＲＣＳ及びＴＣＳを互いに位置合わせする。
【００５２】
この点について、ここで図２を参照するが、図２は、本発明の一部の実施形態による、ＴＣＳ及びＲＣＳを互いに位置合わせするための方法７２のフローチャート及びアルゴリズムである。簡略化のために、図２は、位置合わせが、ツールの遠位先端など、集合体の１つの特定の部分の対応するポーズに基づいて実行されることを想定している。
【００５３】
方法７２は、プロセッサが、センサ追跡信号６０から集合体の特定の部分のＴＣＳポーズを導出する、第１のＴＣＳポーズを導出する工程７４から開始する。典型的には、第１のＴＣＳポーズを導出する工程７４は、周期的に（例えば、５ｍｓ毎に１回）実行される。
【００５４】
集合体の特定の部分のＴＣＳポーズを導出するために、プロセッサは、最初に、任意の好適な手法を使用して、ツール追跡センサのＴＣＳポーズを導出する。例えば、電磁追跡システムの場合、プロセッサは、センサ追跡信号の様々な構成要素のそれぞれの振幅から、それぞれの集合体連結コイルのポーズを計算し得る。光学追跡システムの場合、プロセッサは、カメラによって取得された画像から光学マーカーのポーズを計算するためにコンピュータビジョン手法を使用し得る。集合体の特定の部分が、センサが連結される集合体の部分と異なる場合、プロセッサは次いで、センサのＴＣＳポーズに、集合体の特定の部分とセンサとの間の既知のポーズオフセットを追加することによって、集合体の特定の部分のＴＣＳポーズを計算する。
【００５５】
第１のＴＣＳポーズを導出する工程７４に続き、又はそれに先立ち、プロセッサは、信号受信工程７６において、ロボットからアーム追跡信号を受信する。例えば、プロセッサは、ロボットがアーム追跡信号をプロセッサに伝達するように、第１のＴＣＳポーズを導出する工程７４の直後に又はそれに先立ち、ロボットからのアーム追跡信号を周期的に要求してもよい。あるいは、ロボットは、信号を伝達するための周期的な要求をプロセッサから受信しなくても、アーム追跡信号をプロセッサに周期的に（例えば、５ｍｓ毎に１回）伝達するように構成されてもよい。
【００５６】
信号を受信する工程７６に続き、プロセッサは、ＲＣＳポーズ導出工程７８において、アーム追跡信号から集合体の特定部分のＲＣＳポーズを導出する。最初に、プロセッサは、アーム追跡信号に明示的に指定されたＲＣＳポーズを読み取る。ＲＣＳポーズが指定されたアームの部分が集合体の特定の部分と異なる場合、プロセッサは次いで、ＲＣＳポーズに、集合体の特定の部分とＲＣＳポーズが指定されたアームの部分との間の既知のポーズオフセットを追加する。
【００５７】
次に、チェックする工程８０において、プロセッサは、ＴＣＳ／ＲＣＳ位置合わせが既に実行されたか否かをチェックする。はいの場合、プロセッサは、変換する工程８２において、ＴＣＳ／ＲＣＳ位置合わせに基づいてＴＣＳポーズをＲＣＳに変換する。続いて、第１の距離を計算する工程８４において、プロセッサは、変換されたポーズとＲＣＳポーズとの間の距離を計算する。（例えば、プロセッサは、「概説」で上述したように、２つのポーズ間のＳＳＥのタイプを計算し得る。）プロセッサは、次いで、第１の距離を比較する工程８６において、この距離を既定の閾値と比較する。
【００５８】
（あるいは、プロセッサは、ＲＣＳポーズをＴＣＳに変換し、次いで、変換されたポーズとＴＣＳポーズとの間の距離を計算してもよい。）
【００５９】
距離が閾値以上である場合、ロボットの基部が移動された可能性が高いことを示し、プロセッサは、設定を空にする工程８８において、対応するポーズの対のセットを空にする。続いて、プロセッサは、セットを増大させる工程９０において、対応するポーズの対の（空の）セットにＴＣＳポーズ及びＲＣＳポーズを追加する。プロセッサは、次いで、位置合わせする工程９２において、対応するポーズを使用して、ＴＣＳ及びＲＣＳを互いに再位置合わせする。換言すれば、プロセッサは、直近のＲＣＳポーズ及びＴＣＳポーズを使用するが、以前に取得したＲＣＳポーズ及びＴＣＳポーズのいずれも使用せず、２つの座標系を再位置合わせする。
【００６０】
一方、第１の距離を比較する工程８６において、プロセッサが、距離が閾値以下であることを確認した場合、プロセッサは、最初にセットを空にすることなく、セットを増大させる工程９０を実行し、これにより、ポーズの最新の対が以前に取得された対に付加される。プロセッサは、次いで、セット全体を使用して、ＴＣＳ及びＲＣＳを互いに再位置合わせする。換言すれば、プロセッサは、セットに含まれる以前に取得されたＲＣＳポーズ及びＴＣＳポーズと共に、直近のＲＣＳポーズ及びＴＣＳポーズを使用して、２つの座標系を再位置合わせする。
【００６１】
ここでチェックする工程８０に戻り、プロセッサが、ＴＣＳ／ＲＣＳ位置合わせがまだ実行されていないことを確認した場合、プロセッサは、セットを増大させる工程９０（よって、セットを初期化する）を即座に実行し、続いて、位置合わせする工程９２を実行する。
【００６２】
位置合わせする工程９２に続いて、プロセッサは、第１のＴＣＳポーズを導出する工程７４に戻る。ＴＣＳポーズを導出する工程７４を実行する前に、プロセッサは、ポーズを取得するための所望の周期性を得るため、数ミリ秒間待機してもよい。
【００６３】
例示的な位置合わせ手法
位置合わせする工程９２は、本明細書に記載されるものなどの任意の好適なアルゴリズムを使用して実行されてもよい。例えば、「概説」で上述したように、プロセッサは、誤差関数
【００６４】
【数２】
2020089731.tif 000004
を最小化する変換ＴＴＣＳ→ＲＣＳを見つけることができる。式中、それぞれのＰｉＲＣＳ＊は、ＴＴＣＳ→ＲＣＳをＰｉＴＣＳに適用した結果である。一部の実施形態では、この手法は、以下のように実行される。
（ｉ）ポーズのセット内に、ＴＣＳに対する全ての位置ベクトルを均質な形態で含む位置行列ＭＬＴＣＳを定義し、ＲＣＳに関する類似の位置行列ＭＬＲＣＳを定義する。
【００６５】
【数３】
2020089731.tif 000005
（ｉｉ）ポーズのセット内に、ＴＣＳに対する全ての配向ベクトルを均質な形態で含む配向行列ＭＯＴＣＳを定義し、ＲＣＳに関する類似の配向行列ＭＯＲＣＳを定義する。
【００６６】
【数４】
2020089731.tif 000006
（ｉｉｉ）任意の所与の３×１ベクトルを、角度θ、φ、及びΨによってそれぞれｘ軸、ｙ軸、及びｚ軸を中心に回転させる、３×３回転行列Ｒ３（θ、φ、Ψ）を定義する。
【００６７】
【数５】
2020089731.tif 000007
（簡潔にするために、θ、φ、及びΨに対する用語ｒ１１．．．ｒ３３の依存性は、本明細書に明示的に示されていない。）
（ｉｖ）任意の所定のベクトルを、ｘ軸、ｙ軸、及びｚ軸に沿って変換する、３つの変換ｔｘ、ｔｙ、及びｔｚを定義する。
（ｖ）均質な４×１ベクトル上で動作するようにＲ３に延長させる、４×４回転行列Ｒ４を定義する。
【００６８】
【数６】
2020089731.tif 000008
（ｖｉ）回転Ｒ３（θ、φ、Ψ）のベクトルへの適用に続いて、変換ｔｘ、ｔｙ、及びｔｚによってベクトルを変換する、４×４変換行列Ｔを定義する。
【００６９】
【数７】
2020089731.tif 000009
（ｖｉｉ）位置行列ＭＬＲＣＳ＊がＴ×ＭＬＴＣＳに等しく、配向行列ＭＯＲＣＳ＊がＲ４×ＭＯＴＣＳに等しくなるようにする。
（ｖｉｉｉ）（ＭＬＲＣＳ、ＭＯＲＣＳ）と（ＭＬＲＣＳ＊、ＭＯＲＣＳ＊）との間の距離を最小化するθ、φ、Ψ、ｔｘ、ｔｙ、及びｔｚを見つける。この距離は、「概説」で上述したように、好適な定数Ｃの場合、
【００７０】
【数８】
2020089731.tif 000010
に等しくなり得る。
【００７１】
ロボットを制御する
ここで図３を参照するが、図３は、本発明の一部の実施形態による、ロボット２４を制御するための方法９４のフローチャート及びアルゴリズムである。方法９４は、例えば、平行スレッド上で２つの方法を実行することによって、方法７２（図２）と並行してプロセッサ４０によって実行される。
【００７２】
方法９４は、医師からツールの遠位端の標的ポーズを受信することから開始する。
【００７３】
一部の実施形態では、標的ポーズは、例えば、医師がロボットアームを標的ポーズに手動で移動させることによって、ＴＣＳにおいて指定される。例えば、内視鏡手術では、ロボットは、典型的には、洗浄のために内視鏡を繰り返し引き抜かなければならず、それにより、ロボットは、最初に医師によって指定された標的ポーズに繰り返し復帰する必要がある。
【００７４】
他の実施形態では、図３で想定されるように、医師は、ＳＣＳでツールの遠位端の標的ポーズを指定する。例えば、図１を参照して上述したように、医師は、被験者の術前スキャン上に重ね合わされたアイコンを描画又は移動することによって標的ポーズを指定することができる。よって、方法９４は、プロセッサ４０が、ツールの遠位端の標的ＳＣＳポーズ、すなわち、ＳＣＳに対するツールの遠位端の標的ポーズを受信する、標的を受信する工程９６から開始する。標的を受信する工程９６に続いて、プロセッサは、標的を計算する工程９８において、ＳＣＳ／ＴＣＳ位置合わせを使用して、ツールの遠位端の標的ＴＣＳポーズを計算する。（「概説」で上述したように、ＳＣＳ／ＴＣＳ位置合わせは、典型的に、処置の開始に先だって初期化される。）
【００７５】
続いて、プロセッサは、ツールの遠位端を標的ポーズに向かって漸増的に移動させるように制御ループを実行する。制御ループのそれぞれの反復の開始時に、プロセッサは、第２のＴＣＳポーズを導出する工程１００において、センサ追跡信号からツールの遠位端のＴＣＳポーズを導出する。続いて、プロセッサは、第２の距離を計算する工程１０２において、ＴＣＳポーズと標的ＴＣＳポーズとの間の距離を計算する。次いで、プロセッサは、第２の距離を比較する工程１０４において、この距離を既定の閾値と比較する。距離が閾値以下である場合、ゆえにターゲットポーズが達成された場合、プロセッサは制御ループを出て、方法９４は終了する。そうでなければ、プロセッサは、小さいオフセットの分だけアーム２６を標的ポーズに向かって移動させ、次いで制御ループの開始に戻る。このオフセットは、被験者追跡信号に基づいて計算されるように、被験者のポーズのあらゆる変化に応答して計算される。
【００７６】
（一般に、第２のＴＣＳポーズを導出する工程１００は、図２の第１のＴＣＳポーズを導出する工程７４と一緒に実行されてもよい。例えば、プロセッサは、センサのＴＣＳポーズを周期的に導出し、次いで、センサのＴＣＳポーズから、集合体の特定の部分及びツールの遠位端のＴＣＳポーズを導出し得る。よって、ＴＣＳ／ＲＣＳ位置合わせに使用される集合体の特定の部分がツールの遠位端である場合、第２のＴＣＳポーズを導出する工程１００は、第１のＴＣＳポーズを導出する工程７４と同一であってもよい。）
【００７７】
より具体的には、距離が閾値を超えていることの確認に続き、プロセッサは、まず、第３のＴＣＳポーズを導出する工程１０６において、被験者追跡信号から被験者追跡センサのＴＣＳポーズを導出する。続いて、第３の距離を計算する工程１０８において、プロセッサは、被験者追跡センサの現在のＴＣＳポーズと直近のＴＣＳポーズとの間の距離を計算する。次いで、プロセッサは、距離が既定の閾値を超えているかどうかを第３の距離を比較する工程１１０でチェックする。
【００７８】
距離が閾値以上である場合、ゆえに、被験者が移動していないと想定され得る場合、プロセッサは、第１のオフセットを計算する工程１１４において、ＴＣＳに対する標的アームポーズオフセットを計算する。次に、第２のオフセットを計算する工程１１６において、プロセッサは、ＴＣＳ／ＲＣＳ位置合わせ（図２の方法７２によって得られた）を使用して、図３でＲＣＳアームポーズオフセットと称される、変換されたアームポーズオフセットを計算する。換言すれば、プロセッサは、ＴＣＳアームポーズオフセットをＲＣＳに変換する。続いて、プロセッサは、オフセットを伝達する工程１１８において、変換されたアームポーズオフセットをロボットに伝達することにより、アームポーズオフセットの分だけロボットにアームのポーズを変化させる。次いで、プロセッサは、第２のＴＣＳポーズを導出する工程１００に戻る。
【００７９】
一方、第３の距離を比較する工程１１０において、プロセッサは、距離が閾値を超えていることを確認した（被験者のポーズが変化したことを示す）場合、プロセッサは、アームポーズオフセットの計算に先立って標的ＴＣＳポーズを再計算する。特に、プロセッサは、まず、位置合わせを再計算する工程１１２において、被験者追跡センサの動きに基づいてＳＣＳ／ＴＣＳ位置合わせを再計算する。続いて、プロセッサは、標的を計算する工程９８に戻り、ＳＣＳ／ＴＣＳ位置合わせを使用して、ツールの遠位端の標的ＴＣＳポーズを再計算する。（あるいは、プロセッサは、現在の標的ＴＣＳポーズに、被験者追跡センサの直近のＴＣＳポーズを被験者追跡センサの現在のＴＣＳポーズにマッピングする変換を適用してもよい。）次いで、プロセッサは、上述のように、制御ループを再実行する。
【００８０】
本発明が、本明細書上に具体的に示されて記載されたものに限定されない点が、当業者により理解されよう。むしろ、本発明の実施形態の範囲は、本明細書上に記載されている様々な特徴の組み合わせ及び部分的組み合わせの両方、並びに、上記の説明を一読すると当業者には想起されると思われる、従来技術には存在しない特徴の変更例及び改変例を含む。参照により本特許出願に援用される文献は、これらの援用文献において、いずれかの用語が本明細書において明示的又は暗示的になされた定義と矛盾して定義されている場合には、本明細書における定義のみを考慮するものとする点を除き、本出願の一部とみなすものとする。
【００８１】
〔実施の態様〕
（１）  外科用ロボットが、前記ロボットのアームと、前記アームによって保持されるツールと、を含む集合体を移動させる間に、前記ロボットを制御するためのシステムであって、前記システムは、
通信インターフェースと、
プロセッサであって、
１つ以上の時間に、前記ロボットのロボット座標系（ＲＣＳ）に対する前記アームのアームポーズを示すアーム追跡信号を、前記通信インターフェースを介して前記ロボットから受信し、
前記アーム追跡信号から、前記１つ以上の時間における、前記ＲＣＳに対する、前記集合体の少なくとも１つの特定の部分のそれぞれのＲＣＳポーズを導出し、
追跡システムから、前記追跡システムの追跡システム座標系（ＴＣＳ）に対する、前記追跡システムに属し、前記集合体に連結されている少なくとも１つのセンサのセンサポーズを示す、センサ追跡信号を受信し、
前記センサ追跡信号から、前記１つ以上の時間における、前記ＴＣＳに対する、前記集合体の前記特定の部分のそれぞれのＴＣＳポーズを導出し、
前記ＲＣＳポーズ及び前記ＴＣＳポーズに基づいて、前記ＲＣＳ及び前記ＴＣＳを互いに位置合わせし、かつ
前記位置合わせに基づいて、前記ロボットを制御するように構成されている、プロセッサと、を備える、システム。
（２）  前記センサがコイルを含み、前記追跡システムは、前記コイル内に前記センサ追跡信号を誘発する磁場を発生させる複数の磁場発生器を含む、実施態様１に記載のシステム。
（３）  前記センサが前記ツールに連結されている、実施態様１に記載のシステム。
（４）  前記センサが前記アームに連結されている、実施態様１に記載のシステム。
（５）  前記時間が第１の時間であり、前記ＲＣＳポーズが第１の時間のＲＣＳポーズであり、前記ＴＣＳポーズが第１の時間のＴＣＳポーズであり、前記プロセッサは、
第２の時間に、前記アーム追跡信号を受信し、
前記アーム追跡信号から、前記第２の時間における、前記ＲＣＳに対する、前記集合体の前記特定の部分の第２の時間のＲＣＳポーズを導出し、
前記センサ追跡信号から、前記第２の時間における、前記ＴＣＳに対する、前記集合体の前記特定の部分の第２の時間のＴＣＳポーズを導出し、
前記位置合わせに基づいて、前記第２の時間のＴＣＳポーズを前記ＲＣＳに変換することによって、変換されたポーズを計算し、
前記変換されたポーズと前記第２の時間のＲＣＳポーズとの間の距離を計算し、かつ、
前記距離が既定の閾値を超えていることに応答して、前記第１の時間のＲＣＳポーズを使用せず、また前記第１の時間のＴＣＳポーズを使用せず、前記第２の時間のＲＣＳポーズ及び前記第２の時間のＴＣＳポーズを使用して、前記ＲＣＳ及び前記ＴＣＳを互いに再位置合わせするように更に構成されている、実施態様１に記載のシステム。
【００８２】
（６）  前記時間が第１の時間であり、前記ＲＣＳポーズが第１の時間のＲＣＳポーズであり、前記ＴＣＳポーズが第１の時間のＴＣＳポーズであり、前記プロセッサは、
第２の時間に、前記アーム追跡信号を受信し、
前記アーム追跡信号から、前記第２の時間における、前記ＲＣＳに対する、前記集合体の前記特定の部分の第２の時間のＲＣＳポーズを導出し、
前記センサ追跡信号から、前記第２の時間における、前記ＴＣＳに対する、前記集合体の前記特定の部分の第２の時間のＴＣＳポーズを導出し、
前記位置合わせに基づいて、前記第２の時間のＴＣＳポーズを前記ＲＣＳに変換することによって、変換されたポーズを計算し、
前記変換されたポーズと前記第２の時間のＲＣＳポーズとの間の距離を計算し、かつ、
前記距離が既定の閾値を超えていないことに応答して、前記第２の時間のＲＣＳポーズ、前記第２の時間のＴＣＳポーズ、前記第１の時間のＲＣＳポーズ、及び前記第１の時間のＴＣＳポーズを使用して、前記ＲＣＳ及び前記ＴＣＳを互いに再位置合わせするように更に構成されている、実施態様１に記載のシステム。
（７）  前記時間が第１の時間であり、前記ＲＣＳポーズが第１の時間のＲＣＳポーズであり、前記ＴＣＳポーズが第１の時間のＴＣＳポーズであり、前記プロセッサは、
第２の時間に、前記アーム追跡信号を受信し、
前記アーム追跡信号から、前記第２の時間における、前記ＲＣＳに対する、前記集合体の前記特定の部分の第２の時間のＲＣＳポーズを導出し、
前記センサ追跡信号から、前記第２の時間における、前記ＴＣＳに対する、前記集合体の前記特定の部分の第２の時間のＴＣＳポーズを導出し、
前記位置合わせに基づいて、前記第２の時間のＲＣＳポーズを前記ＴＣＳに変換することによって、変換されたポーズを計算し、
前記変換されたポーズと前記第２の時間のＴＣＳポーズとの間の距離を計算し、かつ、
前記距離が既定の閾値を超えていることに応答して、前記第１の時間のＲＣＳポーズを使用せず、また前記第１の時間のＴＣＳポーズを使用せず、前記第２の時間のＲＣＳポーズ及び前記第２の時間のＴＣＳポーズを使用して、前記ＲＣＳ及び前記ＴＣＳを互いに再位置合わせするように更に構成されている、実施態様１に記載のシステム。
（８）  前記時間が第１の時間であり、前記ＲＣＳポーズが第１の時間のＲＣＳポーズであり、前記ＴＣＳポーズが第１の時間のＴＣＳポーズであり、前記プロセッサは、
第２の時間に、前記アーム追跡信号を受信し、
前記アーム追跡信号から、前記第２の時間における、前記ＲＣＳに対する、前記集合体の前記特定の部分の第２の時間のＲＣＳポーズを導出し、
前記センサ追跡信号から、前記第２の時間における、前記ＴＣＳに対する、前記集合体の前記特定の部分の第２の時間のＴＣＳポーズを導出し、
前記位置合わせに基づいて、前記第２の時間のＲＣＳポーズを前記ＴＣＳに変換することによって、変換されたポーズを計算し、
前記変換されたポーズと前記第２の時間のＴＣＳポーズとの間の距離を計算し、かつ、
前記距離が既定の閾値を超えていないことに応答して、前記第２の時間のＲＣＳポーズ、前記第２の時間のＴＣＳポーズ、前記第１の時間のＲＣＳポーズ、及び前記第１の時間のＴＣＳポーズを使用して、前記ＲＣＳ及び前記ＴＣＳを互いに再位置合わせするように更に構成されている、実施態様１に記載のシステム。
（９）  前記プロセッサは、
前記ＴＣＳに対する標的アームポーズオフセットを計算すること、
前記位置合わせに基づいて、前記標的アームポーズオフセットを前記ＲＣＳに変換することによって、変換された標的アームポーズオフセットを計算すること、及び、
前記変換された標的アームポーズオフセットを前記ロボットに伝達することによって、前記ロボットに前記標的アームポーズオフセットの分だけ前記アームの前記アームポーズを変化させること、
によって、前記ロボットを制御するように構成されている、実施態様１に記載のシステム。
（１０）  前記ロボットが被験者上で動作しており、
前記追跡システムが、前記被験者に連結された少なくとも１つの被験者追跡センサを更に含み、
前記プロセッサが、
前記追跡システムから、前記ＴＣＳに対する前記被験者追跡センサの被験者追跡センサポーズを示す、被験者追跡信号を受信し、かつ
前記被験者追跡信号から、前記被験者の被験者ポーズの変化を導出するように更に構成されており、
前記プロセッサが、前記被験者の前記被験者ポーズの前記変化に応答して、前記標的アームポーズオフセットを計算するように構成されている、実施態様９に記載のシステム。
【００８３】
（１１）  外科用ロボットが、前記ロボットのアームと、前記アームによって保持されるツールと、を含む集合体を移動させる間に、前記ロボットを制御するための方法であって、前記方法は、
１つ以上の時間に、前記ロボットのロボット座標系（ＲＣＳ）に対する前記アームのアームポーズを示すアーム追跡信号を、前記ロボットから受信することと、
前記アーム追跡信号から、前記１つ以上の時間における、前記ＲＣＳに対する、前記集合体の少なくとも１つの特定の部分のそれぞれのＲＣＳポーズを導出することと、
追跡システムから、前記追跡システムの追跡システム座標系（ＴＣＳ）に対する、前記追跡システムに属し、前記集合体に連結されている少なくとも１つのセンサのセンサポーズを示す、センサ追跡信号を受信することと、
前記センサ追跡信号から、前記１つ以上の時間における、前記ＴＣＳに対する、前記集合体の前記特定の部分のそれぞれのＴＣＳポーズを導出することと、
前記ＲＣＳポーズ及び前記ＴＣＳポーズに基づいて、前記ＲＣＳ及び前記ＴＣＳを互いに位置合わせすることと、
前記位置合わせに基づいて、前記ロボットを制御することと、を含む、方法。
（１２）  前記センサがコイルを含み、前記追跡システムが、前記コイル内に前記センサ追跡信号を誘発する磁場を発生させる複数の磁場発生器を含む、実施態様１１に記載の方法。
（１３）  前記センサが、前記ツールに連結されている、実施態様１１に記載の方法。
（１４）  前記センサが、前記アームに連結されている、実施態様１１に記載の方法。
（１５）  前記時間が第１の時間であり、前記ＲＣＳポーズが第１の時間のＲＣＳポーズであり、前記ＴＣＳポーズが第１の時間のＴＣＳポーズであり、前記方法は、
第２の時間に、前記アーム追跡信号を受信することと、
前記アーム追跡信号から、前記第２の時間における、前記ＲＣＳに対する、前記集合体の前記特定の部分の第２の時間のＲＣＳポーズを導出することと、
前記センサ追跡信号から、前記第２の時間における、前記ＴＣＳに対する、前記集合体の前記特定の部分の第２の時間のＴＣＳポーズを導出することと、
前記位置合わせに基づいて、前記第２の時間のＴＣＳポーズを前記ＲＣＳに変換することによって、変換されたポーズを計算することと、
前記変換されたポーズと前記第２の時間のＲＣＳポーズとの間の距離を計算することと、
前記距離が既定の閾値を超えていることに応答して、前記第１の時間のＲＣＳポーズを使用せず、また前記第１の時間のＴＣＳポーズを使用せず、前記第２の時間のＲＣＳポーズ及び前記第２の時間のＴＣＳポーズを使用して、前記ＲＣＳ及び前記ＴＣＳを互いに再位置合わせすることと、を更に含む、実施態様１１に記載の方法。
【００８４】
（１６）  前記時間が第１の時間であり、前記ＲＣＳポーズが第１の時間のＲＣＳポーズであり、前記ＴＣＳポーズが第１の時間のＴＣＳポーズであり、前記方法は、
第２の時間に、前記アーム追跡信号を受信することと、
前記アーム追跡信号から、前記第２の時間における、前記ＲＣＳに対する、前記集合体の前記特定の部分の第２の時間のＲＣＳポーズを導出することと、
前記センサ追跡信号から、前記第２の時間における、前記ＴＣＳに対する、前記集合体の前記特定の部分の第２の時間のＴＣＳポーズを導出することと、
前記位置合わせに基づいて、前記第２の時間のＴＣＳポーズを前記ＲＣＳに変換することによって、変換されたポーズを計算することと、
前記変換されたポーズと前記第２の時間のＲＣＳポーズとの間の距離を計算することと、
前記距離が既定の閾値を超えていないことに応答して、前記第２の時間のＲＣＳポーズ、前記第２の時間のＴＣＳポーズ、前記第１の時間のＲＣＳポーズ、及び前記第１の時間のＴＣＳポーズを使用して、前記ＲＣＳ及び前記ＴＣＳを互いに再位置合わせすることと、を更に含む、実施態様１１に記載の方法。
（１７）  前記時間が第１の時間であり、前記ＲＣＳポーズが第１の時間のＲＣＳポーズであり、前記ＴＣＳポーズが第１の時間のＴＣＳポーズであり、前記方法は、
第２の時間に、前記アーム追跡信号を受信することと、
前記アーム追跡信号から、前記第２の時間における、前記ＲＣＳに対する、前記集合体の前記特定の部分の第２の時間のＲＣＳポーズを導出することと、
前記センサ追跡信号から、前記第２の時間における、前記ＴＣＳに対する、前記集合体の前記特定の部分の第２の時間のＴＣＳポーズを導出することと、
前記位置合わせに基づいて、前記第２の時間のＲＣＳポーズを前記ＴＣＳに変換することによって、変換されたポーズを計算することと、
前記変換されたポーズと前記第２の時間のＴＣＳポーズとの間の距離を計算することと、
前記距離が既定の閾値を超えていることに応答して、前記第１の時間のＲＣＳポーズを使用せず、また前記第１の時間のＴＣＳポーズを使用せず、前記第２の時間のＲＣＳポーズ及び前記第２の時間のＴＣＳポーズを使用して、前記ＲＣＳ及び前記ＴＣＳを互いに再位置合わせすることと、を更に含む、実施態様１１に記載の方法。
（１８）  前記時間が第１の時間であり、前記ＲＣＳポーズが第１の時間のＲＣＳポーズであり、前記ＴＣＳポーズが第１の時間のＴＣＳポーズであり、前記方法は、
第２の時間に、前記アーム追跡信号を受信することと、
前記アーム追跡信号から、前記第２の時間における、前記ＲＣＳに対する、前記集合体の前記特定の部分の第２の時間のＲＣＳポーズを導出することと、
前記センサ追跡信号から、前記第２の時間における、前記ＴＣＳに対する、前記集合体の前記特定の部分の第２の時間のＴＣＳポーズを導出することと、
前記位置合わせに基づいて、前記第２の時間のＲＣＳポーズを前記ＴＣＳに変換することによって、変換されたポーズを計算することと、
前記変換されたポーズと前記第２の時間のＴＣＳポーズとの間の距離を計算することと、
前記距離が既定の閾値を超えていないことに応答して、前記第２の時間のＲＣＳポーズ、前記第２の時間のＴＣＳポーズ、前記第１の時間のＲＣＳポーズ、及び前記第１の時間のＴＣＳポーズを使用して、前記ＲＣＳ及び前記ＴＣＳを互いに再位置合わせすることと、を更に含む、実施態様１１に記載の方法。
（１９）  前記ロボットを制御することは、
前記ＴＣＳに対する標的アームポーズオフセットを計算することと、
前記位置合わせに基づいて、前記標的アームポーズオフセットを前記ＲＣＳに変換することによって、変換された標的アームポーズオフセットを計算することと、
前記変換された標的アームポーズオフセットを前記ロボットに伝達することによって、前記ロボットに前記標的アームポーズオフセットの分だけ前記アームの前記アームポーズを変化させることと、を含む、実施態様１１に記載の方法。
（２０）  前記ロボットが被験者上で動作しており、
前記追跡システムが、前記被験者に連結された少なくとも１つの被験者追跡センサを更に含み、
前記方法は、
前記追跡システムから、前記ＴＣＳに対する前記被験者追跡センサの被験者追跡センサポーズを示す、被験者追跡信号を受信することと、
前記被験者追跡信号から、前記被験者の被験者ポーズの変化を導出することと、を更に含み、
前記標的アームポーズオフセットを計算することは、前記被験者の前記被験者ポーズの前記変化に応答して前記アームポーズオフセットを計算することを含む、実施態様１９に記載の方法。
【図１】
2020089731.tif 000011
【図２】
2020089731.tif 000012
【図３】
2020089731.tif 000013
【外国語明細書】
2020089731000001.pdf