Ejemplo n.º 1
0
void sForwardKinematics(const MultiBody& mb, MultiBodyConfig& mbc)
{
	checkMatchQ(mb, mbc);

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

	forwardKinematics(mb, mbc);
}
Ejemplo n.º 2
0
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);
}
Ejemplo n.º 3
0
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);
}