/dports/devel/ode/ode-0.13/tests/joints/ |
H A D | fixed.cpp | 78 CHECK_CLOSE (joint->qrel[0], 1.0, 1e-4); in SUITE() 79 CHECK_CLOSE (joint->qrel[1], 0.0, 1e-4); in SUITE() 80 CHECK_CLOSE (joint->qrel[2], 0.0, 1e-4); in SUITE() 81 CHECK_CLOSE (joint->qrel[3], 0.0, 1e-4); in SUITE() 92 CHECK_CLOSE (joint->qrel[2], 0.0, 1e-4); in SUITE() 93 CHECK_CLOSE (joint->qrel[3], 0.0, 1e-4); in SUITE() 104 CHECK_CLOSE (joint->qrel[2], 0.0, 1e-4); in SUITE() 105 CHECK_CLOSE (joint->qrel[3], 0.0, 1e-4); in SUITE() 115 CHECK_CLOSE (joint->qrel[1], 0.0, 1e-4); in SUITE() 116 CHECK_CLOSE (joint->qrel[2], 0.0, 1e-4); in SUITE() [all …]
|
H A D | slider.cpp | 79 CHECK_CLOSE (joint->qrel[0], 1.0, 1e-4); in SUITE() 80 CHECK_CLOSE (joint->qrel[1], 0.0, 1e-4); in SUITE() 81 CHECK_CLOSE (joint->qrel[2], 0.0, 1e-4); in SUITE() 82 CHECK_CLOSE (joint->qrel[3], 0.0, 1e-4); in SUITE() 93 CHECK_CLOSE (joint->qrel[2], 0.0, 1e-4); in SUITE() 94 CHECK_CLOSE (joint->qrel[3], 0.0, 1e-4); in SUITE() 105 CHECK_CLOSE (joint->qrel[2], 0.0, 1e-4); in SUITE() 106 CHECK_CLOSE (joint->qrel[3], 0.0, 1e-4); in SUITE() 116 CHECK_CLOSE (joint->qrel[1], 0.0, 1e-4); in SUITE() 117 CHECK_CLOSE (joint->qrel[2], 0.0, 1e-4); in SUITE() [all …]
|
/dports/games/alienarena/alienarena-7.66/source/unix/odesrc/joints/ |
H A D | universal.cpp | 79 dQuaternion qcross, qq, qrel; in getAngles() local 107 dQMultiply2( qrel, qq, qrel1 ); in getAngles() 138 qrel[2] = ax1[1] + ax2[1]; in getAngles() 139 qrel[3] = ax1[2] + ax2[2]; in getAngles() 141 dReal l = dRecip( sqrt( qrel[1] * qrel[1] + qrel[2] * qrel[2] + qrel[3] * qrel[3] ) ); in getAngles() 142 qrel[1] *= l; in getAngles() 143 qrel[2] *= l; in getAngles() 144 qrel[3] *= l; in getAngles() 176 dQuaternion qcross, qq, qrel; in getAngle1() local 202 dQMultiply2( qrel, qq, qrel1 ); in getAngle1() [all …]
|
H A D | hinge.cpp | 40 dSetZero( qrel, 4 ); in dxJointHinge() 61 axis1, qrel ); in getInfo1() 217 dQMultiply3(qOffset, qAngle, joint->qrel); in dJointSetHingeAxisOffset() 218 joint->qrel[0] = qOffset[0]; in dJointSetHingeAxisOffset() 219 joint->qrel[1] = qOffset[1]; in dJointSetHingeAxisOffset() 220 joint->qrel[2] = qOffset[2]; in dJointSetHingeAxisOffset() 221 joint->qrel[3] = qOffset[3]; in dJointSetHingeAxisOffset() 381 qrel[0] = node[0].body->q[0]; in computeInitialRelativeRotation() 382 qrel[1] = -node[0].body->q[1]; in computeInitialRelativeRotation() 383 qrel[2] = -node[0].body->q[2]; in computeInitialRelativeRotation() [all …]
|
H A D | fixed.cpp | 36 dSetZero ( qrel, 4 ); in dxJointFixed() 56 setFixedOrientation ( this, info, qrel, 3 ); in getInfo2() 192 dQMultiply1 (qrel, node[0].body->q, node[1].body->q ); in computeInitialRelativeRotation() 197 qrel[0] = node[0].body->q[0]; in computeInitialRelativeRotation() 198 qrel[1] = -node[0].body->q[1]; in computeInitialRelativeRotation() 199 qrel[2] = -node[0].body->q[2]; in computeInitialRelativeRotation() 200 qrel[3] = -node[0].body->q[3]; in computeInitialRelativeRotation()
|
H A D | joint.cpp | 190 void setFixedOrientation( dxJoint *joint, dxJoint::Info2 *info, dQuaternion qrel, int start_row ) in setFixedOrientation() argument 226 dQMultiply2( qerr, qq, qrel ); in setFixedOrientation() 230 dQMultiply3( qerr, joint->node[0].body->q, qrel ); in setFixedOrientation() 369 dReal getHingeAngleFromRelativeQuat( dQuaternion qrel, dVector3 axis ) in getHingeAngleFromRelativeQuat() argument 394 dReal cost2 = qrel[0]; in getHingeAngleFromRelativeQuat() 395 dReal sint2 = dSqrt( qrel[1] * qrel[1] + qrel[2] * qrel[2] + qrel[3] * qrel[3] ); in getHingeAngleFromRelativeQuat() 396 dReal theta = ( dDOT( qrel + 1, axis ) >= 0 ) ? // @@@ padding assumptions in getHingeAngleFromRelativeQuat() 424 dQuaternion qrel; in getHingeAngle() local 429 dQMultiply2( qrel, qq, q_initial ); in getHingeAngle() 434 dQMultiply3( qrel, body1->q, q_initial ); in getHingeAngle() [all …]
|
H A D | slider.cpp | 37 dSetZero ( qrel, 4 ); in dxJointSlider() 167 setFixedOrientation ( this, info, qrel, 0 ); in getInfo2() 357 dQMultiply1 ( qrel, node[0].body->q, node[1].body->q ); in computeInitialRelativeRotation() 362 qrel[0] = node[0].body->q[0]; in computeInitialRelativeRotation() 363 qrel[1] = -node[0].body->q[1]; in computeInitialRelativeRotation() 364 qrel[2] = -node[0].body->q[2]; in computeInitialRelativeRotation() 365 qrel[3] = -node[0].body->q[3]; in computeInitialRelativeRotation()
|
H A D | joint_internal.h | 58 dReal getHingeAngleFromRelativeQuat( dQuaternion qrel, dVector3 axis ); 60 void setFixedOrientation( dxJoint *joint, dxJoint::Info2 *info, dQuaternion qrel, int start_row );
|
H A D | pr.cpp | 53 dSetZero( qrel, 4 ); in dxJointPR() 147 joint->qrel ); in dJointGetPRAngle() 206 axisR1, qrel ); in getInfo1() 446 dQMultiply1( qrel, node[0].body->q, node[1].body->q ); in computeInitialRelativeRotation() 451 qrel[0] = node[0].body->q[0]; in computeInitialRelativeRotation() 453 qrel[i] = -node[0].body->q[i]; in computeInitialRelativeRotation()
|
/dports/games/alienarena-data/alienarena-7.66/source/unix/odesrc/joints/ |
H A D | universal.cpp | 79 dQuaternion qcross, qq, qrel; in getAngles() local 107 dQMultiply2( qrel, qq, qrel1 ); in getAngles() 138 qrel[2] = ax1[1] + ax2[1]; in getAngles() 139 qrel[3] = ax1[2] + ax2[2]; in getAngles() 141 dReal l = dRecip( sqrt( qrel[1] * qrel[1] + qrel[2] * qrel[2] + qrel[3] * qrel[3] ) ); in getAngles() 142 qrel[1] *= l; in getAngles() 143 qrel[2] *= l; in getAngles() 144 qrel[3] *= l; in getAngles() 176 dQuaternion qcross, qq, qrel; in getAngle1() local 202 dQMultiply2( qrel, qq, qrel1 ); in getAngle1() [all …]
|
H A D | hinge.cpp | 40 dSetZero( qrel, 4 ); in dxJointHinge() 61 axis1, qrel ); in getInfo1() 217 dQMultiply3(qOffset, qAngle, joint->qrel); in dJointSetHingeAxisOffset() 218 joint->qrel[0] = qOffset[0]; in dJointSetHingeAxisOffset() 219 joint->qrel[1] = qOffset[1]; in dJointSetHingeAxisOffset() 220 joint->qrel[2] = qOffset[2]; in dJointSetHingeAxisOffset() 221 joint->qrel[3] = qOffset[3]; in dJointSetHingeAxisOffset() 381 qrel[0] = node[0].body->q[0]; in computeInitialRelativeRotation() 382 qrel[1] = -node[0].body->q[1]; in computeInitialRelativeRotation() 383 qrel[2] = -node[0].body->q[2]; in computeInitialRelativeRotation() [all …]
|
H A D | fixed.cpp | 36 dSetZero ( qrel, 4 ); in dxJointFixed() 56 setFixedOrientation ( this, info, qrel, 3 ); in getInfo2() 192 dQMultiply1 (qrel, node[0].body->q, node[1].body->q ); in computeInitialRelativeRotation() 197 qrel[0] = node[0].body->q[0]; in computeInitialRelativeRotation() 198 qrel[1] = -node[0].body->q[1]; in computeInitialRelativeRotation() 199 qrel[2] = -node[0].body->q[2]; in computeInitialRelativeRotation() 200 qrel[3] = -node[0].body->q[3]; in computeInitialRelativeRotation()
|
H A D | joint.cpp | 190 void setFixedOrientation( dxJoint *joint, dxJoint::Info2 *info, dQuaternion qrel, int start_row ) in setFixedOrientation() argument 226 dQMultiply2( qerr, qq, qrel ); in setFixedOrientation() 230 dQMultiply3( qerr, joint->node[0].body->q, qrel ); in setFixedOrientation() 369 dReal getHingeAngleFromRelativeQuat( dQuaternion qrel, dVector3 axis ) in getHingeAngleFromRelativeQuat() argument 394 dReal cost2 = qrel[0]; in getHingeAngleFromRelativeQuat() 395 dReal sint2 = dSqrt( qrel[1] * qrel[1] + qrel[2] * qrel[2] + qrel[3] * qrel[3] ); in getHingeAngleFromRelativeQuat() 396 dReal theta = ( dDOT( qrel + 1, axis ) >= 0 ) ? // @@@ padding assumptions in getHingeAngleFromRelativeQuat() 424 dQuaternion qrel; in getHingeAngle() local 429 dQMultiply2( qrel, qq, q_initial ); in getHingeAngle() 434 dQMultiply3( qrel, body1->q, q_initial ); in getHingeAngle() [all …]
|
H A D | slider.cpp | 37 dSetZero ( qrel, 4 ); in dxJointSlider() 167 setFixedOrientation ( this, info, qrel, 0 ); in getInfo2() 357 dQMultiply1 ( qrel, node[0].body->q, node[1].body->q ); in computeInitialRelativeRotation() 362 qrel[0] = node[0].body->q[0]; in computeInitialRelativeRotation() 363 qrel[1] = -node[0].body->q[1]; in computeInitialRelativeRotation() 364 qrel[2] = -node[0].body->q[2]; in computeInitialRelativeRotation() 365 qrel[3] = -node[0].body->q[3]; in computeInitialRelativeRotation()
|
H A D | joint_internal.h | 58 dReal getHingeAngleFromRelativeQuat( dQuaternion qrel, dVector3 axis ); 60 void setFixedOrientation( dxJoint *joint, dxJoint::Info2 *info, dQuaternion qrel, int start_row );
|
H A D | pr.cpp | 53 dSetZero( qrel, 4 ); in dxJointPR() 147 joint->qrel ); in dJointGetPRAngle() 206 axisR1, qrel ); in getInfo1() 446 dQMultiply1( qrel, node[0].body->q, node[1].body->q ); in computeInitialRelativeRotation() 451 qrel[0] = node[0].body->q[0]; in computeInitialRelativeRotation() 453 qrel[i] = -node[0].body->q[i]; in computeInitialRelativeRotation()
|
/dports/devel/ode/ode-0.13/ode/src/joints/ |
H A D | universal.cpp | 81 dQuaternion qcross, qq, qrel; in getAngles() local 109 dQMultiply2( qrel, qq, qrel1 ); in getAngles() 140 qrel[2] = ax1[1] + ax2[1]; in getAngles() 141 qrel[3] = ax1[2] + ax2[2]; in getAngles() 143 dReal l = dRecip( sqrt( qrel[1] * qrel[1] + qrel[2] * qrel[2] + qrel[3] * qrel[3] ) ); in getAngles() 144 qrel[1] *= l; in getAngles() 145 qrel[2] *= l; in getAngles() 146 qrel[3] *= l; in getAngles() 178 dQuaternion qcross, qq, qrel; in getAngle1() local 204 dQMultiply2( qrel, qq, qrel1 ); in getAngle1() [all …]
|
H A D | hinge.cpp | 42 dSetZero( qrel, 4 ); in dxJointHinge() 70 axis1, qrel ); in getInfo1() 226 joint->qrel[0] = qOffset[0]; in dJointSetHingeAxisOffset() 227 joint->qrel[1] = qOffset[1]; in dJointSetHingeAxisOffset() 228 joint->qrel[2] = qOffset[2]; in dJointSetHingeAxisOffset() 229 joint->qrel[3] = qOffset[3]; in dJointSetHingeAxisOffset() 298 joint->qrel ); in dJointGetHingeAngle() 389 qrel[0] = node[0].body->q[0]; in computeInitialRelativeRotation() 390 qrel[1] = -node[0].body->q[1]; in computeInitialRelativeRotation() 391 qrel[2] = -node[0].body->q[2]; in computeInitialRelativeRotation() [all …]
|
H A D | fixed.cpp | 38 dSetZero ( qrel, 4 ); in dxJointFixed() 65 setFixedOrientation ( this, worldFPS, worldERP, info, qrel, 3 ); in getInfo2() 207 dQMultiply1 (qrel, node[0].body->q, node[1].body->q ); in computeInitialRelativeRotation() 212 qrel[0] = node[0].body->q[0]; in computeInitialRelativeRotation() 213 qrel[1] = -node[0].body->q[1]; in computeInitialRelativeRotation() 214 qrel[2] = -node[0].body->q[2]; in computeInitialRelativeRotation() 215 qrel[3] = -node[0].body->q[3]; in computeInitialRelativeRotation()
|
H A D | joint.cpp | 235 …nt *joint, dReal fps, dReal erp, const dxJoint::Info2Descr *info, dQuaternion qrel, int start_row ) in setFixedOrientation() argument 274 dQMultiply2( qerr, qq, qrel ); in setFixedOrientation() 278 dQMultiply3( qerr, b0->q, qrel ); in setFixedOrientation() 428 dReal getHingeAngleFromRelativeQuat( dQuaternion qrel, dVector3 axis ) in getHingeAngleFromRelativeQuat() argument 453 dReal cost2 = qrel[0]; in getHingeAngleFromRelativeQuat() 454 dReal sint2 = dSqrt( qrel[1] * qrel[1] + qrel[2] * qrel[2] + qrel[3] * qrel[3] ); in getHingeAngleFromRelativeQuat() 455 dReal theta = ( dCalcVectorDot3( qrel + 1, axis ) >= 0 ) ? // @@@ padding assumptions in getHingeAngleFromRelativeQuat() 483 dQuaternion qrel; in getHingeAngle() local 488 dQMultiply2( qrel, qq, q_initial ); in getHingeAngle() 493 dQMultiply3( qrel, body1->q, q_initial ); in getHingeAngle() [all …]
|
H A D | slider.cpp | 39 dSetZero ( qrel, 4 ); in dxJointSlider() 176 setFixedOrientation ( this, worldFPS, worldERP, info, qrel, 0 ); in getInfo2() 368 dQMultiply1 ( qrel, node[0].body->q, node[1].body->q ); in computeInitialRelativeRotation() 373 qrel[0] = node[0].body->q[0]; in computeInitialRelativeRotation() 374 qrel[1] = -node[0].body->q[1]; in computeInitialRelativeRotation() 375 qrel[2] = -node[0].body->q[2]; in computeInitialRelativeRotation() 376 qrel[3] = -node[0].body->q[3]; in computeInitialRelativeRotation()
|
H A D | joint_internal.h | 58 dReal getHingeAngleFromRelativeQuat( dQuaternion qrel, dVector3 axis ); 60 …t *joint, dReal fps, dReal erp, const dxJoint::Info2Descr *info, dQuaternion qrel, int start_row );
|
H A D | pr.cpp | 55 dSetZero( qrel, 4 ); in dxJointPR() 149 joint->qrel ); in dJointGetPRAngle() 216 axisR1, qrel ); in getInfo1() 456 dQMultiply1( qrel, node[0].body->q, node[1].body->q ); in computeInitialRelativeRotation() 461 qrel[0] = node[0].body->q[0]; in computeInitialRelativeRotation() 463 qrel[i] = -node[0].body->q[i]; in computeInitialRelativeRotation()
|
/dports/math/gecode/gecode-0916a1a/contribs/quacode/examples/ |
H A D | qbf.cpp | 171 qrel(*this, qa, BOT_XOR, qd, O[6]); in QBFProblem() 172 qrel(*this, qc, BOT_OR, O[6], O[5]); in QBFProblem() 173 qrel(*this, qc, BOT_IMP, qd, O[4]); in QBFProblem() 174 qrel(*this, O[4], BOT_AND, O[5], O[3]); in QBFProblem() 175 qrel(*this, qb, BOT_IMP, O[3], O[2]); in QBFProblem() 176 qrel(*this, qc, BOT_OR, qb, O[1]); in QBFProblem() 177 qrel(*this, O[1], BOT_AND, O[2], O[0]); in QBFProblem()
|
/dports/math/mpexpr/mpexpr-1.2/generic/ |
H A D | qtrans.c | 69 while (qrel(term, epsilon2) > 0) { 186 if ((qrel(q, &_qone_) > 0) || (qrel(q, &_qnegone_) < 0)) 203 if (qrel(q, &_qonehalf_) > 0) { 240 while (qrel(term, epsilon2) > 0) { 302 if ((qrel(q, &_qone_) > 0) || (qrel(q, &_qnegone_) < 0)) 529 while (qrel(term, epsilon2) > 0) { 611 while (qrel(q, maxr) > 0) { 634 while (qrel(term, epsilon2) > 0) { 782 while (qrel(term, epsilon2) > 0) {
|