プラグイン名:SoftFingerStability
依存プラグイン:Grasp;GeometryHandler
・ソフトフィンガを持つハンドの把持安定性を計算します
・Enパラメータ計算方法の説明(EnCalculationAlgorithm.pdf)
SoftFingerStabilityプラグインを使用できるようにします。
SoftFingerStabilityHandler.hをインクルードします。
#include "../SoftFingerStablity/ConstraintIK.h
double Q; // 把持安定性評価値
int nContact; // 接触点数
vector< Vector3> objPos(nContact); // 接触点座標
vector< Vector3> objN(nContact); // 接触点法線ベクトル
// 接触点を求めるコードをここに記述
// ....
//
// 把持安定性評価値を計算する
SoftFingerStabilityHandler::instance()->initialize();
Q = SoftFingerStabilityHandler::instance()->calcStability(nContact,&objPos[0],&objN[0]);
ハンドのポリゴンモデルに閉じたポリゴンモデル以外を使用すると、把持安定性評価値が正しく計算されません。