WO2019013067A1 - 力制御装置、力制御方法及び力制御プログラム - Google Patents
力制御装置、力制御方法及び力制御プログラム Download PDFInfo
- Publication number
- WO2019013067A1 WO2019013067A1 PCT/JP2018/025338 JP2018025338W WO2019013067A1 WO 2019013067 A1 WO2019013067 A1 WO 2019013067A1 JP 2018025338 W JP2018025338 W JP 2018025338W WO 2019013067 A1 WO2019013067 A1 WO 2019013067A1
- Authority
- WO
- WIPO (PCT)
- Prior art keywords
- force
- torque
- control
- target
- virtual object
- Prior art date
Links
Images
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
- 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
-
- 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
- G05B13/00—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion
- G05B13/02—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric
- G05B13/04—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators
- G05B13/041—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators in which a variable is automatically adjusted to optimise the performance
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06F—ELECTRIC DIGITAL DATA PROCESSING
- G06F30/00—Computer-aided design [CAD]
- G06F30/20—Design optimisation, verification or simulation
-
- 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/39323—Force and motion control
-
- 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/39332—Adaptive force control
-
- 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/42—Servomotor, servo controller kind till VSS
- G05B2219/42326—Protection servo for saturation of amplifier
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06F—ELECTRIC DIGITAL DATA PROCESSING
- G06F17/00—Digital computing or data processing equipment or methods, specially adapted for specific functions
- G06F17/10—Complex mathematical operations
- G06F17/11—Complex mathematical operations for solving equations, e.g. nonlinear equations, general mathematical optimization problems
Definitions
- This control method includes force sense presentation (non-patent documents 4, 5), remote control (non-patent document 6), rehabilitation (non-patent document 7), human-machine joint work (non-patent document 8) and certain manufacturing processes. (Non-patent document 9) is applied. In most applications, the magnitude of the robot's actuator force is limited due to hardware limitations or safety reasons.
- S (k-1) is a set including, for example, the integral term, the measurement position q s (k-1) of the previous step, the target position p d (k-1) of the previous step, and the like.
- the output value ⁇ (k) of this function is taken as the torque command value to the motor.
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- General Physics & Mathematics (AREA)
- Evolutionary Computation (AREA)
- Theoretical Computer Science (AREA)
- Computer Hardware Design (AREA)
- General Engineering & Computer Science (AREA)
- Geometry (AREA)
- Health & Medical Sciences (AREA)
- Artificial Intelligence (AREA)
- Computer Vision & Pattern Recognition (AREA)
- Medical Informatics (AREA)
- Software Systems (AREA)
- Automation & Control Theory (AREA)
- Human Computer Interaction (AREA)
- Feedback Control In General (AREA)
- Manipulator (AREA)
Abstract
トルク飽和した場合であっても、代数ループを用いて仮想物体の位置をフィード バックすることで、仮想物体と制御対象との位置ずれを低減し、追従性を向上させつつ安定性を向上させる力制御装置等を提供する。 制御対象の位置を検出する位置検出器と、制御対象が物体と接触する力を検出する力センサ11と、制御対象を移動可能に保持する移動機構41と、トルク指令値を入力として移動機構41を動作させるモータを有する駆動装置42と、トルク指令値を決定する演算装置40とを備え、演算装置40が、所定の動特性を有する仮想物体12、及び位置制御器13を保持しており、制御対象に加える目標力、及び力センサ11の測定値を仮想物体12に与えた場合の運動をシミュレートして算出される次の時刻の位置を算出し、当該位置を位置制御器13に次の時刻における目標位置として与えたときに算出されるトルクを求め、当該トルクが予め設定された所定の範囲外にある場合は、当該所定の範囲の境界値及び前記トルクに基づいて代数ループを用いて、仮想物体12の次の時刻における位置が定められるものである。
Description
本発明は、力センサを用いてアドミッタンス制御を行う力制御装置等に関する。
ロボット・マニピュレーターが外部的環境に接して動作している場合、ロボットのエンドエフェクタと環境の間の接触力を制御するための適切な制御器が必要である。この種の制御器は、非特許文献1及び2の中で提案されている。力センサが利用可能であり、ロボットのジョイントに高い摩擦がある状況では、アドミッタンス制御(非特許文献3)と呼ばれる制御手法がよく用いられている(非特許文献3~5)。この種の制御器では、単純な動特性をもつ仮想物体を制御器の中で想定し、力センサで測定された力の情報によって仮想物体の運動をシミュレートする。また、ロボットは仮想物体の運動を追跡するように位置制御される。位置制御が十分に正確である限り、ロボットの外力に対する反応は仮想物体のそれに近い。この制御法は、力覚提示(非特許文献4,5)、遠隔操作(非特許文献6)、リハビリテーション(非特許文献7)、人間機械共同作業(非特許文献8)及びある種の製造工程(非特許文献9)に適用されている。ほとんどの応用例においては、ロボットのアクチュエータ力の大きさはハードウェア制限か安全上の理由により制限されている。
アドミッタンス制御でのアクチュエータ力飽和の1つの問題は、アクチュエータ力が飽和する場合に、ロボットの位置が仮想物体の位置から遠ざかってしまうということである。アクチュエータ力は飽和する可能性があり、仮想物体の速度に急激な変化が発生する可能性がある。大きな外力がロボットに働く可能性がある場合に、仮想物体の慣性と粘性を大きく設定することは、飽和を防ぐことに寄与する。しかし、それは接触力に対する鈍重な反応性に帰着し、多くの場合不適切である。
なお外力のフィードバックループ及び内部位置ループを使用する制御方法は、1970年代以来文献で見つけることができる。それらの制御器は明示的力制御器(非特許文献11~13)及びインピーダンス制御器(非特許文献14~17)に分類することができる。前者はエンドエフェクタ上の力を制御し、また、後者はエンドエフェクタの見かけの機械インピーダンスを制御する。この2つのタイプは、同様のフレームワーク(違いは目標力コマンドが提供されるかどうかである)の中で実現することができる。それらの制御器は、「仮想内部モデル追従制御」(非特許文献9,18)、「位置制御ベース・インピーダンス制御」(非特許文献19,20)及び「アドミッタンス制御」(非特許文献4,5,7,8)のようなさまざまな名前で呼ばれている。
安定性はアドミッタンス制御器の主要な課題である。不安定性の主な原因は、制御器の中の時間遅れ(非特許文献12,23)、内部位置制御システムの帯域制限(非特許文献24~26)である。仮想質量と仮想粘性は、不安定性を抑えるためには、高く設定すべきであるということが知られている。しかしながら、それが制御器の反応性の質を下げる場合があるので、大きな仮想質量か仮想粘性は必ずしも望ましくない。実現可能な最小の仮想質量はアドミッタンス制御される装置のひとつの評価指標でもある(非特許文献5)。仮想質量及び仮想粘性を増加させずに安定性を向上するために、仮想物体位置から実際の位置への伝達関数は、1に近い必要がある。これを実現するために、従来の技術のうちのいくつかは、ロボットの動特性(非特許文献22,27,28の影響を償うためにフィードフォワード項(位相進み補償器とみなすことができる)を含む位置制御器を使用している。
アクチュエータ飽和に関して、どのようにそれを回避しなければならないかという問題についての唯一の解析的な研究はGonzalez及びWidmannの研究(非特許文献29)である。この研究では、飽和がシステムを開ループ系と一時的に等価にするので、飽和が制御対象の安定性を改善することが指摘されている。しかしながら、この技術では、正の飽和と負の飽和が交互に発生する状況(これは通常望ましくない)を考慮していない。
このような問題を解決するために用いることができる制御技術が、非特許文献10及び特許文献1によって提案された、Proxy-based Sliding Mode制御(PSMC)である。
この技術は、単純なスライディングモード制御器のある種の離散時間近似でもあり、飽和のあるPID制御器の拡張でもある。
この技術は、単純なスライディングモード制御器のある種の離散時間近似でもあり、飽和のあるPID制御器の拡張でもある。
PSMCは、トルク不飽和時にはPIDと等価であるため目標位置に対する現在位置追従特性が不十分であることもある。またPSMCの場合、トルク飽和に関しては、飽和から不飽和への遷移時にτが不連続になって、ロボットを触る作業者に、違和感を感じさせる原因となっている。このような問題に対して、位置指令が頻繁及び急激に変わるときでも位置の追従性を向上させることができ、しかもトルク飽和時でも不連続な動きを抑えることができる位置制御器を備えたアドミッタンス制御を用いた力制御装置に関する技術が開示されている(特許文献2)。
D. E. Whitney, "Historical perspective and state of the art in robot force control," Int. J. Robotics Research, vol. 6, no. 1, pp. 3-14, 1987.
G. Zeng and A. Hemami, "An overview of robot force control," Robotica, vol. 15, pp. 473-482, 1997.
C. Ott, R. Mukherjee, and Y. Nakamura, "Unified impedance and admittance control," in Proc. IEEE Int. Conf. Robotics and Automation, 2010, pp. 554-561.
M. Ueberle and M. Buss, "Control of kinesthetic haptic interfaces," in Proc. Workshop on Touch and Haptics, IEEE/RSJ Int. Conf. Intelligent Robots and Systems, 2004, pp. 1-14.
R. Q. Van Der Linde and P. Lammertse, "HapticMaster - a generic force controlled robot for human interaction," Industrial Robot, vol. 30, no. 6, pp. 515-524, 2003.
A. Peer and M. Buss, "A new admittance-type haptic interface for bimanual manipulations," IEEE/ASME Trans. Mechatronics, vol. 13, no. 4, pp. 416-428, 2008.
P. R. Culmer, A. E. Jackson, S. Makower, R. Richardson, J. A. Cozens, M. C. Levesley, and B. B. Bhakta, "A control strategy for upper limb robotic rehabilitation with a dual robot system," IEEE/ASME Trans. Mechatronics, vol. 15, no. 4, pp. 575-585, 2010.
N. Takesue, H. Murayama, K. Fujiwara, K. Matsumoto, H. Konosu, and H. Fujimoto, "Kinesthetic assistance for improving task performance - the case of window installation assist -," Int. J. Automation Technology, vol. 3, no. 6, pp. 663-670, 2009.
H. Arai, "Force-controlled metal spinning machine using linear motors," in Proc. IEEE Int. Conf. Robotics and Automation, 2006, pp. 4031-4036.
R. Kikuuwe, S. Yasukouchi, H. Fujimoto, and M. Yamamoto, "Proxybased sliding mode control: A safer extension of PID position control," IEEE Trans. Robotics, vol. 26, no. 4, pp. 860-873, 2010.
J. De Schutter, "A study of active compliant motion control methods for rigid manipulators based on a generic scheme," in Proc. IEEE Int. Conf. Robotics and Automation, vol. 4, 1987, pp. 1060-1065.
H. Ishikawa, C. Sawada, K. Kawase, and M. Takata, "Stable compliance control and its implementation for a 6 DOF manipulator," in Proc. IEEE Int. Conf. Robotics and Automation, vol. 1, 1989, pp. 98-103.
H. Seraji, "Adaptive admittance control: an approach to explicit force control in compliant motion," in Proc. IEEE Int. Conf. Robotics and Automation, 1994, pp. 2705-2712.
D. E. Whitney, "Force feedback control of manipulator fine motions," Trans. ASME: J. Dynamic Systems, Measurement, and Control, vol. 99, no. 2, pp. 91-97, 1977.
G. Hirzinger, "Direct digital robot control using a force-torque sensor," in Proc. IFAC Symp. Real Time Digital Control Applications, 1983, pp. 243-255.
J. De Schutter and H. Van Brussel, "A methodology for specifying and controlling compliant robot motion," in Proc. 25th Conf. Decision and Control, 1986, pp. 1871-1876.
J. A. Maples and J. J. Becker, "Experiments in force control of robotic manipulators," in Proc. IEEE Int. Conf. Robotics and Automation, 1986, pp. 695-702.
K. Kosuge, K. Furuta, and T. Yokoyama, "Virtual internal model following control of robot arms," in Proc. 1987 IEEE Int. Conf. Robotics and Automation, 1987, pp. 1549-1554.
D. A. Lawrence and R. M. Stoughton, "Position-based impedance control - achieving stability in practice," in Proc. AIAA Guidance, Navigation and Control Conference, 1987, pp. 221-226.
D. Surdilovic and J. Kirchhof, "A new position based force/impedance control for industrial robots," in Proc. IEEE Int. Conf. Robotics and Automation, 1996, pp. 629-634.
R. Volpe and P. K. Khosla, "A theoretical and experimental investigation of explicit force control strategies for manipulators," IEEE Trans. Automatic Control, vol. 38, no. 11, pp. 1634-1650, 1993.
J. J. Gonzalez and G. R. Widmann, "A force commanded impedance control scheme for robots with hard nonlinearities," IEEE Trans. Control Systems Technology, vol. 3, no. 4, pp. 398-408, 1995.
D. A. Lawrence, "Impedance control stability properties in common implementation," in Proc. IEEE Int. Conf. Robotics and Automation, 1988, pp. 1185-1190.
S. D. Eppinger and W. P. Seering, "Understanding bandwidth limitations in robot force control," Proc. IEEE Int. Conf. Robotics and Automation, vol. 4, pp. 904-909, 1987.
T. Valency and M. Zacksenhouse, "Accuracy/robustness dilemma in impedance control," Trans. ASME: J. Dynamic Systems, Measurement, and Control, vol. 125, no. 3, pp. 310-319, 2003.
S. H. Kang, M. Jin, and P. H. Chang, "A solution to the accuracy/ robustness dilemma in impedance control," IEEE/ASME Trans. Mechatronics, vol. 14, no. 3, pp. 282-294, 2009.
S. Tafazoli, S. E. Salcudean, K. Hashtrudi-Zaad, and P. D. Lawrence, "Impedance control of a teleoperated excavator," IEEE Trans. Control Systems Technology, vol. 10, no. 3, pp. 355-367, 2002.
G. Ferretti, G. Magnani, and P. Rocco, "Impedance control for elastic joints industrial manipulators," IEEE Trans. Robotics and Automation, vol. 20, no. 3, pp. 488-498, 2004.
J. J. Gonzalez and G. R. Widmann, "Investigation of nonlinearities in the force control of real robots," IEEE Trans. Systems, Man, and Cybernetics, vol. 22, no. 5, pp. 1183-1193, 1992.
特許文献2に示す技術は、位置の追従性を向上させつつ、トルク飽和時でも不連続な動きを抑えることができるものの、仮想物体とロボットとの位置が離れることで、どうしても追従処理に違和感が生じてしまう可能性がある。
本発明は、トルク飽和した場合であっても、仮想物体の位置をフィードバックすることで、仮想物体と制御対象との位置ずれを低減し、追従性を向上させつつ安定性を向上させる力制御装置等を提供する。
本発明に係る力制御装置は、制御対象の位置を検出する位置検出器と、前記制御対象が物体と接触する力を検出する力センサと、前記制御対象を移動可能に保持する移動機構と、トルク指令値を入力として前記移動機構を動作させるモータを有する駆動装置と、前記トルク指令値を決定する演算装置とを備え、前記演算装置が、所定の動特性を有する仮想物体、及び位置制御則を保持しており、前記制御対象に加える目標力、及び前記力センサの測定値を前記仮想物体に与えた場合の運動をシミュレートして算出される次の時刻の位置を算出し、当該位置を前記位置制御則に次の時刻における目標位置として与えたときに算出されるトルクを求め、前記トルクが予め設定された所定の範囲内にある場合は、前記トルクをトルク指令値として前記位置を前記仮想物体の次の時刻における位置と定め、前記トルクが予め設定された所定の範囲外にある場合は、当該所定の範囲の境界値及び前記トルクに基づいて、前記仮想物体の次の時刻における位置が定められるものである。
このように、本発明に係る力制御装置においては、制御対象の位置を検出する位置検出器と、前記制御対象が物体と接触する力を検出する力センサと、前記制御対象を移動可能に保持する移動機構と、トルク指令値を入力として前記移動機構を動作させるモータを有する駆動装置と、前記トルク指令値を決定する演算装置とを備え、算出されたトルクが予め設定された所定の範囲外にある場合は、当該所定の範囲の境界値及び前記トルクに基づいて、前記仮想物体の次の時刻における位置が定められるため、制御対象と仮想物体との位置のずれが低減され、追従性を向上させつつ安定性を向上させることができるという効果を奏する。
以下、本発明の実施の形態を説明する。また、本実施形態の全体を通して同じ要素には同じ符号を付けている。
(本発明の第1の実施形態)
本実施形態に係る力制御装置について、図1ないし図5を用いて説明する。図1は、従来の力制御装置の処理概念の一例を示す機能ブロック図であり、図2は、本実施形態に係る力制御装置の処理概念の一例を示す機能ブロック図である。図1に示すように、従来技術におけるアドミッタンス制御は、力センサ11の測定値fと目標力(制御対象であるロボット14に対して加える力)fdとから所定の動特性を有する仮想物体12の位置Pdを目標位置として求める。目標位置Pdを満たすように位置制御器13がロボット14のモータのトルク指令値τを算出する。外部からロボット14に加えられる力h、力センサ11の測定値f及びトルク指令値τに基づいて、ロボット14が位置Pに移動する。
本実施形態に係る力制御装置について、図1ないし図5を用いて説明する。図1は、従来の力制御装置の処理概念の一例を示す機能ブロック図であり、図2は、本実施形態に係る力制御装置の処理概念の一例を示す機能ブロック図である。図1に示すように、従来技術におけるアドミッタンス制御は、力センサ11の測定値fと目標力(制御対象であるロボット14に対して加える力)fdとから所定の動特性を有する仮想物体12の位置Pdを目標位置として求める。目標位置Pdを満たすように位置制御器13がロボット14のモータのトルク指令値τを算出する。外部からロボット14に加えられる力h、力センサ11の測定値f及びトルク指令値τに基づいて、ロボット14が位置Pに移動する。
図1の従来技術の場合は、トルク指令値τがトルク範囲(例えば、安全性、ロボット1
4の駆動特性、環境等に応じて予め設定されるトルクの上限値及び下限値)外となる場合は、仮想物体12の位置Pdとロボット14の位置Pとが乖離してしまう。従来技術においては、この飽和状態から不飽和状態に遷移する必要があるため、どうしても追従処理に違和感が生じてしまう。そこで、本実施形態においては、例えば、図2に示すような処理を行う。
4の駆動特性、環境等に応じて予め設定されるトルクの上限値及び下限値)外となる場合は、仮想物体12の位置Pdとロボット14の位置Pとが乖離してしまう。従来技術においては、この飽和状態から不飽和状態に遷移する必要があるため、どうしても追従処理に違和感が生じてしまう。そこで、本実施形態においては、例えば、図2に示すような処理を行う。
図2において、位置制御器13で算出されたトルク指令値τについて、代数ループでフ
ィードバックすることで、仮想物体12の位置qxとロボット14の位置qsとを一致させることができ、従来のような追従処理における違和感を排除することが可能となる。
ィードバックすることで、仮想物体12の位置qxとロボット14の位置qsとを一致させることができ、従来のような追従処理における違和感を排除することが可能となる。
以下、本実施形態に係る力制御装置の構成及びアルゴリズムについて、具体的に説明する。図3は、本実施形態に係る力制御装置のハードウェア構成図である。力制御装置1は、制御対象であるロボット14と、当該ロボット14に付設され当該ロボット14の周囲環境にある物体からの反力を測定する力センサ11と、アドミッタンス制御を行うためのプログラム等が格納されたROM23と、必要に応じて当該プログラムをRAM22に読み込み処理を実行するCPU21と、タッチパネル、キーボード、マウス等の入力機器からの入力を受け付けたり、プリンタやディスプレイ等にデータを出力するためのインタフェースである入出力I/F24とを備える。各処理部はバスを介して接続され、情報のやり取りを行う。なお、上記ハードウェアの構成はあくまで一例であり、必要に応じて変更可能である。
図4は、本実施形態に係る力制御装置の機能ブロック図である。力制御装置1は、環境に対して所定の力を作用させるロボット14と、当該ロボット14の移動を制御する演算装置40とを備える。ロボット14は、周囲環境にある物体からの反力を測定する力センサ11と、ロボット14又は当該ロボット14の一部(例えば、アーム部等)を移動する移動機構41と、当該移動機構41を駆動するためのモータからなる駆動装置42とを備える。演算装置40は、力センサ11からの測定結果と移動機構41の位置情報とに基づいて、駆動装置42のモータのトルク指令値を演算し、駆動装置42に出力する。演算装置40によるトルク指令値の演算処理について、以下に詳細に説明する。
(1)数学的準備
Fを実数上の閉区間とする。それに対する飽和関数と法錐(Normal Cone)は下記のように定義される。
Fを実数上の閉区間とする。それに対する飽和関数と法錐(Normal Cone)は下記のように定義される。
飽和関数と法錐との関係は下記のように表される(参考文献:Acary, V., Brogliato, B.: “Numerical Methods for Nonsmooth Dynamical Systems”, Applications in Mechanics and Electronics, Lecture Notes in Applied and Computational Mechanics, vol.35. Springer (2008))。
符号関数を下記のように定義する。
正の定数Fで定義される閉区間[-F,F]について、下記が成立する。
符号関数と法錐は下記のように、互いに逆写像の関係にある。
また、符号関数と飽和関数の関係は下記のように表される。
(2)次に、提案する制御則の一般表現について説明する。
(2.1)連続時間表現
制御対象(ロボット14)の実際の位置をqs、仮想物体12の位置をqx、駆動装置42における発生力をτ、力センサ11の測定値をf、アドミッタンス制御器に与える目
標力をfdとする(fd=0で固定してもよい)。また、目標位置をqxとしたときのロボット14の位置制御則が適切な関数Φcによって
(2.1)連続時間表現
制御対象(ロボット14)の実際の位置をqs、仮想物体12の位置をqx、駆動装置42における発生力をτ、力センサ11の測定値をf、アドミッタンス制御器に与える目
標力をfdとする(fd=0で固定してもよい)。また、目標位置をqxとしたときのロボット14の位置制御則が適切な関数Φcによって
と与えられているものとする。さらに、仮想物体が実現するべき動特性は、適切な関数Гcによって
と与えられているものとする。これらの関数の具体例は(3)節で後述する。駆動装置4の発生力τの許容範囲を集合Fと定めたとき、提案する制御器の連続時間表現は下記のように表される。
これはτ及びqx(二階微分)を未知数とする連立微分方程式と見なすことができる。また、図2のような代数ループを含んだブロック線図として表すこともできる。式(11a)の法錐Nf(・)は引数であるが、τがF外に存在することを許容しないため、上記を満たすためには、τがF内になければならない。そうなるようにqxが更新される(qx(二階微分)が決定される)というように解釈できる。式(10)が満たされるようにqx(二階微分)を定め、それを式(11b)に代入した際に算出される発生力τがF内にあれば、そのτの値はそのまま採用される。一方で、そのτがF外にあれば、τはFの境界上のτに最も近い値で飽和し、そのときは式(11b)が満たされるようにqx(二階微分)が定められることになる。
(2.2)離散時間表現(代数ループを含んだ表現)
制御器(11)の離散時間表現を導く。
制御器(11)の離散時間表現を導く。
のように離散化すると、式(11a)は適切な関数Γを用いて、
という形で書き直すことができる。また、式(11b)は適切な関数Φを用いて、
という形で書き直すことができる。ここで、S(k-1)は、例えば、積分項や前ステップの測定位置qs(k-1)や前ステップの目標位置pd(k-1)などからなる集合である。この関数の出力値τ(k)をモータへのトルク指令値とする。さらに別の関数Φsを用いて、
のように次ステップのS(k)を決定するものとする。このS(k)は、次ステップの入力値の一つS(k-1)として用いる。式(12a)及び式(12b)は未知数τ(k)とqx(k)についての連立方程式と見なすことができ、これも図2のようなブロック線図のように解釈することができる。これらを用いると、提案するアドミッタンス制御のアルゴリズムは下記のように表される。
これらの表現は、代数包含式(14b)を解く工程を含んでいるため、このまま実装することは困難である。
(2.3)離散時間表現(アルゴリズムとしての表現)
代数包含式(14b)を解く方法を考える。ここで、以下のような仮定をおく。
仮定1 関数Φ(qx,qs,S)は引数qxについて厳密に単調増加である。
多くの典型的な制御器はこの仮定を満たす。この仮定のもとで、以下の式が成り立つことは明らかである。
代数包含式(14b)を解く方法を考える。ここで、以下のような仮定をおく。
仮定1 関数Φ(qx,qs,S)は引数qxについて厳密に単調増加である。
多くの典型的な制御器はこの仮定を満たす。この仮定のもとで、以下の式が成り立つことは明らかである。
また、この仮定のもとで、下記を満たす一価関数Φinvが存在することは明らかである。
この関数Φinvは、いわば逆制御器とも呼ぶことができる。通常の制御器は目標位置に対してトルク指令値を与える。それに対し逆制御器は、指定されたトルク指令値を出力するのに必要な目標位置を算出する。式(15)を用いると、式(14b)の代数包含式は下記のように書き直すことができる。
ここでは、法錐NF(τ(k))の返り値が(-∞,0],0,[0,∞)の3通りしかあり得ないことを考慮している。式(8)より、上式は下記のようになる。
ここで、式(20)は、式(16)で定義される逆制御器Φinvを用いると、
と書き直すことができる。したがって、式(14)のアルゴリズムは下記のように書き直すことができる。
上式が、提案するアドミッタンス制御のアルゴリズムの一つの形態である。仮定1に追加して、以下の仮定2が満たされる場合には、アルゴリズムをさらに簡略化することができる。
仮定2 Φ(qx,qs,S)=K^(qx-Φp(qs,S))がすべてのqx,qs,Sに対して満たされる正の定数K^と関数Φp(qs,S)が存在する。
仮定2 Φ(qx,qs,S)=K^(qx-Φp(qs,S))がすべてのqx,qs,Sに対して満たされる正の定数K^と関数Φp(qs,S)が存在する。
これは、制御器Φ(qx,qs,S)が目標値qxに対して線形であることを意味し、多くの典型的な制御器Φ(qx,qs,S)はこの仮定を満たす。このとき、逆制御器関数は、
となり、アルゴリズム(22)は下記のようになる。
アルゴリズム(22)における式(22d)の演算が、アルゴリズム(24)においては式(24e)のように単純化されている。このため、関数Φ()の構造によっては、ア
ルゴリズム(24)のタイプの実装によって計算量が削減できる。
ルゴリズム(24)のタイプの実装によって計算量が削減できる。
(3)次に、関数Φc及びГcの実例について説明する。
(3.1)関数Φcの例:目標加速度フィードフォワード付きPID制御の場合
目標加速度フィードフォワード付きPID制御の場合は、連続時間領域における制御器関数Φcは下記のように与えられる。
(3.1)関数Φcの例:目標加速度フィードフォワード付きPID制御の場合
目標加速度フィードフォワード付きPID制御の場合は、連続時間領域における制御器関数Φcは下記のように与えられる。
ここで、Mqx(qxは二階微分)が目標加速度のフィードフォワード項であり、K、B及びLはそれぞれ比例、微分、積分ゲインである。このとき、下式
を離散化すると、下記のような形になる。
ここで、aはa=∫(qx-qs)dtに相当し、
である。また、A^=K+B/T+LTであり、
である。これらを考慮すると、上記の関数Φcに対応する関数Φ,ΦS,Φinvは下記のようになる。
また、上記の関数Φ()は明らかに仮定2を満たすため、関数Φpを下記のように定めることができる。
したがって、この関数はアルゴリズム(24)の形式で実装できる。実装した結果は以下のようになる。
(3.2)関数Гcの例:質量・ダンパ系の場合
仮想物体の動特性が単純な慣性・粘性系で与えられている場合、動特性は、
仮想物体の動特性が単純な慣性・粘性系で与えられている場合、動特性は、
となるので、関数Гcは、
となる。ここで式(35)を離散化すると
となる。これをqx(k)について解くと、
となる。すなわち、関数Гは下記のようになる。
次に、本実施形態に係る力制御装置の動作について説明する。図5は、本実施形態に係る力制御装置の動作を示すフローチャートである。まず、ロボット14に対して外部から加わった力、及び力センサ11の測定値に基づいて、演算装置40がアドミッタンス制御の演算処理を行う(S1)。この演算処理は、上記で説明した通りである。演算の結果、ロボット14を駆動する際のモータのトルク指令値が出力され、ロボット14に入力される(S2)。トルク指令値にしたがってロボット14が駆動する(S3)。ロボット14の駆動を終了する場合は、処理を終了する。駆動(停止状態も含む)を継続する場合は、駆動した結果、ロボット14の位置や力センサ11の測定値を出力し、ステップS1のアドミッタンス制御の演算処理に戻る。以降、同様の処理を繰り返して行う。
このように、本実施形態に係る力制御装置においては、算出されたトルク指令値が予め設定された所定の範囲外にある場合は、当該所定の範囲の境界値及びトルク指令値に基づいて代数ループを用いて、仮想物体の次の時刻における位置が定められるため、制御対象と仮想物体との位置のずれが低減され、追従性を向上させつつ安定性を向上させることができる。
本発明に係る力制御装置について、以下の実験を行った。図6は、実験で使用したロボット14の写真である。ロボット14の第3関節に上記アドミッタンス制御則を実装し、その他の関節についてはロックした。そして、力センサ11に接触して動作させた場合と、リンク部(力センサ11以外の部位)に接触して動作させた場合の挙動を観察した。
図7は、従来の手法を用いた場合のアドミッタンス制御の結果を示す図であり、図8は、本発明に係る力制御装置を用いた場合のアドミッタンス制御の結果を示す図である。図7及び図8において、
(1)~時刻A:力センサ11を手で持った状態で動作
(2)時刻B~時刻C:力センサ11外の場所に力を加えている状態
(3)時刻C~:ロボット14が動かないようにリンク部を手で固定したまま、力センサ1に力を加えている状態
のそれぞれにおける測定結果が示されている。グラフの一番上は、仮想物体12の位置とロボット14の位置とを示しており、真ん中は、力センサ11の測定値を示しており、一番下は、モータの駆動トルクを示している。
(1)~時刻A:力センサ11を手で持った状態で動作
(2)時刻B~時刻C:力センサ11外の場所に力を加えている状態
(3)時刻C~:ロボット14が動かないようにリンク部を手で固定したまま、力センサ1に力を加えている状態
のそれぞれにおける測定結果が示されている。グラフの一番上は、仮想物体12の位置とロボット14の位置とを示しており、真ん中は、力センサ11の測定値を示しており、一番下は、モータの駆動トルクを示している。
図7及び図8からわかるように、(1)においては、いずれの手法においてもロボット14の位置が仮想物体12の位置によく追従している。(2)においては、図7の従来手法では、ロボット14の位置と仮想物体12の位置とが乖離しており、このとき、加えていた力を開放すると、バネのように元の位置に戻ろうとして危険である。一方、図8の本願の手法では、仮想物体12の位置がロボット14の位置に追従しているため、加えていた力を開放しても上記のような危険性は全くない。(3)においては、図7の従来手法では、仮想物体12の位置だけが動き、手を離すとロボット14が遠く離れた仮想物体12の位置追従しようとして危険である。一方、図8の本願の手法では、仮想物体12の位置は動かず、ロボット14の位置も動かないため、上記のような危険性は全くない。
以上のように、トルク飽和が発生するような状況においては、従来手法に比べて、本願の手法の方が安全性が格段に向上していることが明らかとなった。
1 力制御装置
11 力センサ
12 仮想物体
13 位置制御器
14 ロボット
21 CPU
22 RAM
23 ROM
24 入出力I/F
40 演算装置
41 移動機構
42 駆動装置
11 力センサ
12 仮想物体
13 位置制御器
14 ロボット
21 CPU
22 RAM
23 ROM
24 入出力I/F
40 演算装置
41 移動機構
42 駆動装置
Claims (9)
- 制御対象の位置を検出する位置検出器と、
前記制御対象が物体と接触する力を検出する力センサと、
前記制御対象を移動可能に保持する移動機構と、
トルク指令値を入力として前記移動機構を動作させるモータを有する駆動装置と、
前記トルク指令値を決定する演算装置とを備え、
前記演算装置が、
所定の動特性を有する仮想物体、及び位置制御則を保持しており、前記制御対象に加える目標力、及び前記力センサの測定値を前記仮想物体に与えた場合の運動をシミュレートして算出される次の時刻の位置を算出し、当該位置を前記位置制御則に次の時刻における目標位置として与えたときに算出されるトルクを求め、
前記トルクが予め設定された所定の範囲内にある場合は、前記トルクをトルク指令値として前記位置を前記仮想物体の次の時刻における位置と定め、
前記トルクが予め設定された所定の範囲外にある場合は、当該所定の範囲の境界値及び前記トルクに基づいて、前記仮想物体の次の時刻における位置が定められることを特徴とする力制御装置。 - 請求項1に記載の力制御装置において、
前記演算手段が、
前記トルクが予め設定された所定の範囲外にある場合に、当該所定の範囲の境界上にあって前記トルクに最も近いトルクをトルク指令値として定め、前記位置制御器が算出するトルク指令値が、定められた前記トルク指令値となる次の時刻における目標位置を算出し、当該目標位置を前記仮想物体の次の時刻の位置として定める力制御装置。 - 請求項2に記載の力制御装置において、
前記演算手段が、離散時間中の時刻kにおいて、前記トルクをτ、前記所定のトルクの範囲をFとし、前記仮想物体の位置をqxとし、前記制御対象の実際の位置をqs、前記目標力をfd、前記力センサの測定値をfとし、前記仮想物体の前記所定動特性がある関数Γcによって
と表されるとした場合に、
を満たすようにqx(k)及びτ(k)が決定される力制御装置。(ただし、関数Φはqsが目標値qxに追従するように定義された位置制御器とし、S(k-1)は積分項、前ステップの測定位置ps(k-1)、前ステップの目標位置pd(k-1)などの制御器内に蓄えられた状態変数からなる集合であり、この関数の出力τ(k)を前記トルク指令値とする。) - コンピュータが、
制御対象の位置を検出する位置検出ステップと、
前記制御対象が物体と接触する力を検出する力検出ステップと、
トルク指令値を入力として前記移動機構を動作させるモータを有する駆動装置の前記トルク指令値を演算する演算ステップと、
前記演算ステップの演算結果に基づいて前記制御対象を移動する移動ステップとを実行し、
前記演算ステップが、
前記コンピュータの内部に保持された所定の動特性を有する仮想物体、及び位置制御則を用い、前記制御対象に加える目標力、及び前記力検出ステップの測定値を前記仮想物体に与えた場合の運動をシミュレートして算出される次の時刻の位置を算出し、当該位置を前記位置制御則に次の時刻における目標位置として与えたときに算出されるトルクを求め、
前記トルクが予め設定された所定の範囲内にある場合は、前記トルクをトルク指令値として前記位置を前記仮想物体の次の時刻における位置と定め、
前記トルクが予め設定された所定の範囲外にある場合は、当該所定の範囲の境界値及び前記トルクに基づいて、前記仮想物体の次の時刻における位置を定めることを特徴とする力制御方法。 - 制御対象の位置を検出する位置検出手段、
前記制御対象が物体と接触する力を検出する力検出手段、
トルク指令値を入力として前記移動機構を動作させるモータを有する駆動装置の前記トルク指令値を演算する演算手段、
前記演算手段の演算結果に基づいて前記制御対象の移動を制御する移動制御手段としてコンピュータを機能させ、
前記演算手段が、
前記コンピュータの内部に保持された所定の動特性を有する仮想物体、及び位置制御則を用い、前記制御対象に加える目標力、及び前記力検出ステップの測定値を前記仮想物体に与えた場合の運動をシミュレートして算出される次の時刻の位置を算出し、当該位置を前記位置制御則に次の時刻における目標位置として与えたときに算出されるトルクを求め、
前記トルクが予め設定された所定の範囲内にある場合は、前記トルクをトルク指令値として前記位置を前記仮想物体の次の時刻における位置と定め、
前記トルクが予め設定された所定の範囲外にある場合は、当該所定の範囲の境界値及び前記トルクに基づいて、前記仮想物体の次の時刻における位置を定めることを特徴とする力制御プログラム。
Priority Applications (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
EP18832753.0A EP3654119A4 (en) | 2017-07-12 | 2018-07-04 | FORCE CONTROL DEVICE, FORCE CONTROL PROCEDURE AND FORCE CONTROL PROGRAM |
US16/629,758 US20200180150A1 (en) | 2017-07-12 | 2018-07-04 | Force control device, force control method, and force control program |
Applications Claiming Priority (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2017136283A JP6934173B2 (ja) | 2017-07-12 | 2017-07-12 | 力制御装置、力制御方法及び力制御プログラム |
JP2017-136283 | 2017-07-12 |
Publications (1)
Publication Number | Publication Date |
---|---|
WO2019013067A1 true WO2019013067A1 (ja) | 2019-01-17 |
Family
ID=65002553
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
PCT/JP2018/025338 WO2019013067A1 (ja) | 2017-07-12 | 2018-07-04 | 力制御装置、力制御方法及び力制御プログラム |
Country Status (4)
Country | Link |
---|---|
US (1) | US20200180150A1 (ja) |
EP (1) | EP3654119A4 (ja) |
JP (1) | JP6934173B2 (ja) |
WO (1) | WO2019013067A1 (ja) |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110045604A (zh) * | 2019-02-27 | 2019-07-23 | 沈阳工业大学 | 音圈电机驱动洛伦兹力型fts重复滑模复合控制方法 |
WO2021153741A1 (ja) * | 2020-01-29 | 2021-08-05 | 株式会社人機一体 | アドミタンス制御を適用した駆動ユニット |
Families Citing this family (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111897289B (zh) * | 2020-08-05 | 2022-02-18 | 上海柏楚电子科技股份有限公司 | 电机驱动机构的力矩信息处理方法、装置、设备与介质 |
CN112891127B (zh) * | 2021-01-14 | 2022-07-26 | 东南大学 | 一种基于自适应阻抗控制的镜像康复训练方法 |
CN112809687B (zh) * | 2021-02-08 | 2022-04-12 | 上海电气集团股份有限公司 | 一种机器人控制器的仿真方法、装置及设备 |
CN113110051B (zh) * | 2021-04-14 | 2022-03-04 | 南开大学 | 考虑误差约束的打磨机器人力/位混合控制方法及系统 |
CN114789444B (zh) * | 2022-05-05 | 2022-12-16 | 山东省人工智能研究院 | 一种基于深度强化学习和阻抗控制的柔顺人机接触方法 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPS6032811B2 (ja) | 1978-06-20 | 1985-07-30 | 東芝テック株式会社 | 重量測定装置 |
JP2007102748A (ja) | 2005-09-06 | 2007-04-19 | Nagoya Institute Of Technology | 位置制御装置、位置制御方法及び位置制御プログラム |
JP2009066696A (ja) * | 2007-09-12 | 2009-04-02 | Toyota Motor Corp | パワーアシスト装置およびその制御方法 |
JP2009208170A (ja) * | 2008-02-29 | 2009-09-17 | Toyota Motor Corp | パワーアシスト装置およびその制御方法 |
JP6032811B2 (ja) * | 2013-02-18 | 2016-11-30 | 国立大学法人九州大学 | アドミッタンス制御を用いた力制御装置及び位置制御装置 |
Family Cites Families (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2770982B2 (ja) * | 1989-05-25 | 1998-07-02 | 株式会社豊田中央研究所 | マニピユレータの位置と力の協調制御装置 |
JP4055090B2 (ja) * | 1997-07-08 | 2008-03-05 | 株式会社安川電機 | ロボットの制御装置 |
JP2008073830A (ja) * | 2006-09-25 | 2008-04-03 | Fanuc Ltd | ロボット制御装置 |
US9186795B1 (en) * | 2013-06-24 | 2015-11-17 | Redwood Robotics, Inc. | Programming and execution of force-based tasks with torque-controlled robot arms |
-
2017
- 2017-07-12 JP JP2017136283A patent/JP6934173B2/ja active Active
-
2018
- 2018-07-04 EP EP18832753.0A patent/EP3654119A4/en not_active Withdrawn
- 2018-07-04 WO PCT/JP2018/025338 patent/WO2019013067A1/ja unknown
- 2018-07-04 US US16/629,758 patent/US20200180150A1/en not_active Abandoned
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPS6032811B2 (ja) | 1978-06-20 | 1985-07-30 | 東芝テック株式会社 | 重量測定装置 |
JP2007102748A (ja) | 2005-09-06 | 2007-04-19 | Nagoya Institute Of Technology | 位置制御装置、位置制御方法及び位置制御プログラム |
JP2009066696A (ja) * | 2007-09-12 | 2009-04-02 | Toyota Motor Corp | パワーアシスト装置およびその制御方法 |
JP2009208170A (ja) * | 2008-02-29 | 2009-09-17 | Toyota Motor Corp | パワーアシスト装置およびその制御方法 |
JP6032811B2 (ja) * | 2013-02-18 | 2016-11-30 | 国立大学法人九州大学 | アドミッタンス制御を用いた力制御装置及び位置制御装置 |
Non-Patent Citations (32)
Title |
---|
A. PEERM. BUSS: "A new admittance-type haptic interface for bimanual manipulations", IEEE/ASME TRANS. MECHATRONICS, vol. 13, no. 4, 2008, pages 416 - 428 |
ACARY, V.BROGLIATO, B.: "Applications in Mechanics and Electronics, Lecture Notes in Applied and Computational Mechanics", vol. 35, 2008, SPRINGER, article "Numerical Methods Nonsmooth Dynamical Systems" |
C. OTTR. MUKHERJ EEY. NAKAMURA: "Unified impedance and admittance control", PROC. IEEE INT. CONF. ROBOTICS AND AUTOMATION, 2010, pages 554 - 561 |
D. A. LAWRENCE: "Impedance control stability properties in common implementation", PROC. IEEE INT. CONF. ROBOTICS AND AUTOMATION, 1988, pages 1185 - 1190, XP010012512, DOI: 10.1109/ROBOT.1988.12222 |
D. A. LAWRENCER. M. STOUGHTON: "Position-based impedance control - achieving stability in practice", PROC. AIAA GUIDANCE, NAVIGATION AND CONTROL CONFERENCE, 1987, pages 221 - 226 |
D. E. WHITNEY: "Force feedback control of manipulator fine motions", TRANS. ASME: J. DYNAMIC SYSTEMS, MEASUREMENT, AND CONTROL, vol. 99, no. 2, 1977, pages 91 - 97 |
D. E. WHITNEY: "Historical perspective and state of the art in robot force control", INT. J. ROBOTICS RESEARCH, vol. 6, no. 1, 1987, pages 3 - 14 |
D. SURDILOVICJ. KIRCHHOF: "A new position based force/impedance control for industrial robots", PROC. IEEE INT. CONF. ROBOTICS AND AUTOMATION, 1996, pages 629 - 634, XP010162819, DOI: 10.1109/ROBOT.1996.503845 |
G. FERRETTIG. MAGNANIP. ROCCO: "Impedance control for elastic joints industrial manipulators", IEEE TRANS. ROBOTICS AND AUTOMATION, vol. 20, no. 3, 2004, pages 488 - 498, XP011113634, DOI: 10.1109/TRA.2004.825472 |
G. HIRZINGER: "Direct digital robot control using a force-torque sensor", PROC. IFAC SYMP. REAL TIME DIGITAL CONTROL APPLICATIONS, 1983, pages 243 - 255 |
G. ZENGA. HEMAMI: "An overview of robot force control", ROBOTICA, vol. 15, 1997, pages 473 - 482, XP008179006, DOI: 10.1017/S026357479700057X |
H. ARAI: "Force-controlled metal spinning machine using linear motors", PROC. IEEE INT. CONF. ROBOTICS AND AUTOMATION, 2006, pages 4031 - 4036, XP010921883, DOI: 10.1109/ROBOT.2006.1642321 |
H. ISHIKAWAC. SAWADAK. KAWASEM. TAKATA: "Stable compliance control and its implementation for a 6 DOF manipulator", PROC. IEEE INT. CONF. ROBOTICS AND AUTOMATION, vol. 1, 1989, pages 98 - 103, XP000041504, DOI: 10.1109/ROBOT.1989.99974 |
H. SERAJI: "Adaptive admittance control: an approach to explicit force control in compliant motion", PROC. IEEE INT. CONF. ROBOTICS AND AUTOMATION, 1994, pages 2705 - 2712, XP000481073, DOI: 10.1109/ROBOT.1994.350927 |
J. A. MAPLESJ. J. BECKER: "Experiments in force control of robotic manipulators", PROC. IEEE INT. CONF. ROBOTICS AND AUTOMATION, 1986, pages 695 - 702 |
J. DE SCHUTTER: "A study of active compliant motion control methods for rigid manipulators based on a generic scheme", PROC. IEEE INT. CONF. ROBOTICS AND AUTOMATION, vol. 4, 1987, pages 1060 - 1065 |
J. DE SCHUTTERH. VAN BRUSSEL: "A methodology for specifying and controlling compliant robot motion", PROC. 25TH CONF. DECISION AND CONTROL, 1986, pages 1871 - 1876, XP001395739 |
J. J. GONZALEZG. R. WIDMANN: "A force commanded impedance control scheme for robots with hard nonlinearities", IEEE TRANS. CONTROL SYSTEMS TECHNOLOGY, vol. 3, no. 4, 1995, pages 398 - 408, XP000542072, DOI: 10.1109/87.481964 |
J. J. GONZALEZG. R. WIDMANN: "Investigation of nonlinearities in the force control of real robots", IEEE TRANS. SYSTEMS, MAN, AND CYBERNETICS, vol. 22, no. 5, 1992, pages 1183 - 1193, XP000334331, DOI: 10.1109/21.179857 |
K. KOSUGEK. FURUTAT. YOKOYAMA: "Virtual internal model following control of robot arms", PROC. 1987 IEEE INT. CONF. ROBOTICS AND AUTOMATION, 1987, pages 1549 - 1554 |
KIKUUE, RYO, MIZUTANI, KOKI: "Effectiveness of proxy-based sliding mode control in controlling inner position of admittance control (non-official translation) ", THE 29TH ANNUAL CONFERENCE OF THE ROBOTICS SOCIETY OF JAPAN, 7 September 2011 (2011-09-07), pages 1446 - 1449, XP009518254 * |
M. UEBERLEM. BUSS: "Control of kinesthetic haptic interfaces", PROC. WORKSHOP ON TOUCH AND HAPTICS, IEEE/RSJ INT. CONF. INTELLIGENT ROBOTS AND SYSTEMS, 2004, pages 1 - 14 |
N. TAKESUEH. MURAYAMAK. FUJIWARAK. MATSUMOTOH. KONOSUH. FUJIMOTO: "Kinesthetic assistance for improving task performance — the case of window installation assist", INT. J. AUTOMATION TECHNOLOGY, vol. 3, no. 6, 2009, pages 663 - 670 |
P. R. CULMERA. E. JACKSONS. MAKOWERR. RICHARDSONJ. A. COZENSM. C. LEVESLEYB. B. BHAKTA: "A control strategy for upper limb robotic rehabilitation with a dual robot system", IEE E/ASME TRANS. MECHATRONICS, vol. 15, no. 4, 2010, pages 575 - 585 |
R. KIKUUWES. YASUKOUCHIH. FUJIMOTOM. YAMAMOTO: "Proxybased sliding mode control: A safer extension of PID position control", IEEE TRANS. ROBOTICS, vol. 26, no. 4, 2010, pages 860 - 873 |
R. Q. VAN DER LINDEP. LAMMERTSE: "HapticMaster - ageneric force controlled robot for human interaction", INDUSTRIAL ROBOT, vol. 30, no. 6, 2003, pages 515 - 524 |
R. VOLPEP. K. KHOSLA: "A theoretical and experimental investigation of explicit force control strategies for manipulators", IEEE TRANS. AUTOMATIC CONTROL, vol. 38, no. 11, 1993, pages 1634 - 1650 |
S. D. EPPINGERW. P. SEERING: "Understanding bandwidth limitations in robot force control", PROC. IEEE INT. CONF. ROBOTICS AND AUTOMATION, vol. 4, 1987, pages 904 - 909 |
S. H. KANGM. JINP. H. CHANG: "A solution to the accuracy/ robustness dilemma in impedance control", IEEE/ASME TRANS. MECHATRONICS, vol. 14, no. 3, 2009, pages 282 - 294 |
S. TAFAZOLIS. E. SALCUDEANK. HASHTRUDI-ZAADP.D. LAWRENCE: "Impedance control of a teleoperated excavator", IEEE TRANS. CONTROL SYSTEMS TECHNOLOGY, vol. 10, no. 3, 2002, pages 355 - 367 |
See also references of EP3654119A4 * |
T. VALENCYM. ZACKSENHOUSE: "Accuracy/robustness dilemma in impedance control", TRANS. ASME: J. DYNAMIC SYSTEMS, MEASUREMENT, AND CONTROL, vol. 125, no. 3, pages 310 - 319 |
Cited By (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110045604A (zh) * | 2019-02-27 | 2019-07-23 | 沈阳工业大学 | 音圈电机驱动洛伦兹力型fts重复滑模复合控制方法 |
CN110045604B (zh) * | 2019-02-27 | 2022-03-01 | 沈阳工业大学 | 音圈电机驱动洛伦兹力型fts重复滑模复合控制方法 |
WO2021153741A1 (ja) * | 2020-01-29 | 2021-08-05 | 株式会社人機一体 | アドミタンス制御を適用した駆動ユニット |
JP2021117918A (ja) * | 2020-01-29 | 2021-08-10 | 株式会社人機一体 | アドミタンス制御を適用した駆動ユニット |
JP7248307B2 (ja) | 2020-01-29 | 2023-03-29 | 株式会社人機一体 | アドミタンス制御を適用した駆動ユニット |
Also Published As
Publication number | Publication date |
---|---|
EP3654119A4 (en) | 2021-04-07 |
JP6934173B2 (ja) | 2021-09-15 |
EP3654119A1 (en) | 2020-05-20 |
JP2019020826A (ja) | 2019-02-07 |
US20200180150A1 (en) | 2020-06-11 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP6934173B2 (ja) | 力制御装置、力制御方法及び力制御プログラム | |
US10751874B2 (en) | Method of teaching robot and robotic arm control device | |
Nemec et al. | Human robot cooperation with compliance adaptation along the motion trajectory | |
JP6032811B2 (ja) | アドミッタンス制御を用いた力制御装置及び位置制御装置 | |
Gregory et al. | Energy-optimal trajectory planning for robot manipulators with holonomic constraints | |
Kikuuwe | A sliding-mode-like position controller for admittance control with bounded actuator force | |
US20180345492A1 (en) | Direct teaching method of robot | |
Campeau-Lecours et al. | A time-domain vibration observer and controller for physical human-robot interaction | |
JP6044511B2 (ja) | ロボットの制御方法及びロボットシステム | |
Kawasaki et al. | Decentralized adaptive coordinated control of multiple robot arms without using a force sensor | |
JP7216405B2 (ja) | 制御装置 | |
Saków et al. | Self-sensing teleoperation system based on 1-dof pneumatic manipulator | |
Likar et al. | Adaptation of bimanual assembly tasks using iterative learning framework | |
Li et al. | A nonlinear momentum observer for sensorless robot collision detection under model uncertainties | |
JP4134812B2 (ja) | ロボット制御装置 | |
Doulgeri et al. | A position/force control for a robot finger with soft tip and uncertain kinematics | |
Ducaju et al. | Joint stiction avoidance with null-space motion in real-time model predictive control for redundant collaborative robots | |
JP2016221653A (ja) | ロボット制御装置およびロボットシステム | |
JP4587052B2 (ja) | 位置制御装置、位置制御方法及び位置制御プログラム | |
JP4134369B2 (ja) | ロボットの制御装置 | |
Smisek et al. | Naturally-transitioning rate-to-force controller robust to time delay by model-mediated teleoperation | |
Cetin et al. | Cooperative control of a human and a robot manipulator for positioning a cart on a frictionless plane | |
CN112405554B (zh) | 用于机器人低刚度运动控制的方法、装置和康复机器人 | |
Saków et al. | Load self-sensing control scheme for telemanipulation-Part 1: Theory | |
JP4376712B2 (ja) | 操作装置 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
121 | Ep: the epo has been informed by wipo that ep was designated in this application |
Ref document number: 18832753 Country of ref document: EP Kind code of ref document: A1 |
|
NENP | Non-entry into the national phase |
Ref country code: DE |
|
ENP | Entry into the national phase |
Ref document number: 2018832753 Country of ref document: EP Effective date: 20200212 |