def synchronize(self, _pandaCJoint, _smrJoint): #_smrJoint.setRot(3.14/20.0,0,0); smrQuaternion = _smrJoint.getRot() pandaQuaternion = Quat() pandaQuaternion.setI(smrQuaternion.getX()) pandaQuaternion.setJ(smrQuaternion.getY()) pandaQuaternion.setK(smrQuaternion.getZ()) pandaQuaternion.setR(smrQuaternion.getW()) _pandaCJoint.setQuat(pandaQuaternion)
def synchronize(self, _pandaCJoint, _smrJoint): smrQuaternion = _smrJoint.getRot() pandaQuaternion = Quat() pandaQuaternion.setI(smrQuaternion.getX()) pandaQuaternion.setJ(smrQuaternion.getY()) pandaQuaternion.setK(smrQuaternion.getZ()) pandaQuaternion.setR(smrQuaternion.getW()) if not (pandaQuaternion.isNan()): _pandaCJoint.setQuat(pandaQuaternion)