Lines Matching refs:r
48 void C_QUATAdd( const Quaternion *p, const Quaternion *q, Quaternion *r ) in C_QUATAdd() argument
52 ASSERTMSG( ( r != 0 ), QUAT_ADD_3 ); in C_QUATAdd()
54 r->x = p->x + q->x; in C_QUATAdd()
55 r->y = p->y + q->y; in C_QUATAdd()
56 r->z = p->z + q->z; in C_QUATAdd()
57 r->w = p->w + q->w; in C_QUATAdd()
66 void PSQUATAdd( const Quaternion *p, const Quaternion *q, Quaternion *r ) in PSQUATAdd() argument
86 __PSQ_STX(r, 0, rxy, 0, 0); in PSQUATAdd()
104 __PSQ_STX(r, 8, rzw, 0, 0); in PSQUATAdd()
122 void C_QUATSubtract( const Quaternion *p, const Quaternion *q, Quaternion *r ) in C_QUATSubtract() argument
126 ASSERTMSG( ( r != 0 ), QUAT_SUBTRACT_3 ); in C_QUATSubtract()
128 r->x = p->x - q->x; in C_QUATSubtract()
129 r->y = p->y - q->y; in C_QUATSubtract()
130 r->z = p->z - q->z; in C_QUATSubtract()
131 r->w = p->w - q->w; in C_QUATSubtract()
140 void PSQUATSubtract( const Quaternion *p, const Quaternion *q, Quaternion *r ) in PSQUATSubtract() argument
160 __PSQ_STX(r, 0, rxy, 0, 0); in PSQUATSubtract()
178 __PSQ_STX(r, 8, rzw, 0, 0); in PSQUATSubtract()
200 Quaternion *r; in C_QUATMultiply() local
209 r = &pqTmp; in C_QUATMultiply()
213 r = pq; in C_QUATMultiply()
216 r->w = p->w*q->w - p->x*q->x - p->y*q->y - p->z*q->z; in C_QUATMultiply()
217 r->x = p->w*q->x + p->x*q->w + p->y*q->z - p->z*q->y; in C_QUATMultiply()
218 r->y = p->w*q->y + p->y*q->w + p->z*q->x - p->x*q->z; in C_QUATMultiply()
219 r->z = p->w*q->z + p->z*q->w + p->x*q->y - p->y*q->x; in C_QUATMultiply()
221 if ( r == &pqTmp ) in C_QUATMultiply()
356 void C_QUATScale( const Quaternion *q, Quaternion *r, f32 scale ) in C_QUATScale() argument
359 ASSERTMSG( ( r != 0 ), QUAT_SCALE_2 ); in C_QUATScale()
361 r->x = q->x * scale; in C_QUATScale()
362 r->y = q->y * scale; in C_QUATScale()
363 r->z = q->z * scale; in C_QUATScale()
364 r->w = q->w * scale; in C_QUATScale()
374 void PSQUATScale( const Quaternion *q, Quaternion *r, f32 scale ) in PSQUATScale() argument
395 __PSQ_STX(r, 0, rxy, 0, 0); in PSQUATScale()
403 __PSQ_STX(r, 8, rzw, 0, 0); in PSQUATScale()
734 void C_QUATDivide( const Quaternion *p, const Quaternion *q, Quaternion *r ) in C_QUATDivide() argument
740 ASSERTMSG( ( r != 0 ), QUAT_DIVIDE_3 ); in C_QUATDivide()
743 C_QUATMultiply(&qtmp, p, r); in C_QUATDivide()
753 void PSQUATDivide( const Quaternion *p, const Quaternion *q, Quaternion *r ) in PSQUATDivide() argument
758 PSQUATMultiply(&qtmp, p, r); in PSQUATDivide()
772 void C_QUATExp( const Quaternion *q, Quaternion *r ) in C_QUATExp() argument
777 ASSERTMSG( ( r != 0 ), QUAT_EXP_2 ); in C_QUATExp()
788 r->x = scale * q->x; in C_QUATExp()
789 r->y = scale * q->y; in C_QUATExp()
790 r->z = scale * q->z; in C_QUATExp()
791 r->w = (f32)cosf(theta); in C_QUATExp()
805 void C_QUATLogN( const Quaternion *q, Quaternion *r ) in C_QUATLogN() argument
810 ASSERTMSG( ( r != 0 ), QUAT_LOGN_2 ); in C_QUATLogN()
832 r->x = scale*q->x; in C_QUATLogN()
833 r->y = scale*q->y; in C_QUATLogN()
834 r->z = scale*q->z; in C_QUATLogN()
835 r->w = 0.0F; in C_QUATLogN()
851 void C_QUATMakeClosest( const Quaternion *q, const Quaternion *qto, Quaternion *r ) in C_QUATMakeClosest() argument
857 ASSERTMSG( ( r != 0 ), QUAT_MAKECLOSEST_3 ); in C_QUATMakeClosest()
863 r->x = -q->x; in C_QUATMakeClosest()
864 r->y = -q->y; in C_QUATMakeClosest()
865 r->z = -q->z; in C_QUATMakeClosest()
866 r->w = -q->w; in C_QUATMakeClosest()
870 *r = *q; in C_QUATMakeClosest()
886 void C_QUATRotAxisRad( Quaternion *r, const Vec *axis, f32 rad ) in C_QUATRotAxisRad() argument
891 ASSERTMSG( ( r != 0 ), QUAT_ROTAXISRAD_1 ); in C_QUATRotAxisRad()
900 r->x = sh * nAxis.x; in C_QUATRotAxisRad()
901 r->y = sh * nAxis.y; in C_QUATRotAxisRad()
902 r->z = sh * nAxis.z; in C_QUATRotAxisRad()
903 r->w = ch; in C_QUATRotAxisRad()
917 void C_QUATMtx( Quaternion *r, MTX_CONST Mtx m ) in C_QUATMtx() argument
924 ASSERTMSG( ( r != 0 ), QUAT_MTX_1 ); in C_QUATMtx()
931 r->w = s * 0.5f; in C_QUATMtx()
933 r->x = (m[2][1] - m[1][2]) * s; in C_QUATMtx()
934 r->y = (m[0][2] - m[2][0]) * s; in C_QUATMtx()
935 r->z = (m[1][0] - m[0][1]) * s; in C_QUATMtx()
950 r->w = (m[k][j] - m[j][k]) * s; in C_QUATMtx()
954 r->x = q[0]; in C_QUATMtx()
955 r->y = q[1]; in C_QUATMtx()
956 r->z = q[2]; in C_QUATMtx()
973 void C_QUATLerp( const Quaternion *p, const Quaternion *q, Quaternion *r, f32 t ) in C_QUATLerp() argument
977 ASSERTMSG( ( r != 0 ), QUAT_LERP_3 ); in C_QUATLerp()
979 r->x = t * ( q->x - p->x ) + p->x; in C_QUATLerp()
980 r->y = t * ( q->y - p->y ) + p->y; in C_QUATLerp()
981 r->z = t * ( q->z - p->z ) + p->z; in C_QUATLerp()
982 r->w = t * ( q->w - p->w ) + p->w; in C_QUATLerp()
998 void C_QUATSlerp( const Quaternion *p, const Quaternion *q, Quaternion *r, f32 t ) in C_QUATSlerp() argument
1004 ASSERTMSG( ( r != 0 ), QUAT_SLERP_3 ); in C_QUATSlerp()
1029 r->x = tp * p->x + tq * q->x; in C_QUATSlerp()
1030 r->y = tp * p->y + tq * q->y; in C_QUATSlerp()
1031 r->z = tp * p->z + tq * q->z; in C_QUATSlerp()
1032 r->w = tp * p->w + tq * q->w; in C_QUATSlerp()
1055 const Quaternion *q, Quaternion *r, f32 t ) in C_QUATSquad() argument
1064 ASSERTMSG( ( r != 0 ), QUAT_SQUAD_5 ); in C_QUATSquad()
1069 C_QUATSlerp(&pq, &ab, r, t2); in C_QUATSquad()