예제 #1
0
파일: FK.cpp 프로젝트: bchretien/RBDyn
void sForwardKinematics(const MultiBody& mb, MultiBodyConfig& mbc)
{
	checkMatchQ(mb, mbc);

	checkMatchBodyPos(mb, mbc);
	checkMatchJointConf(mb, mbc);
	checkMatchParentToSon(mb, mbc);

	forwardKinematics(mb, mbc);
}
예제 #2
0
파일: IK.cpp 프로젝트: aescande/RBDyn
bool InverseKinematics::sInverseKinematics(const MultiBody& mb, MultiBodyConfig& mbc,
					   const sva::PTransformd& ef_target)
{
	checkMatchQ(mb, mbc);
	checkMatchBodyPos(mb, mbc);
	checkMatchJointConf(mb, mbc);
	checkMatchParentToSon(mb, mbc);

	return inverseKinematics(mb, mbc, ef_target);
}
예제 #3
0
파일: FV.cpp 프로젝트: aescande/RBDyn
void sForwardVelocity(const MultiBody& mb, MultiBodyConfig& mbc)
{
	checkMatchAlpha(mb, mbc);
	checkMatchBodyPos(mb, mbc);
	checkMatchJointConf(mb, mbc);
	checkMatchParentToSon(mb, mbc);

	checkMatchBodyVel(mb, mbc);
	checkMatchJointVelocity(mb, mbc);
	checkMatchMotionSubspace(mb, mbc);

	forwardVelocity(mb, mbc);
}