本文整理了Java中us.ihmc.euclid.tuple4D.interfaces.QuaternionBasics.setQuaternion
方法的一些代码示例,展示了QuaternionBasics.setQuaternion
的具体用法。这些代码示例主要来源于Github
/Stackoverflow
/Maven
等平台,是从一些精选项目中提取出来的代码,具有较强的参考意义,能在一定程度帮忙到你。QuaternionBasics.setQuaternion
方法的具体详情如下:
包路径:us.ihmc.euclid.tuple4D.interfaces.QuaternionBasics
类名称:QuaternionBasics
方法名:setQuaternion
暂无
代码示例来源:origin: us.ihmc/ihmc-humanoid-robotics
public void updateFullRobotModel(KinematicsToolboxOutputStatus solution)
{
if (jointsHashCode != solution.getJointNameHash())
throw new RuntimeException("Hashes are different.");
for (int i = 0; i < oneDoFJoints.length; i++)
{
float q = solution.getDesiredJointAngles().get(i);
OneDoFJointBasics joint = oneDoFJoints[i];
joint.setQ(q);
}
Vector3D translation = solution.getDesiredRootTranslation();
rootJoint.getJointPose().setPosition(translation.getX(), translation.getY(), translation.getZ());
Quaternion orientation = solution.getDesiredRootOrientation();
rootJoint.getJointPose().getOrientation().setQuaternion(orientation.getX(), orientation.getY(), orientation.getZ(), orientation.getS());
fullRobotModelToUseForConversion.updateFrames();
}
代码示例来源:origin: us.ihmc/ihmc-avatar-interfaces
rootJoint.getJointPose().setPosition(translation.getX(), translation.getY(), translation.getZ());
Quaternion orientation = robotConfigurationData.getRootOrientation();
rootJoint.getJointPose().getOrientation().setQuaternion(orientation.getX(), orientation.getY(), orientation.getZ(), orientation.getS());
rootJoint.getPredecessor().updateFramesRecursively();
代码示例来源:origin: us.ihmc/ihmc-avatar-interfaces
@Override
public void receivedPacket(RobotConfigurationData packet)
{
latestRobotConfigurationData = packet;
FloatingJointBasics rootJoint = fullRobotModel.getRootJoint();
TFloatArrayList newJointAngles = packet.getJointAngles();
TFloatArrayList newJointVelocities = packet.getJointAngles();
TFloatArrayList newJointTorques = packet.getJointTorques();
OneDoFJointBasics[] oneDoFJoints = fullRobotModel.getOneDoFJoints();
for (int i = 0; i < newJointAngles.size(); i++)
{
oneDoFJoints[i].setQ(newJointAngles.get(i));
oneDoFJoints[i].setQd(newJointVelocities.get(i));
oneDoFJoints[i].setTau(newJointTorques.get(i));
}
pelvisTranslationFromRobotConfigurationData.set(packet.getRootTranslation());
pelvisOrientationFromRobotConfigurationData.set(packet.getRootOrientation());
rootJoint.getJointPose().setPosition(pelvisTranslationFromRobotConfigurationData.getX(), pelvisTranslationFromRobotConfigurationData.getY(), pelvisTranslationFromRobotConfigurationData.getZ());
rootJoint.getJointPose().getOrientation().setQuaternion(pelvisOrientationFromRobotConfigurationData.getX(), pelvisOrientationFromRobotConfigurationData.getY(), pelvisOrientationFromRobotConfigurationData.getZ(), pelvisOrientationFromRobotConfigurationData.getS());
computeDriftTransform();
rootJoint.getPredecessor().updateFramesRecursively();
yoVariableServer.update(System.currentTimeMillis());
}
代码示例来源:origin: us.ihmc/ihmc-avatar-interfaces
desiredRootJoint.getJointPose().setPosition(translation.getX(), translation.getY(), translation.getZ());
Quaternion orientation = robotConfigurationData.getRootOrientation();
desiredRootJoint.getJointPose().getOrientation().setQuaternion(orientation.getX(), orientation.getY(), orientation.getZ(), orientation.getS());
desiredRootJoint.setJointVelocity(0, new DenseMatrix64F(6, 1));
内容来源于网络,如有侵权,请联系作者删除!