JP2023552991A - 複合ロボットの制御方法、装置及びシステム - Google Patents
複合ロボットの制御方法、装置及びシステム Download PDFInfo
- Publication number
- JP2023552991A JP2023552991A JP2023533806A JP2023533806A JP2023552991A JP 2023552991 A JP2023552991 A JP 2023552991A JP 2023533806 A JP2023533806 A JP 2023533806A JP 2023533806 A JP2023533806 A JP 2023533806A JP 2023552991 A JP2023552991 A JP 2023552991A
- Authority
- JP
- Japan
- Prior art keywords
- robot arm
- displacement value
- robot
- moments
- forces
- 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.)
- Pending
Links
- 238000000034 method Methods 0.000 title claims abstract description 101
- 239000002131 composite material Substances 0.000 title claims abstract description 54
- 238000006073 displacement reaction Methods 0.000 claims abstract description 123
- 230000007246 mechanism Effects 0.000 claims abstract description 88
- 238000005457 optimization Methods 0.000 claims abstract description 18
- 238000004364 calculation method Methods 0.000 claims abstract description 14
- 238000003825 pressing Methods 0.000 claims description 18
- 230000004044 response Effects 0.000 claims description 9
- 150000001875 compounds Chemical class 0.000 claims description 8
- 238000003860 storage Methods 0.000 claims description 8
- 238000006243 chemical reaction Methods 0.000 claims description 3
- 238000010586 diagram Methods 0.000 abstract description 5
- 230000008859 change Effects 0.000 description 8
- 230000003993 interaction Effects 0.000 description 8
- 230000008878 coupling Effects 0.000 description 7
- 238000010168 coupling process Methods 0.000 description 7
- 238000005859 coupling reaction Methods 0.000 description 7
- 230000000694 effects Effects 0.000 description 7
- 230000006870 function Effects 0.000 description 4
- 230000008569 process Effects 0.000 description 4
- 210000001217 buttock Anatomy 0.000 description 3
- 238000004422 calculation algorithm Methods 0.000 description 3
- 230000001351 cycling effect Effects 0.000 description 3
- 238000013016 damping Methods 0.000 description 3
- 230000009467 reduction Effects 0.000 description 3
- 230000007423 decrease Effects 0.000 description 2
- 230000003247 decreasing effect Effects 0.000 description 2
- 239000003814 drug Substances 0.000 description 2
- 241000282412 Homo Species 0.000 description 1
- 230000001133 acceleration Effects 0.000 description 1
- 238000013459 approach Methods 0.000 description 1
- 238000004590 computer program Methods 0.000 description 1
- 230000014509 gene expression Effects 0.000 description 1
- 238000003306 harvesting Methods 0.000 description 1
- 238000009776 industrial production Methods 0.000 description 1
- 230000010354 integration Effects 0.000 description 1
- 230000003287 optical effect Effects 0.000 description 1
- 238000011084 recovery Methods 0.000 description 1
- 230000002441 reversible effect Effects 0.000 description 1
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1628—Programme controls characterised by the control loop
- B25J9/1633—Programme controls characterised by the control loop compliant, force, torque control, e.g. combined with position control
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1694—Programme controls characterised by use of sensors other than normal servo-feedback from position, speed or acceleration sensors, perception control, multi-sensor controlled systems, sensor fusion
-
- A—HUMAN NECESSITIES
- A61—MEDICAL OR VETERINARY SCIENCE; HYGIENE
- A61H—PHYSICAL THERAPY APPARATUS, e.g. DEVICES FOR LOCATING OR STIMULATING REFLEX POINTS IN THE BODY; ARTIFICIAL RESPIRATION; MASSAGE; BATHING DEVICES FOR SPECIAL THERAPEUTIC OR HYGIENIC PURPOSES OR SPECIFIC PARTS OF THE BODY
- A61H7/00—Devices for suction-kneading massage; Devices for massaging the skin by rubbing or brushing not otherwise provided for
- A61H7/002—Devices for suction-kneading massage; Devices for massaging the skin by rubbing or brushing not otherwise provided for by rubbing or brushing
- A61H7/004—Devices for suction-kneading massage; Devices for massaging the skin by rubbing or brushing not otherwise provided for by rubbing or brushing power-driven, e.g. electrical
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J11/00—Manipulators not otherwise provided for
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J13/00—Controls for manipulators
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J13/00—Controls for manipulators
- B25J13/08—Controls for manipulators by means of sensing devices, e.g. viewing or touching devices
- B25J13/085—Force or torque sensors
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J19/00—Accessories fitted to manipulators, e.g. for monitoring, for viewing; Safety devices combined with or specially adapted for use in connection with manipulators
-
- A—HUMAN NECESSITIES
- A61—MEDICAL OR VETERINARY SCIENCE; HYGIENE
- A61H—PHYSICAL THERAPY APPARATUS, e.g. DEVICES FOR LOCATING OR STIMULATING REFLEX POINTS IN THE BODY; ARTIFICIAL RESPIRATION; MASSAGE; BATHING DEVICES FOR SPECIAL THERAPEUTIC OR HYGIENIC PURPOSES OR SPECIFIC PARTS OF THE BODY
- A61H2201/00—Characteristics of apparatus not provided for in the preceding codes
- A61H2201/16—Physical interface with patient
- A61H2201/1657—Movement of interface, i.e. force application means
- A61H2201/1659—Free spatial automatic movement of interface within a working area, e.g. Robot
-
- A—HUMAN NECESSITIES
- A61—MEDICAL OR VETERINARY SCIENCE; HYGIENE
- A61H—PHYSICAL THERAPY APPARATUS, e.g. DEVICES FOR LOCATING OR STIMULATING REFLEX POINTS IN THE BODY; ARTIFICIAL RESPIRATION; MASSAGE; BATHING DEVICES FOR SPECIAL THERAPEUTIC OR HYGIENIC PURPOSES OR SPECIFIC PARTS OF THE BODY
- A61H2201/00—Characteristics of apparatus not provided for in the preceding codes
- A61H2201/50—Control means thereof
- A61H2201/5058—Sensors or detectors
- A61H2201/5061—Force sensors
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B2219/00—Program-control systems
- G05B2219/30—Nc systems
- G05B2219/39—Robotics, robotics to robotics hand
- G05B2219/39338—Impedance control, also mechanical
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B2219/00—Program-control systems
- G05B2219/30—Nc systems
- G05B2219/39—Robotics, robotics to robotics hand
- G05B2219/39339—Admittance control, admittance is tip speed-force
Landscapes
- Engineering & Computer Science (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Health & Medical Sciences (AREA)
- Dermatology (AREA)
- Epidemiology (AREA)
- Pain & Pain Management (AREA)
- Physical Education & Sports Medicine (AREA)
- Rehabilitation Therapy (AREA)
- Life Sciences & Earth Sciences (AREA)
- Animal Behavior & Ethology (AREA)
- General Health & Medical Sciences (AREA)
- Public Health (AREA)
- Veterinary Medicine (AREA)
- Human Computer Interaction (AREA)
- Manipulator (AREA)
- Control Of Position Or Direction (AREA)
Abstract
本明細書は、複合ロボットの制御方法、装置及びシステムを開示する。複合ロボットの制御方法は、複合ロボットのロボットアームにおけるコントローラに適用され、ロボットアームは、運動機構に取り付けられ、ロボットアームには、力センサが取り付けられており、コントローラは、運動機構に通信接続され、該方法は、ロボットアームが牽引されて運動している場合、現在の運動における力センサにより採取された複数の力及び複数のモーメントを取得することと、複数の力及び複数のモーメント、プリセット所望の力及びモーメント、並びにプリセットモデルに応じて計算を行い、複数グループの変位値を得ることと、複数グループの変位値に応じて最適化求解を行い、ロボットアームに対応する第1の目標変位値及び運動機構に対応する第2の目標変位値を得ることと、第1の目標変位値及び第2の目標変位値に応じてロボットアーム及び運動機構の運動を制御することと、現在の運動における複数の力及び複数のモーメントを取得する操作を、ロボットアーム及び運動機構が運動を停止するまで繰り返し実行することと、を含む。【選択図】図1
Description
本願は、2021年10月18日に中国専利局に出願された、出願番号が202111209630.6である中国特許出願の優先権を主張し、該出願の全ての内容は引用により本願に組み込まれている。
本願は、知能制御の技術分野に関し、例えば複合ロボットの制御方法、装置及びシステムに関する。
複合ロボットは、新世代のロボットの代表として、工業、移動、協働ロボットの利点を1台にまとめ、ヒューマンマシンが統合され、安全で使いやすく、高感度で精確で、柔軟で汎用的であるなどの特徴を有し、伝統ロボットの動作モードを変え、工業生産、社会サービス、リハビリテーション医療、特殊作業などの分野において幅広く適用される見込みがあり、既に将来ロボットの発展をリードする重要な方向となっている。リハビリテーション医療の分野において、マッサージ師の代わりにロボットを使用してマッサージを行う事例又は製品が多くある。しかし、主流複合ロボット又は移動ロボットアームは、往々にしてロボットアーム及び移動シャーシをそれぞれ個別に制御しており、複合ロボットの性能の強みが十分に発揮できず、マッサージロボットの適用も制限されている。複合ロボットの力・位置のハイブリッド制御において、タスク空間は、位置及び力がいずれも任意の所定方向に沿って制御不可であるため、位置制御及び力制御のサブ空間に分けられ、一般的には、垂直面方向において力制御を行い、断面方向において位置制御を行っており、人が自由に複合ロボットを牽引することが容易ではない。
本願は、ロボットアームと運動機構との間の動的結合を実現可能であり、複合ロボットをドラッグしているときに小さな力だけでロボットの柔軟追随を完成させ、且つドラッグ効果をヒューマンマシンインタラクションのニーズにより適合させることができる複合ロボットの制御方法、装置及びシステムを提供する。
本願は、複合ロボットのロボットアームにおけるコントローラに適用され、ロボットアームは、運動機構に取り付けられ、ロボットアームには、力センサが取り付けられており、コントローラは、運動機構に通信接続され、
ロボットアームが牽引されて運動しているときに、現在の運動における力センサにより採取された複数の力及び複数のモーメントを取得することと、
複数の力及び複数のモーメント、プリセット所望の力及びモーメント、並びにプリセットモデルに応じて計算を行い、複数グループの変位値を得て、そのうち、各グループの変位値が、ロボットアームに対応する第1の変位値及び運動機構に対応する第2の変位値を含み、プリセットモデルが、アドミタンスモデル又はインピーダンスモデルを含むことと、
複数グループの変位値に応じて最適化求解を行い、ロボットアームに対応する第1の目標変位値及び運動機構に対応する第2の目標変位値を得ることと、
第1の目標変位値及び第2の目標変位値に応じてロボットアーム及び運動機構の運動を制御することと、
現在の運動における力センサにより採取された複数の力及び複数のモーメントを取得する操作を、ロボットアーム及び運動機構が運動を停止するまで繰り返し実行することと、を含む複合ロボットの制御方法を提供する。
ロボットアームが牽引されて運動しているときに、現在の運動における力センサにより採取された複数の力及び複数のモーメントを取得することと、
複数の力及び複数のモーメント、プリセット所望の力及びモーメント、並びにプリセットモデルに応じて計算を行い、複数グループの変位値を得て、そのうち、各グループの変位値が、ロボットアームに対応する第1の変位値及び運動機構に対応する第2の変位値を含み、プリセットモデルが、アドミタンスモデル又はインピーダンスモデルを含むことと、
複数グループの変位値に応じて最適化求解を行い、ロボットアームに対応する第1の目標変位値及び運動機構に対応する第2の目標変位値を得ることと、
第1の目標変位値及び第2の目標変位値に応じてロボットアーム及び運動機構の運動を制御することと、
現在の運動における力センサにより採取された複数の力及び複数のモーメントを取得する操作を、ロボットアーム及び運動機構が運動を停止するまで繰り返し実行することと、を含む複合ロボットの制御方法を提供する。
本願は、複合ロボットのロボットアームにおけるコントローラに適用され、ロボットアームは、運動機構に取り付けられ、ロボットアームには、力センサが取り付けられており、コントローラは、運動機構に通信接続され、
ロボットアームが牽引されて運動しているときに、現在の運動における力センサにより採取された複数の力及び複数のモーメントを取得するように構成されるモーメント取得モジュールと、
複数の力及び複数のモーメント、プリセット所望の力及びモーメント、並びにプリセットモデルに応じて計算を行い、複数グループの変位値を得て、そのうち、各グループの変位値が、ロボットアームに対応する第1の変位値及び運動機構に対応する第2の変位値を含み、プリセットモデルが、アドミタンスモデル又はインピーダンスモデルを含むように構成される変位計算モジュールと、
複数グループの変位値に応じて最適化求解を行い、ロボットアームに対応する第1の目標変位値及び運動機構に対応する第2の目標変位値を得るように構成される目標変位決定モジュールと、
第1の目標変位値及び第2の目標変位値に応じてロボットアーム及び運動機構の運動を制御するように構成される運動制御モジュールと、
現在の運動における力センサにより採取された複数の力及び複数のモーメントを取得する操作を、ロボットアーム及び運動機構が運動を停止するまで繰り返し実行するように構成される循環モジュールと、を備える複合ロボットの制御装置をさらに提供する。
ロボットアームが牽引されて運動しているときに、現在の運動における力センサにより採取された複数の力及び複数のモーメントを取得するように構成されるモーメント取得モジュールと、
複数の力及び複数のモーメント、プリセット所望の力及びモーメント、並びにプリセットモデルに応じて計算を行い、複数グループの変位値を得て、そのうち、各グループの変位値が、ロボットアームに対応する第1の変位値及び運動機構に対応する第2の変位値を含み、プリセットモデルが、アドミタンスモデル又はインピーダンスモデルを含むように構成される変位計算モジュールと、
複数グループの変位値に応じて最適化求解を行い、ロボットアームに対応する第1の目標変位値及び運動機構に対応する第2の目標変位値を得るように構成される目標変位決定モジュールと、
第1の目標変位値及び第2の目標変位値に応じてロボットアーム及び運動機構の運動を制御するように構成される運動制御モジュールと、
現在の運動における力センサにより採取された複数の力及び複数のモーメントを取得する操作を、ロボットアーム及び運動機構が運動を停止するまで繰り返し実行するように構成される循環モジュールと、を備える複合ロボットの制御装置をさらに提供する。
本願は、複合ロボット及びマッサージプラットフォームを備え、複合ロボットは、マッサージプラットフォームに通信接続され、複合ロボットは、ロボットアーム及び運動機構を備え、ロボットアームには、コントローラ及び力センサが取り付けられており、ロボットアームは、運動機構に取り付けられ、コントローラは、運動機構に通信接続され、コントローラは、上記の複合ロボットの制御方法を実行するように構成される複合ロボットの制御システムをさらに提供する。
本願は、コンピュータ実行可能な命令が記憶されており、コンピュータ実行可能な命令は、プロセッサにより呼び出されて実行されると、プロセッサに上記の複合ロボットの制御方法を実現するように促すコンピュータ可読記憶媒体をさらに提供する。
以下、実施例を参照しながら本願の技術案を説明し、説明される実施例は、本願の一部の実施例である。
主流複合ロボット又は移動ロボットアームは、往々にしてロボットアーム及び移動シャーシをそれぞれ個別に制御しており、複合ロボットの性能の強みが十分に発揮できず、マッサージロボットの適用も制限され、複合ロボットの力・位置のハイブリッド制御において、タスク空間は、位置及び力がいずれも任意の所定方向に沿って制御不可であるため、位置制御及び力制御のサブ空間に分けられ、一般的には、垂直面方向において力制御を行い、断面方向において位置制御を行っており、上記力・位置のハイブリッド制御の方法では、機械手と環境との間の動的結合を考慮しておらず、人が自由に複合ロボットを牽引することが容易ではない。
本願の実施例は、ロボットアームと運動機構との間の動的結合を実現可能であり、複合ロボットをドラッグしているときに小さな力だけでロボットの柔軟追随を完成させ、且つドラッグ効果をヒューマンマシンインタラクションのニーズにより適合させることができる複合ロボットの制御方法、装置及びシステムを提供する。
本実施例を理解しやすくさせるために、まず、本願の実施例に開示される複合ロボットの制御方法について紹介する。
本願の実施例は、複合ロボットのロボットアームにおけるコントローラに適用される複合ロボットの制御方法を提供し、ロボットアームは、運動機構に取り付けられ、ロボットアームには、力センサが取り付けられており、コントローラは、運動機構に通信接続される。そのうち、ロボットアームの末端には、6次元力センサが追加装着され、運動機構は、自動搬送車(Automated Guided Vehicle、AGV)プラットフォームを使用可能である。
図1に示す複合ロボット制御方法のフローチャートを参照し、該方法は、以下を含む。
S102において、ロボットアームが牽引されて運動しているときに、現在の運動における力センサにより採取された複数の力及び複数のモーメントを取得する。
上記力センサは、ロボットアームの末端に取り付けられた6次元センサ、又はロボットアームの各関節箇所に取り付けられた関節センサを含む。例えば、ロボットアームの末端に取り付けられた6次元センサが使用される場合、ロボットアームが牽引されて運動しているときに、ロボットアームの末端に取り付けられた6次元力センサにより、ロボットアームの6つの自由度における力及びモーメント、即ちロボットアームの3つの並進運動自由度x、y、zにおける力、及び3つの回転運動自由度rx、ry、rzにおけるモーメントを精確に測定することが可能である。
S104において、複数の力及び複数のモーメント、プリセット所望の力及びモーメント、並びにプリセットモデルに応じて計算を行い、複数グループの変位値を得て、各グループの変位値が、ロボットアームに対応する第1の変位値及び運動機構に対応する第2の変位値を含み、プリセットモデルが、アドミタンスモデル又はインピーダンスモデルを含む。
プリセットモデルがアドミタンスモデルであり、力センサが6次元センサであるときに、上記複数の力及び複数のモーメントは、6つの自由度のうち、3つの並進運動自由度に対応する力及び3つの回転運動自由度に対応するモーメントを含み、図2に示すアドミタンス制御システムの構造図を参照し、そのうち、fdは、プリセット所望の力又はモーメントであり、fhは、実際に受けた力又はモーメントであり、fuは、力又はモーメント偏差値である。
6つの自由度のうち、3つの並進運動自由度に対応する力及び3つの回転運動自由度に対応するモーメント、並びにプリセット所望の力及びモーメントに応じて、力又はモーメント偏差値を決定し、力又はモーメント偏差値をアドミタンスモデルに入力して求解を行い、1グループのアドミタンス制御後の変位値を得て、6つの自由度のうち、3つの並進運動自由度に対応する力及び3つの回転運動自由度に対応するモーメント、該グループのアドミタンス制御後の変位値に応じて逆解を求めると、複数グループの変位値、即ち、1グループのアドミタンス制御後の変位値に応じて求められた逆解集合である
を得ることができる。該グループのアドミタンス制御後の変位値は、ロボットアームに対応する第1のアドミタンス制御後の変位値及び運動機構に対応する第2のアドミタンス制御後の変位値を含む。
を得ることができる。該グループのアドミタンス制御後の変位値は、ロボットアームに対応する第1のアドミタンス制御後の変位値及び運動機構に対応する第2のアドミタンス制御後の変位値を含む。
上記アドミタンスモデルは、以下の通りであり、
ここで、Mは、慣性係数であり、Kは、剛性係数であり、Bは、減衰係数であり、fは、所望のヒューマンマシンインタラクションの力又はモーメントと、実際のヒューマンマシンインタラクションの力又はモーメントとの偏差値であり、
は、アドミタンス制御後の変位値であり、
は、アドミタンス制御後の変位値の1次導関数であり、
は、アドミタンス制御後の変位値の2次導関数である。
ここで、Mは、慣性係数であり、Kは、剛性係数であり、Bは、減衰係数であり、fは、所望のヒューマンマシンインタラクションの力又はモーメントと、実際のヒューマンマシンインタラクションの力又はモーメントとの偏差値であり、
は、アドミタンス制御後の変位値であり、
は、アドミタンス制御後の変位値の1次導関数であり、
は、アドミタンス制御後の変位値の2次導関数である。
力センサ下方の取っ手が引き動かされているときに、アドミタンスモデルは、設定済みの慣性係数、剛性係数、減衰係数に応じて目標加速度を出力し、AGVセンサにより取得された現在の速度及び位置と結び付けることで、目標の速度及び位置、即ち1グループのアドミタンス制御後の変位値を算出し、さらに、該グループのアドミタンス制御後の変位値に応じて逆解を求めて複数グループの変位値のうちの各グループの変位値に含まれた、ロボットアームに対応する第1の変位値及び運動機構に対応する第2の変位値を得ることができる。
S106において、複数グループの変位値に応じて最適化求解を行い、ロボットアームに対応する第1の目標変位値及び運動機構に対応する第2の目標変位値を得る。
AGV及び6自由度ロボットアームは計9つの自由度を有し、逆解を求めると複数グループの解があるので、運動範囲を制限して最適化アルゴリズムを使用して最適解を得ることで、ロボットアームの運動及びAGVの運動を決定する必要があり、図2に示すように、qdは即ち、最適化アルゴリズムに応じて求められた最適解である。上記最適化求解のステップは、現在運動学パラメータ及び力関連パラメータ(例えばAGV変位-速度-加速度、ロボットアームの末端の変位-速度-加速度、ロボットアームの末端の6つの自由度であるx、y、z及びrx、ry、rz)を取得することと、現在運動学パラメータ及び力関連パラメータに応じて絞込条件を決定することと、複数グループの変位値のうちの、絞込条件を満たす変位値を目標変位値として決定し、目標変位値が、ロボットアームに対応する第1の目標変位値及び運動機構に対応する第2の目標変位値を含むことと、を含む。
最適化求解は、全ての解において制限条件を加えて条件を満たす解を獲得するものであり、条件は、異なる状態時の運動学パラメータ及び受けた力によって決められる。例えば、牽引の開始及び終了の段階において、ロボットアームを先に牽引し、ロボットアームの、AGVに対する変位が十分に大きくないか又はロボットアームが受けた力が小さい場合、AGVは、ほとんど動かず、牽引段階において、即ちロボットアームが受けた力に大きな急変がない場合、AGVとロボットアームの末端との相対位置が変化しないことを優先的に考慮し、本実施例において、6つの自由度における力又はモーメントの影響重みは、調節可能である。
S108において、第1の目標変位値及び第2の目標変位値に応じてロボットアーム及び前記運動機構の運動を制御する。
ロボットアームには、第1の位置コントローラが取り付けられており、運動機構には、第2の位置コントローラが取り付けられており、第1の目標変位値に応じて前記第1の位置コントローラに第1の制御信号を送信して、第1の位置コントローラが第1の制御信号に応じてロボットアームの運動を制御するようにさせ、第2の目標変位値に応じて第2の位置コントローラに第2の制御信号を送信して、第2の位置コントローラが第2の制御信号に応じて前記運動機構の運動を制御するようにさせる。
ロボットアーム及びAGVの目標変位値が得られた後に、ロボットアーム及びAGVは制御信号を受信し、各々の位置コントローラにより運動を完成させ、図2に示すように、qkは、運動量トラッカーにより出力されたロボットアームの関節及びAGVの実際軌跡である。
S110において、現在の運動における力センサにより採取された複数の力及び複数のモーメントを取得する操作を、ロボットアーム及び運動機構が運動を停止するまで繰り返し実行する。
図2に示すように、プリセット所望の力又はモーメントfdが0であると仮定し、ロボットアームが牽引されているときに、ヒューマンマシンの実際のインタラクションモデルのセンサにより採取された、実際に受けた力又はモーメントfhが0ではなければ、力又はモーメント偏差値fuも0ではなく、アドミタンスコントローラは、力又はモーメント偏差値fuを入力とし、複数グループの変位値
を出力し、最適化求解によりロボットアーム及び運動機構の変位値の最適解を得て、ロボットアーム及びAGVにそれぞれ取り付けられた位置コントローラにより、ロボットアーム及び運動機構の運動を制御し、ロボットアーム及び運動機構が所望位置に牽引されると、牽引を停止し、fhが0に等しくなり、力又はモーメント偏差値fuも0になり、即ちアドミタンスコントローラの入力が0になり、ロボットアーム及び運動機構は、運動を停止する。
を出力し、最適化求解によりロボットアーム及び運動機構の変位値の最適解を得て、ロボットアーム及びAGVにそれぞれ取り付けられた位置コントローラにより、ロボットアーム及び運動機構の運動を制御し、ロボットアーム及び運動機構が所望位置に牽引されると、牽引を停止し、fhが0に等しくなり、力又はモーメント偏差値fuも0になり、即ちアドミタンスコントローラの入力が0になり、ロボットアーム及び運動機構は、運動を停止する。
複合ロボットをドラッグしているときに小さな力だけでロボットの柔軟追随を完成可能である。また、最適化アルゴリズムにより与えられた解は、ドラッグ時に、ロボットアームの伸展程度が小さければ、ロボットアームの運動幅が大きく、AGVの運動幅が小さく、ロボットアームが既に十分に伸展していれば、ドラッグ時におけるロボットアームの運動幅が小さく、AGVの運動幅が大きいことを可能にする。このような効果は、人間-複合ロボットインタラクションのニーズにより適合する。
また、6つの自由度におけるアドミタンス制御パラメータをそれぞれ設定することができる。これにより、異なる方向におけるドラッグが異なる効果を有するようになる。実際の適用においてより柔軟で変化が多くなるように、AGVに対しては1つの自由度が開放されないように設定することができ、ロボットアームに対しても、開放されずドラッグされる(ロボットアームが固定して動かず)ことができる。
本願の実施例に係る複合ロボットの制御方法は、現在の運動における力センサにより採取された複数の力及び複数のモーメントを取得し、プリセット所望の力及びモーメント、並びにプリセットモデルに応じて計算を行い、複数グループの変位値を得て、複数グループの変位値に応じて最適化求解を行い、ロボットアーム及び運動機構に対応する目標変位値を得て、ロボットアーム及び運動機構の運動を制御し、上記ステップを、ロボットアーム及び運動機構が運動を停止するまで循環することで、ロボットアームと運動機構との間の動的結合を実現可能であり、複合ロボットをドラッグしているときに小さな力があればロボットの柔軟追随を完成可能であり、人が自由に複合ロボットを牽引することを容易にし、その最適化求解から得られた目標変位値の解は、ドラッグ時に、ロボットアームの伸展程度が小さければ、ロボットアームの運動幅が大きく、運動機構の運動幅が小さく、ロボットアームが既に十分に伸展していれば、ドラッグ時におけるロボットアームの運動幅が小さく、運動機構の運動幅が大きいという効果を実現可能であり、人間-複合ロボットインタラクションのニーズにより適合する。
本願の実施例は、複合ロボットのロボットアームの力センサの力制御機能に基づいて実現される複合ロボットのマッサージ技法の実現方法をさらに提供する。
ロボットアームのコントローラは、マッサージプラットフォームに通信接続され、マッサージプラットフォームには、複数種類のマッサージ技法にそれぞれ対応する押圧パラメータが配置されており、押圧パラメータは、力度の大きさ及び変換速度を含み、コントローラは、マッサージプラットフォームにより送信された目標押圧パラメータを受信し、目標押圧パラメータ及び力センサに応じて、ロボットアームの被マッサージ者に対する押圧方式を制御して、目標押圧パラメータに対応する目標マッサージ技法を実現する。
上記マッサージ技法は少なくとも、指点法、指按法、指推法、肘推法、掌推法及び一指禅法のいずれかを含む。
異なるマッサージ技法については、その運動学記述及び動力学記述を、相応する力制御ニーズ記述に転換し、異なる力制御ニーズに応じて異なる押圧パラメータを設定することができると同時に、該技法の実現の優先レベル及び実現部位などを設定することもできる。
例えば、指点法、指按法及び肘点法の運動学記述は、人体の表面の固定位置において、垂直方向の上下運動するものであり、動力学記述は、人体の表面に垂直であるように保持され、人体に徐々に近づき、人体の表面に接触して線形増加している圧力/単位面積当たりの圧力(N又はN/cm^2で計算する)(初期圧力、線形増加係数、終了圧力を含む)を出力する「按」、及び、人体の表面から徐々に離れ、線形減少している圧力/単位面積当たりの圧力(初期圧力、線形減少係数、終了圧力を含む)を出力する「収」という2つのステップを含むものであり、相応する力制御ニーズ記述は、(1)ロボットアームの位置姿勢を人体の曲面に垂直である(即ち、人体の曲面の法線ベクトルの方向に沿う)ように保持し、(2)法線方向の6次元力情報をリアルタイムでフィードバックし、(3)人体に接触している過程において、人体組織の軟らかさの変化をリアルタイムでフィードバックし、(4)初期圧力、変化係数及び終了圧力、並びに人体の軟らかさに応じて、持続的にロボットアームの位置姿勢を調節し、線形変化している力度を出力するものであり、安全要求は、圧力/単位面積当たりの圧力を人体最大耐性よりも小さくなるように確保するものであり、それらの技法の実現の優先レベルをレベル1、実現部位を背部、腰部及び臀部として設定することができる。
指推法、肘推法及び掌推法の運動学記述は、人体の表面の固定経路において、等速直線運動し、人体の表面に対してある角度に保持され、「按」、「推」及び「収」という3つのステップを含むものであり、動力学記述は、「按」において、人体に徐々に近づき、人体の表面に接触して線形増加している圧力/単位面積当たりの圧力(N又はN/cm^2で計算する)(初期圧力、線形増加係数、終了圧力を含む)を出力し、この圧力を保持し、「推」において、下向きの圧力を保持すると同時に、推法の経路に沿って一定の推力(初期力、変化システム及び目標力を含む)を出力し、「収」において、人体の表面から徐々に離れ、線形減少している圧力/単位面積当たりの圧力(初期圧力、線形減少係数、終了圧力を含む)を出力するものであり、相応する力制御ニーズ記述は、(1)ロボットアームの位置姿勢を人体の表面に対してある角度に保持し、(2)法線方向の6次元力情報をリアルタイムでフィードバックし、(3)人体に接触している過程において、人体組織の軟らかさの変化をリアルタイムでフィードバックし、(4)初期圧力、変化係数及び終了圧力、並びに人体の軟らかさに応じて、持続的にロボットアームの位置姿勢を調節し、線形変化している力度を出力し、(5)推法の経路に沿って一定力(初期力、変化システム及び目標力を含む)を保持するものであり、安全要求は、圧力/単位面積当たりの圧力を人体最大耐性よりも小さくなるように確保するものであり、それらの技法の実現の優先レベルをレベル2、実現部位を背部、腰部及び臀部として設定することができる。
一指禅推法の運動学記述は、人体の表面の固定位置において、垂直方向の軸に沿って往復回転運動し、そのうち、正方向回転及び逆方向回転の角度範囲が120~180度であるものであり、動力学記述は、人体の表面に垂直であるように保持され、人体に徐々に近づき、人体の表面に接触して線形増加している圧力/単位面積当たりの圧力(N又はN/cm^2で計算する)(初期圧力、線形増加係数、終了圧力を含む)を出力し、この圧力を保持する「按」、下向きの圧力を保持すると同時に、人体の表面に垂直な軸に沿って回転し、線形変化しているトルク(初期トルク、変化係数(増加又は減少)及び目標トルクを含む)を出力し、目標トルクに到達すると、一定に保持する「転」、及び、人体の表面から徐々に離れ、線形減少している圧力/単位面積当たりの圧力(初期圧力、線形減少係数、終了圧力を含む)を出力する「収」という3つのステップを含むものであり、相応する力制御ニーズ記述は、(1)ロボットアームの位置姿勢を人体の曲面に垂直である(即ち、人体の曲面の法線ベクトルの方向に沿う)ように保持し、(2)法線方向の6次元力情報をリアルタイムでフィードバックし、(3)人体に接触している過程において、人体組織の軟らかさの変化をリアルタイムでフィードバックし、(4)初期圧力、変化係数及び終了圧力、並びに人体の軟らかさに応じて、持続的にロボットアームの位置姿勢を調節し、線形変化している力度を出力し、(5)法線方向軸に沿って回転し、線形変化しているトルクを出力するものであり、安全要求は、圧力/単位面積当たりの圧力を人体最大耐性よりも小さくなるように確保するものであり、該技法の実現の優先レベルをレベル3、実現部位を背部、腰部及び臀部として設定することができる。
ロボットアームの力制御機能は、6つの次元の減衰力(トルク)、一定力(トルク)などが設定可能であり、力制御パラメータを変えることでマッサージ力度の変化を実現可能である。また、伝統的なマッサージにおける各技法及び各人の好みの力度は異なり、力制御パラメータのリアルタイムな調整は、ロボットのマッサージをマッサージ師の手法により近くさせることができ、安全要求の設計も、ロボットのマッサージの安全性を確保している。
また、マッサージ時のロボットアームの軌跡は、実質的に一連のデカルト空間における位置姿勢により決定され、位置姿勢集合に対する記録、編集、再現により、様々な機能を実現可能であり、そのため、複合ロボットのソフトウェア開発キット(Software Development Kit、SDK)を用いて、複数の軌跡に対して自由に調速、接合、縮小拡大することができ、これにより、複雑なマッサージテクニックが簡単に再現され、且つ異なるマッサージ対象に応じて調整されることができる。例えば、人為的牽引による軌跡の記録、軌跡速度の編集、力度制御、軌跡の組み合わせ及び縮小拡大などの機能を実現可能であり、使用者は、自分で軌跡を記録して力度パラメータを調節して複雑なテクニックを復元してもよいし、予め設計済みの軌跡、及び指按、指推、指ねじなどのテクニックを直接使用してもよい。上記SDK部分の開発は、主に機能設計で具現し、その他の協働ロボットを使用して実現することができる。
本願の実施例に係る複合ロボットのマッサージ技法の実現方法は、ロボットアームのコントローラに複数種類のマッサージ技法にそれぞれ対応する押圧パラメータを配置し、コントローラで、マッサージプラットフォームにより送信された目標押圧パラメータを受信し、目標押圧パラメータ及び力センサに応じて、ロボットアームの被マッサージ者に対する押圧方式を制御することで、目標押圧パラメータに対応する目標マッサージ技法を実現可能であり、該方法は、力制御パラメータを変えることでマッサージ力度の変化を実現し、ロボットのマッサージをマッサージ師の手法により近くさせることができると同時に、ロボットのマッサージの安全性を確保する。
上記方法の実施例に基づいて、本願の実施例は、複合ロボットの制御装置をさらに提供し、図3を参照し、該装置は、複合ロボットのロボットアームにおけるコントローラに適用され、ロボットアームは、運動機構に取り付けられ、ロボットアームには、力センサが取り付けられており、コントローラは、運動機構に通信接続され、該装置は、
ロボットアームが牽引されて運動しているときに、現在の運動における力センサにより採取された複数の力及び複数のモーメントを取得するように構成されるモーメント取得モジュール31と、複数の力及び複数のモーメント、プリセット所望の力及びモーメント、並びにプリセットモデルに応じて計算を行い、複数グループの変位値を得て、各グループの変位値が、ロボットアームに対応する第1の変位値及び運動機構に対応する第2の変位値を含み、プリセットモデルが、アドミタンスモデル又はインピーダンスモデルを含むように構成される変位計算モジュール32と、複数グループの変位値に応じて最適化求解を行い、ロボットアームに対応する第1の目標変位値及び運動機構に対応する第2の目標変位値を得るように構成される目標変位決定モジュール33と、第1の目標変位値及び第2の目標変位値に応じて前記ロボットアーム及び運動機構の運動を制御するように構成される運動制御モジュール34と、現在の運動における力センサにより採取された複数の力及び複数のモーメントを取得する操作を、ロボットアーム及び運動機構が運動を停止するまで繰り返し実行するように構成される循環モジュール35と、を備える。
ロボットアームが牽引されて運動しているときに、現在の運動における力センサにより採取された複数の力及び複数のモーメントを取得するように構成されるモーメント取得モジュール31と、複数の力及び複数のモーメント、プリセット所望の力及びモーメント、並びにプリセットモデルに応じて計算を行い、複数グループの変位値を得て、各グループの変位値が、ロボットアームに対応する第1の変位値及び運動機構に対応する第2の変位値を含み、プリセットモデルが、アドミタンスモデル又はインピーダンスモデルを含むように構成される変位計算モジュール32と、複数グループの変位値に応じて最適化求解を行い、ロボットアームに対応する第1の目標変位値及び運動機構に対応する第2の目標変位値を得るように構成される目標変位決定モジュール33と、第1の目標変位値及び第2の目標変位値に応じて前記ロボットアーム及び運動機構の運動を制御するように構成される運動制御モジュール34と、現在の運動における力センサにより採取された複数の力及び複数のモーメントを取得する操作を、ロボットアーム及び運動機構が運動を停止するまで繰り返し実行するように構成される循環モジュール35と、を備える。
本願の実施例に係る複合ロボットの制御装置は、現在の運動における力センサにより採取された複数の力及び複数のモーメントを取得し、プリセット所望の力及びモーメント、並びにプリセットモデルに応じて計算を行い、複数グループの変位値を得て、複数グループの変位値に応じて最適化求解を行い、ロボットアーム及び運動機構に対応する目標変位値を得て、ロボットアーム及び運動機構の運動を制御し、上記ステップを、ロボットアーム及び運動機構が運動を停止するまで循環することで、ロボットアームと運動機構との間の動的結合を実現可能であり、複合ロボットをドラッグしているときに、小さな力だけでロボットの柔軟追随を完成可能であり、ドラッグ効果をヒューマンマシンインタラクションのニーズにより適合させる。
上記力センサは、ロボットアームの末端に取り付けられた6次元センサ、又はロボットアームの各関節箇所に取り付けられた関節センサを含む。上記プリセットモデルは、アドミタンスモデルを含み、力センサは、6次元センサであり、複数の力及び複数のモーメントは、6つの自由度のうち、3つの並進運動自由度に対応する力及び3つの回転運動自由度に対応するモーメントを含む。
上記変位計算モジュール32は、6つの自由度のうち、3つの並進運動自由度に対応する力及び3つの回転運動自由度に対応するモーメント、並びにプリセット所望の力及びモーメントに応じて、力又はモーメント偏差値を決定し、力又はモーメント偏差値をアドミタンスモデルに入力して求解を行い、1グループのアドミタンス制御後の変位値を得て、前記6つの自由度のうち、3つの並進運動自由度に対応する力及び3つの回転運動自由度に対応するモーメント、並びに該グループのアドミタンス制御後の変位値に応じて逆解を求め、複数グループの変位値を得るように構成される。
目標変位決定モジュール33は、現在運動学パラメータ及び力関連パラメータを取得し、現在運動学パラメータ及び力関連パラメータに応じて絞込条件を決定し、複数グループの変位値のうちの、絞込条件を満たす変位値を目標変位値として決定し、目標変位値が、ロボットアームに対応する第1の目標変位値及び運動機構に対応する第2の目標変位値を含むように構成される。
上記ロボットアームには、第1の位置コントローラが取り付けられており、運動機構には、第2の位置コントローラが取り付けられており、上記運動制御モジュール34は、第1の目標変位値に応じて第1の位置コントローラに第1の制御信号を送信して、第1の位置コントローラが第1の制御信号に応じてロボットアームの運動を制御するようにさせ、第2の目標変位値に応じて第2の位置コントローラに第2の制御信号を送信して、第2の位置コントローラが第2の制御信号に応じて前記運動機構の運動を制御するようにさせる、ように構成される。
上記コントローラは、マッサージプラットフォームに通信接続され、マッサージプラットフォームには、複数種類のマッサージ技法にそれぞれ対応する押圧パラメータが配置されており、押圧パラメータは、力度の大きさ及び変換速度を含み、上記装置は、マッサージプラットフォームにより送信された目標押圧パラメータを受信し、目標押圧パラメータ及び力センサに応じて、ロボットアームの被マッサージ者に対する押圧方式を制御して、目標押圧パラメータに対応する目標マッサージ技法を実現するように構成されるマッサージモジュールをさらに備える。
上記マッサージ技法は少なくとも、指点法、指按法、指推法、肘推法、掌推法及び一指禅法のいずれかを含む。
本願の実施例に係る複合ロボットの制御装置は、その実現原理及び生じさせる技術効果が、前述の複合ロボットの制御方法の実施例と同じであり、説明を簡略化するために、複合ロボットの制御装置の実施例の部分で言及されていないものは、前述の複合ロボットの制御方法の実施例における対応内容を参照することができる。
本願の実施例は、複合ロボットの制御システムをさらに提供し、図4に示すものを参照し、該システムは、複合ロボット41及びマッサージプラットフォーム42を備え、複合ロボット41は、マッサージプラットフォーム42に通信接続され、複合ロボット41は、ロボットアーム411及び運動機構412を備え、ロボットアームには、コントローラ4111及び力センサ4112が取り付けられており、ロボットアーム411は、運動機構412に取り付けられ、コントローラ4111は、運動機構412に通信接続され、コントローラ4111は、上記複合ロボットの制御方法を実行するように構成され、実現方式は、前述の方法の実施例を参照することができ、ここでは繰り返し説明しない。
本願の実施例に係る複合ロボットの制御システムは、現在の運動における力センサにより採取された複数の力及び複数のモーメントを取得し、プリセット所望の力及びモーメント、並びにプリセットモデルに応じて計算を行い、複数グループの変位値を得て、複数グループの変位値に応じて最適化求解を行い、ロボットアーム及び運動機構に対応する目標変位値を得て、ロボットアーム及び運動機構の運動を制御し、上記ステップを、ロボットアーム及び運動機構が運動を停止するまで循環することで、ロボットアームと運動機構との間の動的結合を実現可能であり、複合ロボットをドラッグしているときに小さな力だけでロボットの柔軟追随を完成可能であり、ドラッグ効果をヒューマンマシンインタラクションのニーズにより適合させ、且つ、上記マッサージプラットフォームには、ヒューマンコンピュータインターフェイスが設けられており、ヒューマンコンピュータインターフェイスにより、マッサージパラメータを設定することができ、制御システムは、力制御パラメータを変えることでマッサージ力度の変化を実現し、ロボットのマッサージをマッサージ師の手法により近くさせることができると同時に、ロボットのマッサージの安全性を確保している。
本願の実施例は、コンピュータ実行可能な命令が記憶されたコンピュータ可読記憶媒体をさらに提供し、該コンピュータ実行可能な命令は、プロセッサにより呼び出されて実行されると、プロセッサに上記複合ロボットの制御方法を実現するように促し、実現方式は、前述の方法の実施例を参照することができ、ここでは繰り返し説明しない。
本願の実施例に係る方法、装置及びシステムのコンピュータプログラム製品は、プログラムコードが記憶されたコンピュータ可読記憶媒体を含み、前記プログラムコードに含まれる命令は、前の方法の実施例に記載の複合ロボットの制御方法を実行するために使用可能であり、実現方式は、方法の実施例を参照することができ、ここでは繰り返し説明しない。
別途説明がない限り、これらの実施例で述べられた部品及びステップの相対的なステップ、数字表現式及び数値は、本願の範囲を制限するものではない。
前記機能は、ソフトウェア機能ユニットの形式で実現され、且つ独立した製品として販売又は使用されれば、1つの、プロセッサによって実行可能である不揮発的なコンピュータ可読記憶媒体に記憶されてもよい。本願の技術案は、本質的にソフトウェア製品の形式で表現することができ、該コンピュータソフトウェア製品は、1つの記憶媒体に記憶され、1台のコンピュータ機器(パーソナルコンピュータ、サーバ又はネットワーク機器などであってもよい)に本願の実施例に記載の方法の全て又は一部のステップを実行させるための複数の指令を含む。さらに、前述の記憶媒体は、USBメモリ、リムーバブルハードディスク、読み出し専用メモリ(Read-Only Memory、ROM)、ランダムアクセスメモリ(Random Access Memory、RAM)、磁気ディスク又は光ディスクなどの様々な、プログラムコードを記憶可能な媒体又は非一時的記憶媒体を含む。
本願の説明において、用語「中心」、「上」、「下」、「左」、「右」、「鉛直」、「水平」、「内」、「外」などにより指示される方位又は位置関係は、図面に示す方位又は位置関係に基づくものであり、本願の説明を容易し、及び説明を簡略化するためのものに過ぎず、かかる装置又は素子が特定の方位を有し、特定の方位から構成されて操作されなければならないことを指示又は暗示するものではないため、本願を制限するものとしては理解できない。また、用語「第1」、「第2」、「第3」は、説明の目的のためのものに過ぎず、相対的な重要性を指示又は暗示するものとしては理解できない。
本願の実施例は、複合ロボットの制御システムをさらに提供し、図4に示すものを参照し、該システムは、複合ロボット41及びマッサージプラットフォーム42を備え、複合ロボット41は、マッサージプラットフォーム42に通信接続され、複合ロボット41は、ロボットアーム411及び運動機構412を備え、ロボットアームには、コントローラ4112及び力センサ4111が取り付けられており、ロボットアーム411は、運動機構412に取り付けられ、コントローラ4112は、運動機構412に通信接続され、コントローラ4112は、上記複合ロボットの制御方法を実行するように構成され、実現方式は、前述の方法の実施例を参照することができ、ここでは繰り返し説明しない。
Claims (10)
- 複合ロボットのロボットアームにおけるコントローラに適用され、
前記ロボットアームは、運動機構に取り付けられ、前記ロボットアームには、力センサが取り付けられており、前記コントローラは、前記運動機構に通信接続され、
前記ロボットアームが牽引されて運動している場合、現在の運動における前記力センサにより採取された複数の力及び複数のモーメントを取得することと、
前記複数の力及び複数のモーメント、プリセット所望の力及びモーメント、並びにプリセットモデルに応じて計算を行い、複数グループの変位値を得て、各グループの変位値が、前記ロボットアームに対応する第1の変位値及び前記運動機構に対応する第2の変位値を含み、前記プリセットモデルが、アドミタンスモデル又はインピーダンスモデルを含むことと、
前記複数グループの変位値に応じて最適化求解を行い、前記ロボットアームに対応する第1の目標変位値及び前記運動機構に対応する第2の目標変位値を得ることと、
前記第1の目標変位値及び前記第2の目標変位値に応じて前記ロボットアーム及び前記運動機構の運動を制御することと、
前記した、現在の運動における前記力センサにより採取された複数の力及び複数のモーメントを取得する操作を、前記ロボットアーム及び前記運動機構が運動を停止するまで繰り返し実行することと、を含む、
複合ロボットの制御方法。 - 前記力センサは、前記ロボットアームの末端に取り付けられた6次元センサ、又は前記ロボットアームの各関節箇所に取り付けられた関節センサを含む、
請求項1に記載の方法。 - 前記プリセットモデルは、アドミタンスモデルを含み、前記力センサは、6次元センサであり、前記複数の力及び複数のモーメントは、6つの自由度のうち、3つの並進運動自由度に対応する力及び3つの回転運動自由度に対応するモーメントを含み、
前記複数の力及び複数のモーメント、プリセット所望の力及びモーメント、並びにプリセットモデルに応じて計算を行い、複数グループの変位値を得ることは、
前記6つの自由度のうち、3つの並進運動自由度に対応する力及び3つの回転運動自由度に対応するモーメント、並びに前記プリセット所望の力及びモーメントに応じて、力又はモーメント偏差値を決定することと、
前記力又はモーメント偏差値を前記アドミタンスモデルに入力して求解を行い、1グループのアドミタンス制御後の変位値を得ることと、
前記6つの自由度のうち、3つの並進運動自由度に対応する力及び3つの回転運動自由度に対応するモーメント、並びに前記1グループのアドミタンス制御後の変位値に応じて逆解を求め、前記複数グループの変位値を得ることと、を含む、
請求項1に記載の方法。 - 前記した、前記複数グループの変位値に応じて最適化求解を行い、前記ロボットアームに対応する第1の目標変位値及び前記運動機構に対応する第2の目標変位値を得ることは、
現在運動学パラメータ及び力関連パラメータを取得することと、
前記現在運動学パラメータ及び前記力関連パラメータに応じて絞込条件を決定することと、
前記複数グループの変位値のうちの、前記絞込条件を満たす変位値を目標変位値として決定し、前記目標変位値が、前記ロボットアームに対応する第1の目標変位値及び前記運動機構に対応する第2の目標変位値を含むことと、を含む、
請求項1に記載の方法。 - 前記ロボットアームには、第1の位置コントローラが取り付けられており、前記運動機構には、第2の位置コントローラが取り付けられており、前記した、前記第1の目標変位値に応じて前記ロボットアームの運動を制御し、前記第2の目標変位値に応じて前記運動機構の運動を制御することは、
前記第1の目標変位値に応じて前記第1の位置コントローラに第1の制御信号を送信して、前記第1の位置コントローラが前記第1の制御信号に応じて前記ロボットアームの運動を制御するようにさせることと、
前記第2の目標変位値に応じて前記第2の位置コントローラに第2の制御信号を送信して、前記第2の位置コントローラが前記第2の制御信号に応じて前記運動機構の運動を制御するようにさせることと、を含む、
請求項1に記載の方法。 - 前記コントローラは、マッサージプラットフォームに通信接続され、前記マッサージプラットフォームには、複数種類のマッサージ技法にそれぞれ対応する押圧パラメータが配置されており、前記押圧パラメータは、力度の大きさ及び変換速度を含み、
前記マッサージプラットフォームにより送信された目標押圧パラメータを受信することと、
前記目標押圧パラメータ及び前記力センサに応じて、前記ロボットアームの被マッサージ者に対する押圧方式を制御して、前記目標押圧パラメータに対応する目標マッサージ技法を実現することと、をさらに含む、
請求項1に記載の方法。 - 前記マッサージ技法は少なくとも、指点法、指按法、指推法、肘推法、掌推法、一指禅法のいずれかを含む、
請求項6に記載の方法。 - 複合ロボットのロボットアームにおけるコントローラに適用され、
前記ロボットアームは、運動機構に取り付けられ、前記ロボットアームには、力センサが取り付けられており、前記コントローラは、前記運動機構に通信接続され、
前記ロボットアームが牽引されて運動している場合、現在の運動における前記力センサにより採取された複数の力及び複数のモーメントを取得するように構成されるモーメント取得モジュールと、
前記複数の力及び複数のモーメント、プリセット所望の力及びモーメント、並びにプリセットモデルに応じて計算を行い、複数グループの変位値を得て、各グループの変位値が、前記ロボットアームに対応する第1の変位値及び前記運動機構に対応する第2の変位値を含み、前記プリセットモデルが、アドミタンスモデル又はインピーダンスモデルを含むように構成される変位計算モジュールと、
前記複数グループの変位値に応じて最適化求解を行い、前記ロボットアームに対応する第1の目標変位値及び前記運動機構に対応する第2の目標変位値を得るように構成される目標変位決定モジュールと、
前記第1の目標変位値及び前記第2の目標変位値に応じて前記ロボットアーム及び前記運動機構の運動を制御するように構成される運動制御モジュールと、
前記した、現在の運動における前記力センサにより採取された複数の力及び複数のモーメントを取得する操作を、前記ロボットアーム及び前記運動機構が運動を停止するまで繰り返し実行するように構成される循環モジュールと、を備える、
複合ロボットの制御装置。 - 複合ロボット及びマッサージプラットフォームを備え、
前記複合ロボットは、前記マッサージプラットフォームに通信接続され、前記複合ロボットは、ロボットアーム及び運動機構を備え、前記ロボットアームには、コントローラ及び力センサが取り付けられており、前記ロボットアームは、前記運動機構に取り付けられ、前記コントローラは、前記運動機構に通信接続され、前記コントローラは、請求項1~7のいずれか1項に記載の複合ロボットの制御方法を実行するように構成される、
複合ロボットの制御システム。 - コンピュータ実行可能な命令が記憶されており、
前記コンピュータ実行可能な命令は、プロセッサにより呼び出されて実行されると、プロセッサに請求項1~7のいずれか1項に記載の複合ロボットの制御方法を実現するように促す、
コンピュータ可読記憶媒体。
Applications Claiming Priority (3)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202111209630.6A CN113843801B (zh) | 2021-10-18 | 2021-10-18 | 复合机器人的控制方法、装置及系统 |
CN202111209630.6 | 2021-10-18 | ||
PCT/CN2022/111062 WO2023065781A1 (zh) | 2021-10-18 | 2022-08-09 | 复合机器人的控制方法、装置及系统 |
Publications (1)
Publication Number | Publication Date |
---|---|
JP2023552991A true JP2023552991A (ja) | 2023-12-20 |
Family
ID=78978616
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2023533806A Pending JP2023552991A (ja) | 2021-10-18 | 2022-08-09 | 複合ロボットの制御方法、装置及びシステム |
Country Status (6)
Country | Link |
---|---|
US (1) | US20240017407A1 (ja) |
EP (1) | EP4205915A1 (ja) |
JP (1) | JP2023552991A (ja) |
CN (1) | CN113843801B (ja) |
MX (1) | MX2023006910A (ja) |
WO (1) | WO2023065781A1 (ja) |
Families Citing this family (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113843801B (zh) * | 2021-10-18 | 2022-11-29 | 上海节卡机器人科技有限公司 | 复合机器人的控制方法、装置及系统 |
CN114454166B (zh) * | 2022-02-11 | 2023-04-28 | 苏州艾利特机器人有限公司 | 一种机械臂阻抗控制方法及装置 |
CN115946120B (zh) * | 2023-01-09 | 2024-02-13 | 上海艾利特机器人有限公司 | 机械臂控制方法、装置、设备和介质 |
CN116619393B (zh) * | 2023-07-24 | 2023-11-14 | 杭州键嘉医疗科技股份有限公司 | 基于svm的机械臂变导纳控制方法、装置及设备 |
Family Cites Families (12)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2013158837A (ja) * | 2012-02-01 | 2013-08-19 | Seiko Epson Corp | ロボット制御装置、およびロボット制御方法 |
CN103240739B (zh) * | 2013-05-07 | 2015-04-15 | 武汉科技大学 | 一种移动机械臂分散集中自主切换控制方法 |
CN106420257B (zh) * | 2016-09-05 | 2018-11-09 | 南京航空航天大学 | 基于串联弹性驱动器的上肢用康复外骨骼机器人 |
CN108000477B (zh) * | 2017-12-05 | 2021-06-15 | 哈尔滨工业大学 | 一种全位姿主被动柔顺机器人旋拧阀门方法 |
CN109397244B (zh) * | 2018-11-23 | 2020-09-18 | 华中科技大学 | 一种一体化双7自由度机械臂全向移动机器人系统与控制方法 |
CN111376263B (zh) * | 2018-12-29 | 2022-08-02 | 沈阳新松机器人自动化股份有限公司 | 一种复合机器人人机协作系统及其交叉耦合力控制方法 |
KR20210149091A (ko) * | 2019-03-27 | 2021-12-08 | 보스턴 다이나믹스, 인크. | 상자들을 팔레타이징하기 위한 로봇 및 방법 |
CN111887906B (zh) * | 2019-09-10 | 2021-05-11 | 深圳市精锋医疗科技有限公司 | 手术机器人及其机械臂的控制方法、控制装置 |
CN112497208A (zh) * | 2020-10-22 | 2021-03-16 | 西安交通大学 | 基于全状态阻抗控制器的移动操作机器人通用控制方法 |
CN112157659A (zh) * | 2020-10-28 | 2021-01-01 | 成都九系机器人科技有限公司 | 一种基于机器人力位混合控制的飞机部件装配系统及方法 |
CN113305838B (zh) * | 2021-05-26 | 2022-04-29 | 深圳市优必选科技股份有限公司 | 按摩运动控制方法、装置、机器人控制设备及存储介质 |
CN113843801B (zh) * | 2021-10-18 | 2022-11-29 | 上海节卡机器人科技有限公司 | 复合机器人的控制方法、装置及系统 |
-
2021
- 2021-10-18 CN CN202111209630.6A patent/CN113843801B/zh active Active
-
2022
- 2022-08-09 JP JP2023533806A patent/JP2023552991A/ja active Pending
- 2022-08-09 US US18/036,779 patent/US20240017407A1/en active Pending
- 2022-08-09 EP EP22871098.4A patent/EP4205915A1/en active Pending
- 2022-08-09 MX MX2023006910A patent/MX2023006910A/es unknown
- 2022-08-09 WO PCT/CN2022/111062 patent/WO2023065781A1/zh active Application Filing
Also Published As
Publication number | Publication date |
---|---|
CN113843801A (zh) | 2021-12-28 |
CN113843801B (zh) | 2022-11-29 |
WO2023065781A1 (zh) | 2023-04-27 |
US20240017407A1 (en) | 2024-01-18 |
MX2023006910A (es) | 2023-08-22 |
EP4205915A1 (en) | 2023-07-05 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP2023552991A (ja) | 複合ロボットの制御方法、装置及びシステム | |
CN107053179B (zh) | 一种基于模糊强化学习的机械臂柔顺力控制方法 | |
CN107116553B (zh) | 一种机械臂的操作方法及装置 | |
CN109091818B (zh) | 基于导纳控制的绳牵引上肢康复机器人的训练方法及系统 | |
CN108524187B (zh) | 一种六自由度的上肢康复机器人控制系统 | |
CN110825076B (zh) | 基于视线和力反馈的移动机器人编队导航半自主控制方法 | |
CN107050763B (zh) | 一种新型踝关节康复机器人其控制方法 | |
CN110251898B (zh) | 一种基于力反馈的手腕康复外骨骼的闭环控制系统 | |
CN108897220B (zh) | 一种自适应稳定平衡控制方法和系统以及双足仿人机器人 | |
CN109529274B (zh) | 基于冗余机械臂上肢关节主动康复系统及其训练方法 | |
CN110834329B (zh) | 外骨骼控制方法及装置 | |
CN113001540B (zh) | 负载机动型外骨骼的人机交互智能控制方法及外骨骼系统 | |
CN111249005A (zh) | 一种穿刺手术机器人柔顺控制系统 | |
CN115502966B (zh) | 用于机器人的可变导纳控制方法 | |
CN114571469A (zh) | 一种机械臂零空间实时避障控制方法及系统 | |
Yu et al. | Gesture-based telemanipulation of a humanoid robot for home service tasks | |
CN113876556A (zh) | 一种三维激光扫描按摩机器人系统 | |
CN110561391B (zh) | 用于下肢外骨骼系统的惯性信息前馈控制装置及控制方法 | |
CN112237524A (zh) | 柔性上肢康复机器人被动康复训练的控制方法 | |
CN109159120B (zh) | 基于康复机械臂关节电机电流反馈的主动控制方法及系统 | |
Xu et al. | A teleoperated shared control scheme for mobile robot based semg | |
CN114700959B (zh) | 一种机械臂镜像阻抗控制方法及镜像机械臂设备 | |
Khalifa et al. | Workspace mapping and control of a teleoperated endoscopic surgical robot | |
CN209158419U (zh) | 基于触觉的机械手控制系统 | |
Yuan et al. | Design of adaptive compliance control algorithm for upper limb exoskeleton rehabilitation robot |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20230531 |
|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20230531 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20240312 |
|
A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20240510 |