JP7357902B2 - ロボット制御システム、装置、方法及びプログラム - Google Patents
ロボット制御システム、装置、方法及びプログラム Download PDFInfo
- Publication number
- JP7357902B2 JP7357902B2 JP2019134802A JP2019134802A JP7357902B2 JP 7357902 B2 JP7357902 B2 JP 7357902B2 JP 2019134802 A JP2019134802 A JP 2019134802A JP 2019134802 A JP2019134802 A JP 2019134802A JP 7357902 B2 JP7357902 B2 JP 7357902B2
- Authority
- JP
- Japan
- Prior art keywords
- interference
- spatial region
- link
- slave robot
- robot
- 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.)
- Active
Links
Images
Landscapes
- Manipulator (AREA)
Description
(1.1 マスタ・スレーブ制御システムの構成)
図1~図4を参照しつつ、本実施形態に係るマスタ・スレーブ制御システム100の構成について説明する。
次に、図5~図18を参照しつつ、本実施形態に係るマスタ・スレーブ制御システム100の動作について、以下、詳細に説明する。
図5は、マスタ側情報処理装置3の動作に関するフローチャートである。同図から明らかな通り、処理が開始すると、ユーザ姿勢検出部31は、モーションセンサ2であるIMUセンサ(21~25L、25R)において検出されたセンサ情報の取得処理を行う(S11)。ここで、センサ情報は、上述のIMUセンサのセンサ値であり、具体的には、加速度センサ、角速度センサ及び地磁気センサの3軸センサ値である。
図6は、スレーブ側情報処理装置5の主に関節角度監視部56の動作に関するフローチャートである。同図から明らかな通り、処理が開始すると、関節角度監視部56は、コントローラユニット7からの送信情報、特に、ロボット8に備えられたセンサを介して得られたロボット8の現在の関節角度情報を取得する(S91)。なお、関節角度情報の取得周期は、本実施形態においては、100Hzである。関節角度情報を取得した後、当該関節角度情報が第1の干渉禁止領域と干渉するか否かの判定処理が行われる(S92)。
図10は、スレーブ側情報処理装置5の動作に関するフローチャートである。同図から明らかな通り、処理が開始すると、ユーザ姿勢受信部51は、ユーザ姿勢情報を取得する処理を行う(S3)。その後、マッピング処理部52は、ユーザ姿勢情報に基づいてロボット8の目標関節角度を算出すべく所定のマッピング処理を行う(S4)。
第1の実施形態によれば、ロボット8における自己衝突の危険を低減させることができると共にフェールセーフ処理が行われる頻度を低減させることができる。しかしながら、同構成を以てしても現在関節角度から目標関節角度へと移行する中間姿勢において自己干渉が発生する可能性がある。本実施形態によれば、より確実にロボット8における自己衝突の危険を低減させ、フェールセーフ処理が行われる頻度を低減させることができる。
第1の実施形態においては、各関節の目標関節角度に基づいて、干渉判定の対象となる第2の干渉禁止領域を算出したが、本実施形態では、干渉判定の対象となる第2の干渉禁止領域の一方を現在角度に基づいて算出する。
上述の実施形態においては、第2の干渉禁止領域同士の干渉判定結果に基づいて、目標関節角度を送信するか否かを判定していたが、本発明はこのような構成に限定されない。従って、例えば、いずれかを一方を第2の干渉禁止領域とし、他方は、ロボットの筐体領域又は第1の干渉禁止領域としてもよい。
2 モーションセンサ
3 マスタ側情報処理装置
4 スレーブシステム
5 スレーブ側情報処理装置
7 コントローラユニット
8 ロボット
89 ロボット(従来図)
21 頭部用IMUセンサ
22 背面用IMUセンサ
23 上腕用IMUセンサ
24 前腕用IMUセンサ
25 甲用IMUセンサ
81 頭部
811 頭部第1関節駆動モータ
812 頭部第2関節駆動モータ
82 胴部
821 胴部第1関節駆動モータ
822 胴部第2関節駆動モータ
85 腕部
851 腕部第1関節駆動モータ
852 腕部第2関節駆動モータ
853 腕部第3関節駆動モータ
854 腕部第4関節駆動モータ
855 腕部第5関節駆動モータ
856 腕部第6関節駆動モータ
857 腕部第7関節駆動モータ
100 マスタ・スレーブ制御システム
200 第2の干渉禁止領域
300 第1の干渉禁止領域
Claims (29)
- マスタ装置を介して取得されたユーザ姿勢に追従し、かつ、1又は複数の関節と複数のリンクを備えたスレーブロボットを制御するロボット制御システムであって、
前記スレーブロボットの前記リンクのうちの一のリンクを包含するように構成された第1の空間領域が、他のいずれかのリンク又は当該リンクに関する第1の空間領域に干渉するか否かを判定する、第1干渉判定部と、
前記第1干渉判定部において干渉有りと判定される場合には、前記スレーブロボットの動作制御部へとフェールセーフ信号を提供する、フェールセーフ信号提供部と、
前記リンクのうちの一のリンクを包含しかつ対応する第1の空間領域と一致するか又は包含するように構成された第2の空間領域が、他のいずれかのリンク、当該リンクに関する第1の空間領域又は第2の空間領域に干渉するか否かを判定する、第2干渉判定部と、
前記第2干渉判定部において干渉無しと判定される場合には、前記ユーザ姿勢に対応する前記スレーブロボットの各前記関節における目標関節角度を前記スレーブロボットの前記動作制御部へと提供し、前記第2干渉判定部において干渉有りと判定される場合には、前記目標関節角度を前記スレーブロボットの前記動作制御部へと提供しない、目標関節角度提供部と、
前記ユーザ姿勢に関するセンサ情報を前記スレーブロボットの関節角度へと変換するための変換情報を記憶する、変換情報記憶部と、
前記変換情報と逆運動学に基づいて、前記ユーザ姿勢を、対応する前記スレーブロボットの各前記関節における目標関節角度へと変換する、変換部と、を備えたロボット制御システム。 - 前記第2干渉判定部において干渉判定される、前記一のリンクに係る前記第2の空間領域、又は、前記他のいずれかのリンク、当該リンクに関する第1の空間領域若しくは第2の空間領域のいずれか一方は、目標関節角度に基づいて算出され、他方は、前記スレーブロボットの各前記関節における現在関節角度に基づいて算出される、請求項1に記載のロボット制御システム。
- 前記第2干渉判定部において干渉判定される、前記一のリンクに係る前記第2の空間領域、又は、前記他のいずれかのリンク、当該リンクに関する第1の空間領域若しくは第2の空間領域のいずれも、前記目標関節角度に基づいて算出される、請求項1に記載のロボット制御システム。
- 前記ロボット制御システムは、さらに、
現在の前記関節角度から前記目標関節角度へと至る過程の一又は複数の中間姿勢における中間姿勢関節角度を生成する、中間関節角度生成部を備え、
前記第2干渉判定部は、さらに、
前記中間姿勢関節角度のそれぞれに基づいて、前記リンクのうちの一のリンクに関する第2の空間領域が、他のいずれかのリンク、当該リンクに関する第1の空間領域又は第2の空間領域に干渉するか否かを判定する、中間姿勢判定部と、を備える、請求項1に記載のロボット制御システム。 - 前記第1干渉判定部における前記判定は、前記リンク又は前記リンクに関する第1の空間領域に対応する3次元モデル同士の干渉判定を行うことにより行われる、請求項1に記載のロボット制御システム。
- 前記第1干渉判定部は、さらに、
判定対象となる前記リンク又は前記リンクに関する第1の空間領域に対応する境界ボリューム同士の干渉を判定する、第1境界ボリューム判定部と、
前記第1境界ボリューム判定部において干渉有りと判断された場合に、前記リンク又は前記リンクに関する第1の空間領域の表面間の干渉を判定する、第1表面干渉判定部と、
を備える、請求項5に記載のロボット制御システム。 - 前記第2干渉判定部における前記判定は、前記リンク、前記リンクに関する第1の空間領域又は第2の空間領域に対応する3次元モデル同士の干渉判定を行うことにより行われる、請求項1に記載のロボット制御システム。
- 前記第2干渉判定部は、
判定対象となる前記リンク、前記リンクに関する第1の空間領域又は第2の空間領域に対応する境界ボリューム同士の干渉を判定する、第2境界ボリューム判定部と、
前記第2境界ボリューム判定部において干渉有りと判断された場合に、前記リンク、前記リンクに関する第1の空間領域又は前記第2の空間領域の表面間の干渉を判定する、第2表面干渉判定部と、を備える、請求項7に記載のロボット制御システム。 - 前記第1境界ボリューム判定部における判定は、AABB法(Axis-Aligned Bounding Box法)により行われる、請求項6に記載のロボット制御システム。
- 前記第2境界ボリューム判定部における判定は、AABB法(Axis-Aligned Bounding Box法)により行われる、請求項8に記載のロボット制御システム。
- 前記第1干渉判定部及び前記第2干渉判定部は、隣り合うリンクの間では干渉判定を行わない、請求項1に記載のロボット制御システム。
- マスタ装置を介して取得されたユーザ姿勢に追従し、かつ、1又は複数の関節と複数のリンクを備えたスレーブロボットを制御するロボット制御装置であって、
前記スレーブロボットの前記リンクのうちの一のリンクを包含するように構成された第1の空間領域が、他のいずれかのリンク又は当該リンクに関する第1の空間領域に干渉するか否かを判定する、第1干渉判定部と、
前記第1干渉判定部において干渉有りと判定される場合には、前記スレーブロボットの動作制御部へとフェールセーフ信号を提供する、フェールセーフ信号提供部と、
前記リンクのうちの一のリンクを包含しかつ対応する第1の空間領域と一致するか又は包含するように構成された第2の空間領域が、他のいずれかのリンク、当該リンクに関する第1の空間領域又は第2の空間領域に干渉するか否かを判定する、第2干渉判定部と、
前記第2干渉判定部において干渉無しと判定される場合には、前記ユーザ姿勢に対応する前記スレーブロボットの各前記関節における目標関節角度を前記スレーブロボットの前記動作制御部へと提供し、前記第2干渉判定部において干渉有りと判定される場合には、前記目標関節角度を前記スレーブロボットの前記動作制御部へと提供しない、目標関節角度提供部と、
前記ユーザ姿勢に関するセンサ情報を前記スレーブロボットの関節角度へと変換するための変換情報を記憶する、変換情報記憶部と、
前記変換情報と逆運動学に基づいて、前記ユーザ姿勢を、対応する前記スレーブロボットの各前記関節における目標関節角度へと変換する、変換部と、を備えたロボット制御装置。 - マスタ装置を介して取得されたユーザ姿勢に追従し、かつ、1又は複数の関節と複数のリンクを備えたスレーブロボットを制御するロボット制御方法であって、
前記スレーブロボットの前記リンクのうちの一のリンクを包含するように構成された第1の空間領域が、他のいずれかのリンク又は当該リンクに関する第1の空間領域に干渉するか否かを判定する、第1干渉判定ステップと、
前記第1干渉判定ステップにおいて干渉有りと判定される場合には、前記スレーブロボットの動作制御部へとフェールセーフ信号を提供する、フェールセーフ信号提供ステップと、
前記リンクのうちの一のリンクを包含しかつ対応する第1の空間領域と一致するか又は包含するように構成された第2の空間領域が、他のいずれかのリンク、当該リンクに関する第1の空間領域又は第2の空間領域に干渉するか否かを判定する、第2干渉判定ステップと、
前記第2干渉判定ステップにおいて干渉無しと判定される場合には、前記ユーザ姿勢に対応する前記スレーブロボットの各前記関節における目標関節角度を前記スレーブロボットの前記動作制御部へと提供し、前記第2干渉判定ステップにおいて干渉有りと判定される場合には、前記目標関節角度を前記スレーブロボットの前記動作制御部へと提供しない、目標関節角度提供ステップと、
前記ユーザ姿勢に関するセンサ情報を前記スレーブロボットの関節角度へと変換するための変換情報を記憶する、変換情報記憶ステップと、
前記変換情報と逆運動学に基づいて、前記ユーザ姿勢を、対応する前記スレーブロボットの各前記関節における目標関節角度へと変換する、変換ステップと、を備えたロボット制御方法。 - マスタ装置を介して取得されたユーザ姿勢に追従し、かつ、1又は複数の関節と複数のリンクを備えたスレーブロボットを制御するロボット制御プログラムであって、
前記スレーブロボットの前記リンクのうちの一のリンクを包含するように構成された第1の空間領域が、他のいずれかのリンク又は当該リンクに関する第1の空間領域に干渉するか否かを判定する、第1干渉判定ステップと、
前記第1干渉判定ステップにおいて干渉有りと判定される場合には、前記スレーブロボットの動作制御部へとフェールセーフ信号を提供する、フェールセーフ信号提供ステップと、
前記リンクのうちの一のリンクを包含しかつ対応する第1の空間領域と一致するか又は包含するように構成された第2の空間領域が、他のいずれかのリンク、当該リンクに関する第1の空間領域又は第2の空間領域に干渉するか否かを判定する、第2干渉判定ステップと、
前記第2干渉判定ステップにおいて干渉無しと判定される場合には、前記ユーザ姿勢に対応する前記スレーブロボットの各前記関節における目標関節角度を前記スレーブロボットの前記動作制御部へと提供し、前記第2干渉判定ステップにおいて干渉有りと判定される場合には、前記目標関節角度を前記スレーブロボットの前記動作制御部へと提供しない、目標関節角度提供ステップと、
前記ユーザ姿勢に関するセンサ情報を前記スレーブロボットの関節角度へと変換するための変換情報を記憶する、変換情報記憶ステップと、
前記変換情報と逆運動学に基づいて、前記ユーザ姿勢を、対応する前記スレーブロボットの各前記関節における目標関節角度へと変換する、変換ステップと、を備えたロボット制御プログラム。 - マスタ装置を介して取得されたユーザ姿勢に追従し、かつ、1又は複数の関節と複数のリンクを備えたスレーブロボットを制御するロボット制御システムであって、
前記スレーブロボットの前記リンクのうちの一のリンクを包含するように構成された第1の空間領域が、他のいずれかのリンク又は当該リンクに関する第1の空間領域に干渉するか否かを判定する、第1干渉判定部と、
前記第1干渉判定部において干渉有りと判定される場合には、前記スレーブロボットの動作制御部へとフェールセーフ信号を提供する、フェールセーフ信号提供部と、
前記リンクのうちの一のリンクを包含しかつ対応する第1の空間領域と一致するか又は包含するように構成された第2の空間領域が、他のいずれかのリンク、当該リンクに関する第1の空間領域又は第2の空間領域に干渉するか否かを判定する、第2干渉判定部と、
前記第2干渉判定部において干渉無しと判定される場合には、前記ユーザ姿勢に対応する前記スレーブロボットの各前記関節における目標関節角度を前記スレーブロボットの前記動作制御部へと提供し、前記第2干渉判定部において干渉有りと判定される場合には、前記目標関節角度を前記スレーブロボットの前記動作制御部へと提供しない、目標関節角度提供部と、を備え、
前記第2干渉判定部において干渉判定される、前記一のリンクに係る前記第2の空間領域、又は、前記他のいずれかのリンク、当該リンクに関する第1の空間領域若しくは第2の空間領域のいずれか一方は、目標関節角度に基づいて算出され、他方は、前記スレーブロボットの各前記関節における現在関節角度に基づいて算出される、ロボット制御システム。 - マスタ装置を介して取得されたユーザ姿勢に追従し、かつ、1又は複数の関節と複数のリンクを備えたスレーブロボットを制御するロボット制御方法であって、
前記スレーブロボットの前記リンクのうちの一のリンクを包含するように構成された第1の空間領域が、他のいずれかのリンク又は当該リンクに関する第1の空間領域に干渉するか否かを判定する、第1干渉判定ステップと、
前記第1干渉判定ステップにおいて干渉有りと判定される場合には、前記スレーブロボットの動作制御部へとフェールセーフ信号を提供する、フェールセーフ信号提供ステップと、
前記リンクのうちの一のリンクを包含しかつ対応する第1の空間領域と一致するか又は包含するように構成された第2の空間領域が、他のいずれかのリンク、当該リンクに関する第1の空間領域又は第2の空間領域に干渉するか否かを判定する、第2干渉判定ステップと、
前記第2干渉判定ステップにおいて干渉無しと判定される場合には、前記ユーザ姿勢に対応する前記スレーブロボットの各前記関節における目標関節角度を前記スレーブロボットの前記動作制御部へと提供し、前記第2干渉判定ステップにおいて干渉有りと判定される場合には、前記目標関節角度を前記スレーブロボットの前記動作制御部へと提供しない、目標関節角度提供ステップと、を備え、
前記第2干渉判定ステップにおいて干渉判定される、前記一のリンクに係る前記第2の空間領域、又は、前記他のいずれかのリンク、当該リンクに関する第1の空間領域若しくは第2の空間領域のいずれか一方は、目標関節角度に基づいて算出され、他方は、前記スレーブロボットの各前記関節における現在関節角度に基づいて算出される、ロボット制御方法。 - マスタ装置を介して取得されたユーザ姿勢に追従し、かつ、1又は複数の関節と複数のリンクを備えたスレーブロボットを制御するロボット制御プログラムであって、
前記スレーブロボットの前記リンクのうちの一のリンクを包含するように構成された第1の空間領域が、他のいずれかのリンク又は当該リンクに関する第1の空間領域に干渉するか否かを判定する、第1干渉判定ステップと、
前記第1干渉判定ステップにおいて干渉有りと判定される場合には、前記スレーブロボットの動作制御部へとフェールセーフ信号を提供する、フェールセーフ信号提供ステップと、
前記リンクのうちの一のリンクを包含しかつ対応する第1の空間領域と一致するか又は包含するように構成された第2の空間領域が、他のいずれかのリンク、当該リンクに関する第1の空間領域又は第2の空間領域に干渉するか否かを判定する、第2干渉判定ステップと、
前記第2干渉判定ステップにおいて干渉無しと判定される場合には、前記ユーザ姿勢に対応する前記スレーブロボットの各前記関節における目標関節角度を前記スレーブロボットの前記動作制御部へと提供し、前記第2干渉判定ステップにおいて干渉有りと判定される場合には、前記目標関節角度を前記スレーブロボットの前記動作制御部へと提供しない、目標関節角度提供ステップと、を備え、
前記第2干渉判定ステップにおいて干渉判定される、前記一のリンクに係る前記第2の空間領域、又は、前記他のいずれかのリンク、当該リンクに関する第1の空間領域若しくは第2の空間領域のいずれか一方は、目標関節角度に基づいて算出され、他方は、前記スレーブロボットの各前記関節における現在関節角度に基づいて算出される、ロボット制御プログラム。 - マスタ装置を介して取得されたユーザ姿勢に追従し、かつ、1又は複数の関節と複数のリンクを備えたスレーブロボットを制御するロボット制御システムであって、
前記スレーブロボットの前記リンクのうちの一のリンクを包含するように構成された第1の空間領域が、他のいずれかのリンク又は当該リンクに関する第1の空間領域に干渉するか否かを判定する、第1干渉判定部と、
前記第1干渉判定部において干渉有りと判定される場合には、前記スレーブロボットの動作制御部へとフェールセーフ信号を提供する、フェールセーフ信号提供部と、
前記リンクのうちの一のリンクを包含しかつ対応する第1の空間領域と一致するか又は包含するように構成された第2の空間領域が、他のいずれかのリンク、当該リンクに関する第1の空間領域又は第2の空間領域に干渉するか否かを判定する、第2干渉判定部と、
前記第2干渉判定部において干渉無しと判定される場合には、前記ユーザ姿勢に対応する前記スレーブロボットの各前記関節における目標関節角度を前記スレーブロボットの前記動作制御部へと提供し、前記第2干渉判定部において干渉有りと判定される場合には、前記目標関節角度を前記スレーブロボットの前記動作制御部へと提供しない、目標関節角度提供部と、を備え、
前記第2干渉判定部において干渉判定される、前記一のリンクに係る前記第2の空間領域、又は、前記他のいずれかのリンク、当該リンクに関する第1の空間領域若しくは第2の空間領域のいずれも、前記目標関節角度に基づいて算出される、ロボット制御システム。 - マスタ装置を介して取得されたユーザ姿勢に追従し、かつ、1又は複数の関節と複数のリンクを備えたスレーブロボットを制御するロボット制御方法であって、
前記スレーブロボットの前記リンクのうちの一のリンクを包含するように構成された第1の空間領域が、他のいずれかのリンク又は当該リンクに関する第1の空間領域に干渉するか否かを判定する、第1干渉判定ステップと、
前記第1干渉判定ステップにおいて干渉有りと判定される場合には、前記スレーブロボットの動作制御部へとフェールセーフ信号を提供する、フェールセーフ信号提供ステップと、
前記リンクのうちの一のリンクを包含しかつ対応する第1の空間領域と一致するか又は包含するように構成された第2の空間領域が、他のいずれかのリンク、当該リンクに関する第1の空間領域又は第2の空間領域に干渉するか否かを判定する、第2干渉判定ステップと、
前記第2干渉判定ステップにおいて干渉無しと判定される場合には、前記ユーザ姿勢に対応する前記スレーブロボットの各前記関節における目標関節角度を前記スレーブロボットの前記動作制御部へと提供し、前記第2干渉判定ステップにおいて干渉有りと判定される場合には、前記目標関節角度を前記スレーブロボットの前記動作制御部へと提供しない、目標関節角度提供ステップと、
前記第2干渉判定ステップにおいて干渉判定される、前記一のリンクに係る前記第2の空間領域、又は、前記他のいずれかのリンク、当該リンクに関する第1の空間領域若しくは第2の空間領域のいずれも、前記目標関節角度に基づいて算出される、ロボット制御方法。 - マスタ装置を介して取得されたユーザ姿勢に追従し、かつ、1又は複数の関節と複数のリンクを備えたスレーブロボットを制御するロボット制御プログラムであって、
前記スレーブロボットの前記リンクのうちの一のリンクを包含するように構成された第1の空間領域が、他のいずれかのリンク又は当該リンクに関する第1の空間領域に干渉するか否かを判定する、第1干渉判定ステップと、
前記第1干渉判定ステップにおいて干渉有りと判定される場合には、前記スレーブロボットの動作制御部へとフェールセーフ信号を提供する、フェールセーフ信号提供ステップと、
前記リンクのうちの一のリンクを包含しかつ対応する第1の空間領域と一致するか又は包含するように構成された第2の空間領域が、他のいずれかのリンク、当該リンクに関する第1の空間領域又は第2の空間領域に干渉するか否かを判定する、第2干渉判定ステップと、
前記第2干渉判定ステップにおいて干渉無しと判定される場合には、前記ユーザ姿勢に対応する前記スレーブロボットの各前記関節における目標関節角度を前記スレーブロボットの前記動作制御部へと提供し、前記第2干渉判定ステップにおいて干渉有りと判定される場合には、前記目標関節角度を前記スレーブロボットの前記動作制御部へと提供しない、目標関節角度提供ステップと、を備え、
前記第2干渉判定ステップにおいて干渉判定される、前記一のリンクに係る前記第2の空間領域、又は、前記他のいずれかのリンク、当該リンクに関する第1の空間領域若しくは第2の空間領域のいずれも、前記目標関節角度に基づいて算出される、ロボット制御プログラム。 - マスタ装置を介して取得されたユーザ姿勢に追従し、かつ、1又は複数の関節と複数のリンクを備えたスレーブロボットを制御するロボット制御システムであって、
前記スレーブロボットの前記リンクのうちの一のリンクを包含するように構成された第1の空間領域が、他のいずれかのリンク又は当該リンクに関する第1の空間領域に干渉するか否かを判定する、第1干渉判定部と、
前記第1干渉判定部において干渉有りと判定される場合には、前記スレーブロボットの動作制御部へとフェールセーフ信号を提供する、フェールセーフ信号提供部と、
前記リンクのうちの一のリンクを包含しかつ対応する第1の空間領域と一致するか又は包含するように構成された第2の空間領域が、他のいずれかのリンク、当該リンクに関する第1の空間領域又は第2の空間領域に干渉するか否かを判定する、第2干渉判定部と、
前記第2干渉判定部において干渉無しと判定される場合には、前記ユーザ姿勢に対応する前記スレーブロボットの各前記関節における目標関節角度を前記スレーブロボットの前記動作制御部へと提供し、前記第2干渉判定部において干渉有りと判定される場合には、前記目標関節角度を前記スレーブロボットの前記動作制御部へと提供しない、目標関節角度提供部と、
現在の関節角度から前記目標関節角度へと至る過程の一又は複数の中間姿勢における中間姿勢関節角度を生成する、中間関節角度生成部と、を備え、
前記第2干渉判定部は、さらに、
前記中間姿勢関節角度のそれぞれに基づいて、前記リンクのうちの一のリンクに関する第2の空間領域が、他のいずれかのリンク、当該リンクに関する第1の空間領域又は第2の空間領域に干渉するか否かを判定する、中間姿勢判定部、を備える、ロボット制御システム。 - マスタ装置を介して取得されたユーザ姿勢に追従し、かつ、1又は複数の関節と複数のリンクを備えたスレーブロボットを制御するロボット制御方法であって、
前記スレーブロボットの前記リンクのうちの一のリンクを包含するように構成された第1の空間領域が、他のいずれかのリンク又は当該リンクに関する第1の空間領域に干渉するか否かを判定する、第1干渉判定ステップと、
前記第1干渉判定ステップにおいて干渉有りと判定される場合には、前記スレーブロボットの動作制御部へとフェールセーフ信号を提供する、フェールセーフ信号提供ステップと、
前記リンクのうちの一のリンクを包含しかつ対応する第1の空間領域と一致するか又は包含するように構成された第2の空間領域が、他のいずれかのリンク、当該リンクに関する第1の空間領域又は第2の空間領域に干渉するか否かを判定する、第2干渉判定ステップと、
前記第2干渉判定ステップにおいて干渉無しと判定される場合には、前記ユーザ姿勢に対応する前記スレーブロボットの各前記関節における目標関節角度を前記スレーブロボットの前記動作制御部へと提供し、前記第2干渉判定ステップにおいて干渉有りと判定される場合には、前記目標関節角度を前記スレーブロボットの前記動作制御部へと提供しない、目標関節角度提供ステップと、
現在の関節角度から前記目標関節角度へと至る過程の一又は複数の中間姿勢における中間姿勢関節角度を生成する、中間関節角度生成ステップと、を備え、
前記第2干渉判定ステップは、さらに、
前記中間姿勢関節角度のそれぞれに基づいて、前記リンクのうちの一のリンクに関する第2の空間領域が、他のいずれかのリンク、当該リンクに関する第1の空間領域又は第2の空間領域に干渉するか否かを判定する、中間姿勢判定ステップ、を備える、ロボット制御方法。 - マスタ装置を介して取得されたユーザ姿勢に追従し、かつ、1又は複数の関節と複数のリンクを備えたスレーブロボットを制御するロボット制御プログラムであって、
前記スレーブロボットの前記リンクのうちの一のリンクを包含するように構成された第1の空間領域が、他のいずれかのリンク又は当該リンクに関する第1の空間領域に干渉するか否かを判定する、第1干渉判定ステップと、
前記第1干渉判定ステップにおいて干渉有りと判定される場合には、前記スレーブロボットの動作制御部へとフェールセーフ信号を提供する、フェールセーフ信号提供ステップと、
前記リンクのうちの一のリンクを包含しかつ対応する第1の空間領域と一致するか又は包含するように構成された第2の空間領域が、他のいずれかのリンク、当該リンクに関する第1の空間領域又は第2の空間領域に干渉するか否かを判定する、第2干渉判定ステップと、
前記第2干渉判定ステップにおいて干渉無しと判定される場合には、前記ユーザ姿勢に対応する前記スレーブロボットの各前記関節における目標関節角度を前記スレーブロボットの前記動作制御部へと提供し、前記第2干渉判定ステップにおいて干渉有りと判定される場合には、前記目標関節角度を前記スレーブロボットの前記動作制御部へと提供しない、目標関節角度提供ステップと、
現在の関節角度から前記目標関節角度へと至る過程の一又は複数の中間姿勢における中間姿勢関節角度を生成する、中間関節角度生成ステップと、を備え、
前記第2干渉判定ステップは、さらに、
前記中間姿勢関節角度のそれぞれに基づいて、前記リンクのうちの一のリンクに関する第2の空間領域が、他のいずれかのリンク、当該リンクに関する第1の空間領域又は第2の空間領域に干渉するか否かを判定する、中間姿勢判定ステップ、を備える、ロボット制御プログラム。 - マスタ装置を介して取得されたユーザ姿勢に追従し、かつ、1又は複数の関節と複数のリンクを備えたスレーブロボットを制御するロボット制御システムであって、
前記スレーブロボットの前記リンクのうちの一のリンクを包含するように構成された第1の空間領域が、他のいずれかのリンク又は当該リンクに関する第1の空間領域に干渉するか否かを判定する、第1干渉判定部と、
前記第1干渉判定部において干渉有りと判定される場合には、前記スレーブロボットの動作制御部へとフェールセーフ信号を提供する、フェールセーフ信号提供部と、
前記リンクのうちの一のリンクを包含しかつ対応する第1の空間領域と一致するか又は包含するように構成された第2の空間領域が、他のいずれかのリンク、当該リンクに関する第1の空間領域又は第2の空間領域に干渉するか否かを判定する、第2干渉判定部と、
前記第2干渉判定部において干渉無しと判定される場合には、前記ユーザ姿勢に対応する前記スレーブロボットの各前記関節における目標関節角度を前記スレーブロボットの前記動作制御部へと提供し、前記第2干渉判定部において干渉有りと判定される場合には、前記目標関節角度を前記スレーブロボットの前記動作制御部へと提供しない、目標関節角度提供部と、を備え、
前記第1干渉判定部における前記判定は、前記リンク又は前記リンクに関する第1の空間領域に対応する3次元モデル同士の干渉判定を行うことにより行われ、
前記第1干渉判定部は、さらに、
判定対象となる前記リンク又は前記リンクに関する第1の空間領域に対応する境界ボリューム同士の干渉を判定する、第1境界ボリューム判定部と、
前記第1境界ボリューム判定部において干渉有りと判断された場合に、前記リンク又は前記リンクに関する第1の空間領域の表面間の干渉を判定する、第1表面干渉判定部と、を備える、ロボット制御システム。 - マスタ装置を介して取得されたユーザ姿勢に追従し、かつ、1又は複数の関節と複数のリンクを備えたスレーブロボットを制御するロボット制御方法であって、
前記スレーブロボットの前記リンクのうちの一のリンクを包含するように構成された第1の空間領域が、他のいずれかのリンク又は当該リンクに関する第1の空間領域に干渉するか否かを判定する、第1干渉判定ステップと、
前記第1干渉判定ステップにおいて干渉有りと判定される場合には、前記スレーブロボットの動作制御部へとフェールセーフ信号を提供する、フェールセーフ信号提供ステップと、
前記リンクのうちの一のリンクを包含しかつ対応する第1の空間領域と一致するか又は包含するように構成された第2の空間領域が、他のいずれかのリンク、当該リンクに関する第1の空間領域又は第2の空間領域に干渉するか否かを判定する、第2干渉判定ステップと、
前記第2干渉判定ステップにおいて干渉無しと判定される場合には、前記ユーザ姿勢に対応する前記スレーブロボットの各前記関節における目標関節角度を前記スレーブロボットの前記動作制御部へと提供し、前記第2干渉判定ステップにおいて干渉有りと判定される場合には、前記目標関節角度を前記スレーブロボットの前記動作制御部へと提供しない、目標関節角度提供ステップと、を備え、
前記第1干渉判定ステップにおける前記判定は、前記リンク又は前記リンクに関する第1の空間領域に対応する3次元モデル同士の干渉判定を行うことにより行われ、
前記第1干渉判定ステップは、さらに、
判定対象となる前記リンク又は前記リンクに関する第1の空間領域に対応する境界ボリューム同士の干渉を判定する、第1境界ボリューム判定ステップと、
前記第1境界ボリューム判定ステップにおいて干渉有りと判断された場合に、前記リンク又は前記リンクに関する第1の空間領域の表面間の干渉を判定する、第1表面干渉判定ステップと、を備える、ロボット制御方法。 - マスタ装置を介して取得されたユーザ姿勢に追従し、かつ、1又は複数の関節と複数のリンクを備えたスレーブロボットを制御するロボット制御プログラムであって、
前記スレーブロボットの前記リンクのうちの一のリンクを包含するように構成された第1の空間領域が、他のいずれかのリンク又は当該リンクに関する第1の空間領域に干渉するか否かを判定する、第1干渉判定ステップと、
前記第1干渉判定ステップにおいて干渉有りと判定される場合には、前記スレーブロボットの動作制御部へとフェールセーフ信号を提供する、フェールセーフ信号提供ステップと、
前記リンクのうちの一のリンクを包含しかつ対応する第1の空間領域と一致するか又は包含するように構成された第2の空間領域が、他のいずれかのリンク、当該リンクに関する第1の空間領域又は第2の空間領域に干渉するか否かを判定する、第2干渉判定ステップと、
前記第2干渉判定ステップにおいて干渉無しと判定される場合には、前記ユーザ姿勢に対応する前記スレーブロボットの各前記関節における目標関節角度を前記スレーブロボットの前記動作制御部へと提供し、前記第2干渉判定ステップにおいて干渉有りと判定される場合には、前記目標関節角度を前記スレーブロボットの前記動作制御部へと提供しない、目標関節角度提供ステップと、を備え、
前記第1干渉判定ステップにおける前記判定は、前記リンク又は前記リンクに関する第1の空間領域に対応する3次元モデル同士の干渉判定を行うことにより行われ、
前記第1干渉判定ステップは、さらに、
判定対象となる前記リンク又は前記リンクに関する第1の空間領域に対応する境界ボリューム同士の干渉を判定する、第1境界ボリューム判定ステップと、
前記第1境界ボリューム判定ステップにおいて干渉有りと判断された場合に、前記リンク又は前記リンクに関する第1の空間領域の表面間の干渉を判定する、第1表面干渉判定ステップと、を備える、ロボット制御プログラム。 - マスタ装置を介して取得されたユーザ姿勢に追従し、かつ、1又は複数の関節と複数のリンクを備えたスレーブロボットを制御するロボット制御システムであって、
前記スレーブロボットの前記リンクのうちの一のリンクを包含するように構成された第1の空間領域が、他のいずれかのリンク又は当該リンクに関する第1の空間領域に干渉するか否かを判定する、第1干渉判定部と、
前記第1干渉判定部において干渉有りと判定される場合には、前記スレーブロボットの動作制御部へとフェールセーフ信号を提供する、フェールセーフ信号提供部と、
前記リンクのうちの一のリンクを包含しかつ対応する第1の空間領域と一致するか又は包含するように構成された第2の空間領域が、他のいずれかのリンク、当該リンクに関する第1の空間領域又は第2の空間領域に干渉するか否かを判定する、第2干渉判定部と、
前記第2干渉判定部において干渉無しと判定される場合には、前記ユーザ姿勢に対応する前記スレーブロボットの各前記関節における目標関節角度を前記スレーブロボットの前記動作制御部へと提供し、前記第2干渉判定部において干渉有りと判定される場合には、前記目標関節角度を前記スレーブロボットの前記動作制御部へと提供しない、目標関節角度提供部と、を備え、
前記第2干渉判定部における前記判定は、前記リンク、前記リンクに関する第1の空間領域又は第2の空間領域に対応する3次元モデル同士の干渉判定を行うことにより行われ、
前記第2干渉判定部は、
判定対象となる前記リンク、前記リンクに関する第1の空間領域又は第2の空間領域に対応する境界ボリューム同士の干渉を判定する、第2境界ボリューム判定部と、
前記第2境界ボリューム判定部において干渉有りと判断された場合に、前記リンク、前記リンクに関する第1の空間領域又は前記第2の空間領域の表面間の干渉を判定する、第2表面干渉判定部と、を備える、ロボット制御システム。 - マスタ装置を介して取得されたユーザ姿勢に追従し、かつ、1又は複数の関節と複数のリンクを備えたスレーブロボットを制御するロボット制御方法であって、
前記スレーブロボットの前記リンクのうちの一のリンクを包含するように構成された第1の空間領域が、他のいずれかのリンク又は当該リンクに関する第1の空間領域に干渉するか否かを判定する、第1干渉判定ステップと、
前記第1干渉判定ステップにおいて干渉有りと判定される場合には、前記スレーブロボットの動作制御部へとフェールセーフ信号を提供する、フェールセーフ信号提供ステップと、
前記リンクのうちの一のリンクを包含しかつ対応する第1の空間領域と一致するか又は包含するように構成された第2の空間領域が、他のいずれかのリンク、当該リンクに関する第1の空間領域又は第2の空間領域に干渉するか否かを判定する、第2干渉判定ステップと、
前記第2干渉判定ステップにおいて干渉無しと判定される場合には、前記ユーザ姿勢に対応する前記スレーブロボットの各前記関節における目標関節角度を前記スレーブロボットの前記動作制御部へと提供し、前記第2干渉判定ステップにおいて干渉有りと判定される場合には、前記目標関節角度を前記スレーブロボットの前記動作制御部へと提供しない、目標関節角度提供ステップと、を備え、
前記第2干渉判定ステップにおける前記判定は、前記リンク、前記リンクに関する第1の空間領域又は第2の空間領域に対応する3次元モデル同士の干渉判定を行うことにより行われ、
前記第2干渉判定ステップは、
判定対象となる前記リンク、前記リンクに関する第1の空間領域又は第2の空間領域に対応する境界ボリューム同士の干渉を判定する、第2境界ボリューム判定ステップと、
前記第2境界ボリューム判定ステップにおいて干渉有りと判断された場合に、前記リンク、前記リンクに関する第1の空間領域又は前記第2の空間領域の表面間の干渉を判定する、第2表面干渉判定ステップと、を備える、ロボット制御方法。 - マスタ装置を介して取得されたユーザ姿勢に追従し、かつ、1又は複数の関節と複数のリンクを備えたスレーブロボットを制御するロボット制御プログラムであって、
前記スレーブロボットの前記リンクのうちの一のリンクを包含するように構成された第1の空間領域が、他のいずれかのリンク又は当該リンクに関する第1の空間領域に干渉するか否かを判定する、第1干渉判定ステップと、
前記第1干渉判定ステップにおいて干渉有りと判定される場合には、前記スレーブロボットの動作制御部へとフェールセーフ信号を提供する、フェールセーフ信号提供ステップと、
前記リンクのうちの一のリンクを包含しかつ対応する第1の空間領域と一致するか又は包含するように構成された第2の空間領域が、他のいずれかのリンク、当該リンクに関する第1の空間領域又は第2の空間領域に干渉するか否かを判定する、第2干渉判定ステップと、
前記第2干渉判定ステップにおいて干渉無しと判定される場合には、前記ユーザ姿勢に対応する前記スレーブロボットの各前記関節における目標関節角度を前記スレーブロボットの前記動作制御部へと提供し、前記第2干渉判定ステップにおいて干渉有りと判定される場合には、前記目標関節角度を前記スレーブロボットの前記動作制御部へと提供しない、目標関節角度提供ステップと、を備え、
前記第2干渉判定ステップにおける前記判定は、前記リンク、前記リンクに関する第1の空間領域又は第2の空間領域に対応する3次元モデル同士の干渉判定を行うことにより行われ、
前記第2干渉判定ステップは、
判定対象となる前記リンク、前記リンクに関する第1の空間領域又は第2の空間領域に対応する境界ボリューム同士の干渉を判定する、第2境界ボリューム判定ステップと、
前記第2境界ボリューム判定ステップにおいて干渉有りと判断された場合に、前記リンク、前記リンクに関する第1の空間領域又は前記第2の空間領域の表面間の干渉を判定する、第2表面干渉判定ステップと、を備える、ロボット制御プログラム。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2019134802A JP7357902B2 (ja) | 2019-07-22 | 2019-07-22 | ロボット制御システム、装置、方法及びプログラム |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2019134802A JP7357902B2 (ja) | 2019-07-22 | 2019-07-22 | ロボット制御システム、装置、方法及びプログラム |
Publications (2)
Publication Number | Publication Date |
---|---|
JP2021016924A JP2021016924A (ja) | 2021-02-15 |
JP7357902B2 true JP7357902B2 (ja) | 2023-10-10 |
Family
ID=74565740
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2019134802A Active JP7357902B2 (ja) | 2019-07-22 | 2019-07-22 | ロボット制御システム、装置、方法及びプログラム |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP7357902B2 (ja) |
Families Citing this family (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPWO2023119657A1 (ja) * | 2021-12-24 | 2023-06-29 |
Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2005046931A (ja) | 2003-07-30 | 2005-02-24 | National Institute Of Information & Communication Technology | ロボットアーム・ハンド操作制御方法、ロボットアーム・ハンド操作制御システム |
WO2018148181A1 (en) | 2017-02-07 | 2018-08-16 | Veo Robotics, Inc. | Workspace safety monitoring and equipment control |
JP6476358B1 (ja) | 2017-05-17 | 2019-02-27 | Telexistence株式会社 | 制御装置、ロボット制御方法及びロボット制御システム |
Family Cites Families (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPS5973289A (ja) * | 1982-10-15 | 1984-04-25 | 松下電器産業株式会社 | 多関節ロボツトの制御方法 |
-
2019
- 2019-07-22 JP JP2019134802A patent/JP7357902B2/ja active Active
Patent Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2005046931A (ja) | 2003-07-30 | 2005-02-24 | National Institute Of Information & Communication Technology | ロボットアーム・ハンド操作制御方法、ロボットアーム・ハンド操作制御システム |
WO2018148181A1 (en) | 2017-02-07 | 2018-08-16 | Veo Robotics, Inc. | Workspace safety monitoring and equipment control |
JP6476358B1 (ja) | 2017-05-17 | 2019-02-27 | Telexistence株式会社 | 制御装置、ロボット制御方法及びロボット制御システム |
Also Published As
Publication number | Publication date |
---|---|
JP2021016924A (ja) | 2021-02-15 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US8977392B2 (en) | Robot control device, robot control method, robot control program, and robot system | |
US20200249654A1 (en) | Robotic control via a virtual world simulation | |
CN108883533A (zh) | 机器人控制 | |
EP2660013B1 (en) | Method of controlling seven-shaft multi-joint robot, control program, and robot control device | |
WO2019059364A1 (ja) | 遠隔制御マニピュレータシステムおよび制御装置 | |
Tadakuma et al. | Development of anthropomorphic multi-DOF master-slave arm for mutual telexistence | |
JP2018030210A (ja) | シミュレーション装置、制御システム、ロボットシステム、シミュレーション方法、プログラム及び記録媒体 | |
JP7357902B2 (ja) | ロボット制御システム、装置、方法及びプログラム | |
JP2015174184A (ja) | 制御装置 | |
JP5927270B2 (ja) | ロボットシミュレーション装置 | |
US20220105627A1 (en) | Singularity-free kinematic parameterization of soft robot manipulators | |
Gienger et al. | Exploiting task intervals for whole body robot control | |
JP5776486B2 (ja) | ロボット制御装置、その制御方法及びプログラム | |
Ueberle et al. | Design and control concepts of a hyper redundant haptic interface for interaction with virtual environments | |
US20220101477A1 (en) | Visual Interface And Communications Techniques For Use With Robots | |
JP2020075329A (ja) | シミュレーション装置、制御システム、ロボットシステム、シミュレーション方法、プログラム及び記録媒体 | |
Riadchykov et al. | Constructive solution of the robotic chassis AnyWalker | |
Hazem et al. | Joint Control Implementation of 4-DOF Robotic Arm Using Robot Operating System | |
Sabater et al. | Magister-P; a 6-URS parallel haptic device with open control architecture | |
WO2023203635A1 (ja) | ロボット装置の動作状態を算出するシミュレーション装置 | |
JP2024023104A (ja) | ロボット制御システム、装置、方法及びプログラム | |
JP2003300188A (ja) | 触覚インターフェイス及びその制御方法 | |
KR102332131B1 (ko) | 최소 영공간 작업의 매개변수화 방법 | |
WO2023037550A1 (ja) | ロボット、ロボットシステム、制御方法及びプログラム | |
CN116551692A (zh) | 一种基于特殊力矩的机器人阻抗控制方法、装置和设备 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A821 Effective date: 20190724 |
|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20220404 |
|
A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20230222 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20230315 |
|
A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20230511 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20230621 |
|
A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20230731 |
|
TRDD | Decision of grant or rejection written | ||
A01 | Written decision to grant a patent or to grant a registration (utility model) |
Free format text: JAPANESE INTERMEDIATE CODE: A01 Effective date: 20230823 |
|
A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20230920 |
|
R150 | Certificate of patent or registration of utility model |
Ref document number: 7357902 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R150 |