JP4715296B2 - Robot hand holding and gripping control method. - Google Patents
Robot hand holding and gripping control method. Download PDFInfo
- Publication number
- JP4715296B2 JP4715296B2 JP2005140084A JP2005140084A JP4715296B2 JP 4715296 B2 JP4715296 B2 JP 4715296B2 JP 2005140084 A JP2005140084 A JP 2005140084A JP 2005140084 A JP2005140084 A JP 2005140084A JP 4715296 B2 JP4715296 B2 JP 4715296B2
- Authority
- JP
- Japan
- Prior art keywords
- joint
- robot hand
- control
- finger
- holding
- 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.)
- Expired - Fee Related
Links
Images
Landscapes
- Manipulator (AREA)
Description
本発明は、複数の能動関節と、力覚センサを有する複数の指を備えるロボットハンドにおいて把持物体の持ち替え動作を行う際の把持制御方法に関する。 The present invention relates to a grip control method for performing a holding object changing operation in a robot hand including a plurality of active joints and a plurality of fingers having force sensors.
複数関節を有する多指ロボットハンドを用いて各種の作業を行わせる場合、物体を把持したまま、物体とロボットハンドとの位置関係を変更する持ち替え動作が可能であれば作業性が向上する。このような持ち替え動作時の制御方法として特許文献１に記載された技術が知られている。
When various operations are performed using a multi-fingered robot hand having a plurality of joints, workability is improved if a holding and changing operation that changes the positional relationship between the object and the robot hand can be performed while the object is held. A technique described in
この技術においては、コンピュータシミュレーションまたはロボットハンドの実機を用いて、与えられた情報とランダムに決定した把持方法に基づいて仮想的にあるいは実際にロボットハンドを制御し、その結果を予め決められた評価式に基づいて評価する。これを異なる把持方法の組み合わせについて繰り返す。こうして試行した中から最もよい評価が得られた把持方法についてさらに修正を加えて結果を評価する試行を繰り返すことで最適な把持方法を選び出す進化的探索アルゴリズムを利用している。
しかしながら、この技術では、最適な把持方法を選択するまでに非常に多くの試行回数を必要とするため、把持方法を選択するのに時間がかかる。標準的な持ち替え動作について予めシミュレーションや実験を用いて把持方法等を求めて記憶しておき、その中から適切な把持方法を選択する方法を取った場合でも、汎用性に乏しいため、新規の物体や、持ち替え動作に対応することが難しい。また、把持方法を正確に評価するためには、把持物体の落下や潰れ、持ち損ね等も評価の対象とする必要があるが、そのためには物体自体の位置・姿勢を認識する必要があり、装置構成が複雑となる。 However, since this technique requires a very large number of trials before selecting the optimum gripping method, it takes time to select the gripping method. Even if a method for obtaining a gripping method or the like by using simulations or experiments in advance and storing it for a standard holding operation and selecting an appropriate gripping method from the results, it is not versatile. And it is difficult to support the changeover operation. In addition, in order to accurately evaluate the gripping method, it is necessary to evaluate the gripping object, such as dropping, crushing, and loss of holding, but for that purpose it is necessary to recognize the position and orientation of the object itself, The device configuration becomes complicated.
そこで本発明は、複雑な装置構成を必要とすることなく、汎用性のあるロボットハンドの持ち替え把持制御方法を提供することを課題とする。 Therefore, an object of the present invention is to provide a versatile robot hand holding and gripping control method without requiring a complicated apparatus configuration.
上記課題を解決するため、本発明にかかるロボットハンドの持ち替え把持制御方法は、複数の能動関節と、力覚センサを有する複数の指を備えるロボットハンドにおいて把持物体とロボットハンドとの位置関係を変更する持ち替え動作を行う把持制御方法において、（１）初期位置関係から別の目標位置関係へと至るロボットハンドの指動作を段階的な関節の回転動作に分解してこの回転動作を行う順序を設定する工程と、（２）回転動作ごとに、各指が把持物体と接触する接触点数を判定する工程と、（３）回転動作ごとに、各関節中で接触力の調整効果の高い関節として関節角度を一定量回転させた際に把持物体との接触力方向への変位量が大きい関節を接触点数と同数抽出する工程と、（４）抽出された関節をフィードバック制御関節に設定し、それ以外の関節にフィードフォワード制御による運動指令値を設定する工程と、（４）フィードバック制御関節以外の関節の動きを設定した運動指令値に基づいてフィードフォワード制御するとともに、フィードバック制御関節の動きを力覚センサの値に基づいて接触力にフィードバックすることにより制御する工程と、を備えていることを特徴とする。 In order to solve the above-described problems, a method for controlling holding and holding a robot hand according to the present invention changes the positional relationship between a gripping object and a robot hand in a robot hand including a plurality of active joints and a plurality of fingers having force sensors. In the grip control method for performing the holding movement, (1) the robot hand's finger movement from the initial positional relationship to another target positional relationship is broken down into stepwise joint rotational motions, and the order of performing the rotational motions is set. a step of, (2) for each rotation, the step of determining the number of contact points that each finger is in contact with the gripping body, (3) joint for each rotation, as a high joint of conditioning effect of the contact force in each joint a step of the same number as the number of contact points of the displacement amount is large joints in the contact force direction extracting the object to be held angle upon by a predetermined amount of rotation, (4) extracted joint feedback control joint A step of setting a motion command value by feedforward control to the other joints, and (4) feedforward control based on the motion command value in which the motion of a joint other than the feedback control joint is set, and a feedback control joint And a step of controlling the movement by feeding back to the contact force based on the value of the force sensor.
複雑な持ち替え動作も単純な動作タスクを順に組み合わせることで実現できる。そこで、持ち替え動作を単純な動作タスク系列に分解し、個々のタスクにおけるハンドの動作を設定する。この際に、関節の動きを予め設定して、目標どおりの関節移動を実現するフィードフォワード制御を行う関節と、物体の把持力に応じてフィードバック制御を行う関節とを予め設定しておき、両者を組み合わせた制御を行う。 Complex changeover operations can also be realized by combining simple operation tasks in order. Therefore, the holding action is broken down into a simple action task series, and the hand action in each task is set. At this time, the joint movement is set in advance, the joint that performs feed-forward control that realizes the desired joint movement, and the joint that performs feedback control according to the gripping force of the object are set in advance. Control is combined.
本発明によれば、持ち替え動作を単純な動作タスク系列に分解したうえで、各動作タスクについて、フィードフォワード制御とフィードバック制御を組み合わせることで、物体への把持力を適切に維持した状態で、目標に応じた各指の移動を実現することができる。これにより、適切な持ち替え動作を実現することができる。また、持ち替え動作を単純な動作タスク系列へと分解することで、複雑な持ち替え動作を実現することができるとともに、把持対象物や持ち替え動作に応じた適切な把持動作を行うことができるため、汎用性の高い制御動作が実現できる。 According to the present invention, the separation operation is decomposed into a simple operation task series, and for each operation task, the feedforward control and the feedback control are combined to maintain the gripping force on the object appropriately, and the target The movement of each finger according to can be realized. As a result, it is possible to realize an appropriate transfer operation. In addition, by disassembling the changeover operation into a simple operation task series, it is possible to realize a complicated changeover operation and perform an appropriate holding operation according to the object to be held and the changeover operation. A highly controllable operation can be realized.
接触点の数に応じてフィードバック制御を行う関節数を設定すると、関節と接触点とを対応させることができ、フィードバック制御が容易になり、把持の確実性が向上する。 When the number of joints for which feedback control is performed according to the number of contact points is set, the joints can be associated with the contact points, feedback control is facilitated, and gripping reliability is improved.
以下、添付図面を参照して本発明の好適な実施の形態について詳細に説明する。説明の理解を容易にするため、各図面において同一の構成要素に対しては可能な限り同一の参照番号を附し、重複する説明は省略する。 DESCRIPTION OF EXEMPLARY EMBODIMENTS Hereinafter, preferred embodiments of the invention will be described in detail with reference to the accompanying drawings. In order to facilitate the understanding of the description, the same reference numerals are given to the same components in the drawings as much as possible, and duplicate descriptions are omitted.
図１は本発明に係るロボットハンドの持ち替え把持制御方法によって制御されるロボットハンド１の構成を示す図であり、図２は、その制御系を示すブロック構成図である。そして、図３は、このロボットハンド１を備えるロボット１００の概略構成図である。
FIG. 1 is a diagram showing the configuration of a
本実施形態のロボットハンド１は、母指１０、示指１１、中指１２、薬指１３の４指からなる。母指１０は、４つの関節ごとにそれぞれモータ１４が配置された４自由度のリンク系である。他の３指１１〜１３は、最先端の関節を除く３つの関節ごとにそれぞれモータ１４が配置され、最先端の関節は、隣接する関節と連動する構成とされている（連動関節１７）。したがって、４関節でそれぞれ３自由度のリンク系を構成する。つまり、ロボットハンド１全体の自由度は１３となる。これらの各指の先端１０ｔ〜１３ｔは、曲面形状の弾性体で構成されており、指表面に柔軟構造を有している。さらに、各関節には、関節の曲げ角度を検出するためのエンコーダポテンションメータ１６が配置されている。また、指には接触力を検知するための触覚センサ１８が埋め込まれている。
The
このロボットハンド１は、図３に示されるように、アーム７によって、ロボット１００の胴体８に取り付けられている。胴体８は、左右にアーム７を有し、頭部に視覚センサであるカメラアイ３を備えている。アーム７にもモータとエンコーダポテンションメータが配置され、ロボットハンド１を所望の位置に移動させることが可能な構成となっている。
As shown in FIG. 3, the
制御系は、ＲＡＭ、ＲＯＭ、ＣＰＵ等で構成される制御ＥＣＵ２を中心に構成されており、把持対象物の画像を撮影するカメラアイ３の出力画像から画像認識によって対象物の形状・位置を認識する画像認識部２０と、認識結果を基にして把持位置・把持姿勢を計算するハンド位置姿勢演算部２１と、フィードバック（Feed Back）制御を行う関節を決定するＦＢ制御関節決定部２２と、フィードフォワード（Feed Forward）制御を行う関節の目標軌道を生成するＦＦ制御関節指令生成部２３と、ロボットハンド１の動きを制御するロボットハンド制御部２４とを有している。ロボットハンド制御部２４には、エンコーダポテンションメータ１６と、触覚センサ１８の出力信号が入力され、モータドライバ４を制御することで、各モータ１４の動きを制御する。
The control system is mainly configured by a control ECU 2 including a RAM, a ROM, a CPU, and the like, and recognizes the shape and position of an object by image recognition from an output image of a
制御系は、このような構成に限られるものではなく、指示された姿勢となるようロボットハンド１の動きを制御する制御部と、画像認識装置や把持姿勢の演算部を、別体としてもよい。また、これらの演算部・制御部は、ハードウェア的に区分されていてもソフトウェア的に区分されていてもよい。
The control system is not limited to such a configuration, and the control unit that controls the movement of the
次に、本発明にかかる持ち替え把持制御方法について具体的に説明する。図４は、この持ち替え把持制御方法の処理を示すフローチャートである。ここでは、既に対象物を把持しており、例えば、画像認識部２０とハンド位置姿勢演算部２１で生成した持ち替え動作指令に基づいて持ち替え動作を行う場合を例に説明する。
Next, the holding and holding control method according to the present invention will be specifically described. FIG. 4 is a flowchart showing the processing of this holding and gripping control method. Here, a case will be described as an example where the object has already been gripped and, for example, the holding operation is performed based on the holding operation command generated by the
最初に、持ち替え動作指令を受信（ステップＳ１０）し、持ち替え動作を単純な動作タスク系列へと分解する（ステップＳ１１）。図５は、動作タスクの基本パターンを説明する図である。 First, a change-over operation command is received (step S10), and the change-over operation is broken down into a simple operation task sequence (step S11). FIG. 5 is a diagram for explaining a basic pattern of operation tasks.
図５に示されるように、ハンド１の座標系Σｈをハンド１の手首に固定する。ここで、座標系Σｈの原点は手首の回転中心であり、回転中心から回転軸に沿ってハンド１方向をＹｈ軸とし、指１１〜１３の配列方向に平行な方向にＸｈ軸を、母指１０と他指１１〜１３の対向方向に平行な方向にＺｈ軸をそれぞれ配置する。一方、物体２００側の座標系Σｏは、物体の重心を座標系の原点とし、物体２００の主軸方向をＸｏ軸とし、これに直交する方向をそれぞれＹｏ軸、Ｚｏ軸とする。Ｙｏ軸、Ｚｏ軸は、可能であれば、Ｙｈ軸、Ｚｈ軸にそれぞれ平行な方向に配置される。Ｘｏ軸、Ｙｏ軸、Ｚｏ軸のそれぞれに平行な軸回りの物体２００の回転運動をそれぞれ持ち替え動作のタイプ１、タイプ２、タイプ３とする。
As shown in FIG. 5, the coordinate system Σh of the
図６は、タイプ１の持ち替え動作の例を示している。ここでは、簡略化のため、対向する指２本（母指１０と示指１１）のみを示し、他の指１２、１３の記載は省略している。図６（ａ）に示されるように、対向する指１０、１１のそれぞれの先端で物体２００を把持している初期状態（例えば、机上に載置されている物体２００を持ち上げた直後の状態）である摘み把持形態から、最終的に図６（ｄ）に示されるように、対向する指１０、１１で物体２００を包み込むように把持する形態へと移行する場合、持ち替え動作中の物体２００の自由度は、図６の図示平面内に限られる。最初に、物体２００を母指１０上で転がすことにより、手首側へと引き寄せる（step１）ことで図６（ｂ）に示されるように半包み込み把持形態へと移行する。次に、一旦、物体２００の上側に接触している指１１を物体２００から離し（step２）、図６（ｃ）に示される状態へと移行し、さらに、離隔させた指１１を伸ばして物体２００へと再度接触させる（step３）ことで、図６（ｄ）に示される状態へと移行する。
FIG. 6 shows an example of the
タイプ２の持ち替え動作は、図７（ａ）（ｂ）に示されるように、中指１２を中心に示指１１と薬指１３の接触力を変えることで実現できる。一方、タイプ３の持ち替え動作は、図８（ａ）（ｂ）に示されるように、中指１２に対して、示指１１と薬指１３の一方を伸ばし、他方を縮めることで実現できる。
As shown in FIGS. 7 (a) and 7 (b), the type 2 change-over operation can be realized by changing the contact force between the
任意の持ち替え動作は、このような３軸のそれぞれを回転軸とする回転動作に分解することができ、適切な順序で実行することによって実現できる。ステップＳ１１では、こううして持ち替え動作をタスクに分解し、タスク順序を設定する。 Arbitrary change-over operation can be broken down into rotation operations in which each of the three axes is a rotation axis, and can be realized by executing them in an appropriate order. In step S11, the changeover operation is thus broken down into tasks, and the task order is set.
次に、各タスクの動作制御に入る。まず、ステップＳ１２では、ハンドの現在姿勢を現タスクの初期姿勢に設定し、各関節の初期位置を取り込む。次に、タスク終了時点の目標位置と目標接触力を設定する（ステップＳ１３）。この設定は、事前にシミュレーションや実機での試行試験に基づいて得られた値をＲＡＭ、ＲＯＭ、その他の記憶装置へと格納しておき、これを読み出すことで設定すればよい。なお、このシミュレーションや試行試験は、基本パターンのタスクについてのみ実行しておけば足りるので、シミュレーションや試行試験の回数は最小限ですみ、結果を格納しておく記憶領域も小さくてすむ。 Next, the operation control of each task is started. First, in step S12, the current posture of the hand is set as the initial posture of the current task, and the initial position of each joint is captured. Next, the target position and target contact force at the time of task completion are set (step S13). This setting may be set by storing values obtained in advance based on simulations or trial tests with actual machines in a RAM, ROM, or other storage device and reading them out. The simulation and trial test need only be executed for basic pattern tasks, so the number of simulations and trial tests can be minimized, and the storage area for storing the results can be small.
次に、指ごとにフィードバック制御関節を設定する（ステップＳ１４）。フィードバック制御関節の数は、当該タスクにおいて常に物体に接触する指上の接触点の数と等しく設定される。接触箇所に対応するフィードバック制御関節の関節角度を調整することで接触力を調整することにより、接触力の追従制御が容易となる。 Next, a feedback control joint is set for each finger (step S14). The number of feedback control joints is set equal to the number of contact points on the finger that always touch the object in the task. By adjusting the contact force by adjusting the joint angle of the feedback control joint corresponding to the contact location, the follow-up control of the contact force is facilitated.
通常は、物体２００と指は１カ所で接触するため、フィードバック制御関節は指で１カ所となることが多い。そして、各関節中で接触点の接触力の調整効果が最も大きな関節をフィードバック制御関節に設定するとよい。調整効果が大きければ大きいほど、関節角度の調整量は小さくてすみ、接触力の追従制御の精度が高くなるからである。
Usually, since the
接触力の調整効果は、関節が一定の微少角度だけ回転したときの接触力方向における指先の変位量により評価できる。つまり、関節の回転による指先の変位量が大きな関節ほど調整効果が大きいことになる。これは、指リンク系の運動ヤコビ行列により評価することができる。ヤコビ行列Ｊは式（１）のように定義される。
ここで、ｘ、ｙ、ｚはハンド座標系Σｈにおける指先接触点の座標値であり、θｉは各関節の角度である。例えば、図９に示される３つの能動関節からなる指リンク系を例にとると、接触力方向は、ハンド座標系ΣｈのＺｈ軸に略平行になる。したがって、各関節の回転による指先接触点の接触力方向への影響は、Ｚｈ方向への指先接触点の変位により評価できるから、（１）式の第３行の各要素の絶對値により評価されることになる。図９に示されるリンク系においては、ヤコビ行列Ｊの計算により、関節１の調節効果は略０であり、関節２の調整効果が一番大きくなる。したがって、このリンク系では、関節２がフィードバック制御関節として設定される。なお、実際のヤコビ行列Ｊは、指姿勢によって変わるため、初期位置と最終位置に応じたヤコビ行列をそれぞれ計算し、調節効果の平均値が一番大きい関節をフィードバック制御関節として設定すればよい。設定したフィードバック制御関節以外の能動関節はすべてフィードフォワード制御関節となる。
The effect of adjusting the contact force can be evaluated by the amount of fingertip displacement in the contact force direction when the joint is rotated by a certain minute angle. In other words, the effect of adjustment is greater for joints with larger fingertip displacement due to joint rotation. This can be evaluated by a finger-linked motion Jacobian matrix. The Jacobian matrix J is defined as in equation (1).
Here, x, y, and z are the coordinate values of the fingertip contact point in the hand coordinate system Σh, and θi is the angle of each joint. For example, taking the finger link system including three active joints shown in FIG. 9 as an example, the contact force direction is substantially parallel to the Zh axis of the hand coordinate system Σh. Therefore, the influence of the fingertip contact point on the contact force direction due to the rotation of each joint can be evaluated by the displacement of the fingertip contact point in the Zh direction. Therefore, it is evaluated by the absolute value of each element in the third row of the equation (1). Will be. In the link system shown in FIG. 9, the adjustment effect of the joint 1 is substantially 0 by the calculation of the Jacobian matrix J, and the adjustment effect of the joint 2 is the largest. Therefore, in this link system, the joint 2 is set as a feedback control joint. Since the actual Jacobian matrix J varies depending on the finger posture, the Jacobian matrix corresponding to the initial position and the final position is calculated, and the joint having the largest average adjustment effect may be set as the feedback control joint. All active joints other than the set feedback control joint are feedforward control joints.
ヤコビ行列Ｊの具体的な計算手法を説明する。指全体の座標変換行列は、下記の式（２）により表せる。
ここで、i-1Ｔi（θi）は、第ｉリンクの４×４座標変換行列であり、θiは第ｉ関節の回転角度である。各関節の回転角度θiについて全体座標変換行列の偏導関数（（３）式）を求める。
ヤコビ行列Ｊは、これらの偏導関数を用いて、式（４）により表せる。
Here, i−1 T i (θ i ) is a 4 × 4 coordinate transformation matrix of the i-th link, and θ i is the rotation angle of the i-th joint. The partial derivative (Equation (3)) of the global coordinate transformation matrix is obtained for the rotation angle θ i of each joint.
The Jacobian matrix J can be expressed by Equation (4) using these partial derivatives.
こうして求めたヤコビ行列Ｊの各要素の値を基に、法線接触力方向の要素の絶對値が最大となる関節をフィードバック制御関節とする。法線接触力方向がハンド座標系ΣｈのＸｈ軸方向に一致するならば、ヤコビ行列Ｊの第１行の各値Ｒθ１（１，４）〜Ｒθｎ（１，４）を比較して、最大の絶対値を有する関節番号を選出する。同様に、法線接触力方向がハンド座標系ΣｈのＹｈ軸方向に一致するならば、ヤコビ行列Ｊの第２行の各値Ｒθ１（２，４）〜Ｒθｎ（２，４）を比較して、法線接触力方向がハンド座標系ΣｈのＺｈ軸方向に一致するならば、ヤコビ行列Ｊの第３行の各値Ｒθ１（３，４）〜Ｒθｎ（３，４）を比較して、それぞれ最大の絶対値を有する関節番号を選出する。 Based on the value of each element of the Jacobian matrix J thus obtained, the joint that maximizes the absolute value of the element in the normal contact force direction is defined as a feedback control joint. If the normal contact force direction matches the Xh-axis direction of the hand coordinate system Σh, the values R θ1 (1,4) to R θn (1,4) of the first row of the Jacobian matrix J are compared, The joint number with the largest absolute value is selected. Similarly comparison, if the normal contact force direction coincides with the Yh-axis direction of the hand coordinate system .SIGMA.H, each value R .theta.1 of the second row of the Jacobian matrix J of (2,4) ~R θn (2,4) If the normal contact force direction matches the Zh-axis direction of the hand coordinate system Σh, the values R θ1 (3,4) to R θn (3,4) of the third row of the Jacobian matrix J are compared. Then, each joint number having the maximum absolute value is selected.
法線接触力方向がＸｈ、Ｙｈ、Ｚｈ軸の各方向とは異なる任意の方向である場合には、（５）式で表される法線接触力方向ベクトルへのヤコビ行列の要素の投影値Ｓｉ（（６）式参照。）を比較することで、最大となるＳｉに対応する関節をフィードバック制御関節とする。
なお、指に複数のフィードバック制御関節を設定する場合には、接触力方向ごとに最大となる関節を求めればよい。
When the normal contact force direction is an arbitrary direction different from the directions of the Xh, Yh, and Zh axes, the projection value of the element of the Jacobian matrix onto the normal contact force direction vector expressed by equation (5) By comparing Si (see equation (6)), the joint corresponding to the maximum Si is set as the feedback control joint.
When a plurality of feedback control joints are set on the finger, the joint that is maximized for each contact force direction may be obtained.
フィードバック制御関節の設定が終了したら、フィードフォワード関節の動作時系列指令を設定する（ステップＳ１５）。本制御においては、物体２００と個々の指との接触状態は、フィードバック制御関節の動作によって維持されるので、フィードフォワード関節の運動軌道は任意に決定しうる。時刻ｔにおけるモータ１４の角速度をω（ｔ）で表すと、図１０（ａ）に示されるような等速軌道か図１０（ｂ）に示されるような台形速度軌道を用いると、簡便な制御で高精度の制御を行うことができ、好ましい。
When the setting of the feedback control joint is completed, an operation time series command for the feedforward joint is set (step S15). In this control, the contact state between the
等速軌道により制御する場合の時系列角速度指令値ω（ｔ）は、下記の（７）式により表される。
ここで、θ（Ｔ）は、タスク終了時の目標関節角度であり、θ（０）は、初期関節角度であり、Ｔはタスクの動作時間である。
A time-series angular velocity command value ω (t) in the case of controlling by a constant velocity trajectory is expressed by the following equation (7).
Here, θ (T) is the target joint angle at the end of the task, θ (0) is the initial joint angle, and T is the task operating time.
一方、台形速度軌道により制御する場合の時系列角速度指令値ω（ｔ）は、下記の（８）式により表される。
フィードフォワード関節の運動指令値が設定できたら、動作タスクを実際に開始する。まず、モータドライバ４により、フィードフォワード関節の各モータ１４を設定した運動指令値に基づいて駆動する（ステップＳ１６）。次に、触覚センサ１８の出力を基にして接触力を検知し（ステップＳ１７）、フィードバック制御関節の動きを接触力からフィードバック制御する（ステップＳ１８）。具体的には、角速度指令により制御する場合には、次式（９）式によって制御する。
ここで、ωiは、第ｉ制御ステップにおける関節角速度指令であり、ｋωはフィードバックゲインであり、Ｆrefが目標接触力、Ｆが現在の接触力を表す。一方、角度位置指令で制御する場合は、次式（１０）によって制御する。
ここで、θiは、第ｉ制御ステップにおける関節位置指令であり、ｋθはフィードバックゲインである。
When the motion command value of the feedforward joint can be set, the operation task is actually started. First, the motor driver 4 drives each feed forward
Here, ω i is a joint angular velocity command in the i-th control step, k ω is a feedback gain, F ref is a target contact force, and F is a current contact force. On the other hand, when controlling by an angular position command, it controls by following Formula (10).
Here, θ i is a joint position command in the i-th control step, and k θ is a feedback gain.
なお、接触力が過大である等してフィードバック制御の制御範囲を超えている場合（ステップＳ１９で判定）には、警告を発して（ステップＳ２０）、処理を終了するとよい。ステップＳ１９でフィードバック制御の制御範囲内にある場合には、さらに、ステップＳ２１へと移行してタスクを終了したか否かを判定する。タスクを終了していないと判定した場合には、ステップＳ１６へ戻るループ処理を行うことにより、タスクを継続する。一方、タスクが終了したと判定した場合には、ステップＳ２２へと移行し、次の動作タスクが存在するか否かを判定する。次の動作タスクがある場合には、ステップＳ１２へと戻り、次の動作タスクへと移行する。一方、次の動作タスクがなく、持ち替え制御が終了したと判定した場合には、処理を終了する。 Note that if the contact force exceeds the control range of the feedback control due to excessive force (determined in step S19), a warning is issued (step S20), and the process may be terminated. If it is within the control range of the feedback control in step S19, the process further proceeds to step S21 to determine whether the task is finished. If it is determined that the task has not ended, the task is continued by performing a loop process that returns to step S16. On the other hand, if it is determined that the task is completed, the process proceeds to step S22, and it is determined whether there is a next operation task. If there is a next operation task, the process returns to step S12 and proceeds to the next operation task. On the other hand, if it is determined that there is no next operation task and the switchover control is completed, the process is terminated.
本発明によれば、このようにフィードバック制御により把持力を確保しながら、フィードフォワード制御により指の動きを調整することで、持ち替え動作中のタスクを精度よく安定して実行することが可能となる。 According to the present invention, it is possible to accurately and stably execute the task during the holding operation by adjusting the movement of the finger by the feedforward control while securing the gripping force by the feedback control as described above. .
また、図６のstep２やstep３におけるタスクのように、物体２００と接触していない指を動作させる場合には、フィードフォワード制御のみを行えばよく、フィードバック制御は必要ない。
In addition, when a finger that is not in contact with the
このようにして分解したタスクを順に実行していくことによって複雑な持ち替え動作でも実現することが可能となる。特に、形状等を学習していない未知の物体の持ち替えにおいても対応することができ、汎用性の高い制御動作が実現できる。 By executing the decomposed tasks in this way in order, it is possible to realize even a complicated changeover operation. In particular, it is possible to cope with a change of an unknown object whose shape or the like has not been learned, and a highly versatile control operation can be realized.
１…ロボットハンド、３…カメラアイ、４…モータドライバ、７…アーム、８…胴体、１０…母指、１１…示指、１２…中指、１３…薬指、１４…モータ、１６…エンコーダポテンションメータ、１７…連動関節、１８…触覚センサ、２０…画像認識部、２１…ハンド位置姿勢演算部、２２…ＦＢ制御関節決定部、２３…ＦＦ制御関節指令生成部、２４…ロボットハンド制御部、１００…ロボット、２００…物体。
DESCRIPTION OF
Claims (1)
前記初期位置関係から前記目標位置関係へと至る前記ロボットハンドの指動作を段階的な関節の回転動作に分解して該回転動作を行う順序を設定する工程と、
前記回転動作ごとに、各指が前記把持物体と接触する接触点数を判定する工程と、
前記回転動作ごとに、各関節中で接触力の調整効果の高い関節として関節角度を一定量回転させた際に前記把持物体との接触力方向への変位量が大きい関節を前記接触点数と同数抽出する工程と、
前記抽出された関節をフィードバック制御関節に設定し、それ以外の関節にフィードフォワード制御による運動指令値を設定する工程と、
前記フィードバック制御関節以外の関節の動きを設定した運動指令値に基づいてフィードフォワード制御するとともに、前記フィードバック制御関節の動きを力覚センサの値に基づいて接触力にフィードバックすることにより制御する工程と、
を備えていることを特徴とするロボットハンドの持ち替え把持制御方法。 In the robot hand having a plurality of active joints and a plurality of fingers having force sensors, a holding operation is performed to change the positional relationship between the grasped object and the robot hand from the initial positional relationship to another target positional relationship. In the grip control method,
Disassembling the finger motion of the robot hand from the initial positional relationship to the target positional relationship into a stepwise joint rotational motion and setting the order of performing the rotational motion;
For each of the rotational operation, the steps of each finger to determine the number of contact points in contact with the object to be held,
When the joint angle is rotated by a certain amount as a joint having a high contact force adjustment effect in each joint for each rotation operation , the number of joints having a large displacement amount in the contact force direction with the gripping object is equal to the number of contact points. Extracting, and
Setting the extracted joint as a feedback control joint, and setting a motion command value by feedforward control to the other joint; and
Feedforward control based on a motion command value in which movements of joints other than the feedback control joint are set, and controlling the movement of the feedback control joint by feeding back to a contact force based on a value of a force sensor; ,
A holding / holding control method for a robot hand characterized by comprising:
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2005140084A JP4715296B2 (en) | 2005-05-12 | 2005-05-12 | Robot hand holding and gripping control method. |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2005140084A JP4715296B2 (en) | 2005-05-12 | 2005-05-12 | Robot hand holding and gripping control method. |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| JP2006315128A JP2006315128A (en) | 2006-11-24 |
| JP4715296B2 true JP4715296B2 (en) | 2011-07-06 |
Family
ID=37536234
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| JP2005140084A Expired - Fee Related JP4715296B2 (en) | 2005-05-12 | 2005-05-12 | Robot hand holding and gripping control method. |
Country Status (1)
| Country | Link |
|---|---|
| JP (1) | JP4715296B2 (en) |
Families Citing this family (4)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP2008178930A (en) * | 2007-01-23 | 2008-08-07 | Fuji Electric Holdings Co Ltd | Workpiece gripping method of robot and robot |
| JP4965413B2 (en) * | 2007-11-26 | 2012-07-04 | トヨタ自動車株式会社 | Robot hand |
| JP5289179B2 (en) * | 2009-05-14 | 2013-09-11 | 本田技研工業株式会社 | Robot hand and its control system, control method and control program |
| JP6640792B2 (en) * | 2017-06-30 | 2020-02-05 | ファナック株式会社 | Hand control device, hand control method, and hand simulation device |
Citations (2)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JPH03196983A (en) * | 1989-12-22 | 1991-08-28 | Mitsubishi Heavy Ind Ltd | Control method for human type robot finger mechanism |
| JP2003245883A (en) * | 2002-02-25 | 2003-09-02 | Gifu Univ | Robot hand and method for controlling grip of robot hand, and robot and method for controlling the same |
-
2005
- 2005-05-12 JP JP2005140084A patent/JP4715296B2/en not_active Expired - Fee Related
Patent Citations (2)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JPH03196983A (en) * | 1989-12-22 | 1991-08-28 | Mitsubishi Heavy Ind Ltd | Control method for human type robot finger mechanism |
| JP2003245883A (en) * | 2002-02-25 | 2003-09-02 | Gifu Univ | Robot hand and method for controlling grip of robot hand, and robot and method for controlling the same |
Also Published As
| Publication number | Publication date |
|---|---|
| JP2006315128A (en) | 2006-11-24 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| JP5685027B2 (en) | Information processing apparatus, object gripping system, robot system, information processing method, object gripping method, and program | |
| JP5505138B2 (en) | Robot apparatus and gripping method using robot apparatus | |
| JP6450960B2 (en) | Robot, robot system and teaching method | |
| JP5580850B2 (en) | Fast grip contact calculation for serial robots | |
| JP4001105B2 (en) | Grasping method of arbitrarily shaped object by robot | |
| JP5560948B2 (en) | Robot equipment | |
| JP7044047B2 (en) | robot | |
| JP2010064155A (en) | Holding device | |
| CN114025928A (en) | End effector control system and end effector control method | |
| JP6322949B2 (en) | Robot control apparatus, robot system, robot, robot control method, and robot control program | |
| JP4715296B2 (en) | Robot hand holding and gripping control method. | |
| JP2006212741A (en) | Task skill generating device | |
| JP4591043B2 (en) | Method of gripping an arbitrarily shaped object by a robot | |
| JP4033050B2 (en) | Robot hand gripping control device | |
| JP2006341372A (en) | Method for controlling robot | |
| JP4737099B2 (en) | Robot and robot control apparatus and control method | |
| JPWO2019065427A1 (en) | Robot hand system control method and robot hand system | |
| JP2007216367A (en) | Device and method for holding object | |
| JP4640499B2 (en) | Grip control device | |
| JP2015085499A (en) | Robot, robot system, control device and control method | |
| TWI781708B (en) | Learning apparatus, learning method, learning program, control apparatus, control method, and control program | |
| JP7504398B2 (en) | Trajectory generation device, trajectory generation method, and trajectory generation program | |
| JP2009196040A (en) | Robot system | |
| JP7159525B2 (en) | ROBOT CONTROL DEVICE, LEARNING DEVICE, AND ROBOT CONTROL SYSTEM | |
| JP2005335010A (en) | Gripping control device |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20070723 |
|
| A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20080512 |
|
| A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20080520 |
|
| A521 | Written amendment |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20080716 |
|
| A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20090512 |
|
| A521 | Written amendment |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20090703 |
|
| A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20100330 |
|
| A521 | Written amendment |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20100427 |
|
| A01 | Written decision to grant a patent or to grant a registration (utility model) |
Free format text: JAPANESE INTERMEDIATE CODE: A01 Effective date: 20110301 |
|
| A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20110314 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20140408 Year of fee payment: 3 |
|
| LAPS | Cancellation because of no payment of annual fees |