PageRenderTime 27ms CodeModel.GetById 17ms RepoModel.GetById 1ms app.codeStats 0ms

/include/veclib/cpx_vec.c

https://gitlab.com/oytunistrator/QuIP
C | 389 lines | 229 code | 100 blank | 60 comment | 12 complexity | 480fb82e13108a3f22c5b9b8db99ab63 MD5 | raw file
    

  1. /* complex number stuff */
    2. 

  2. 

  3. /* Real only */
    4. 

  4. 

  5. // for debugging...
    6. 

  6. #define SHOW_CPX_3							\
    7. 

  7. 	sprintf(error_string,"csrc1 = %g  %g",csrc1.re,csrc1.im);	\
    8. 

  8. 	advise(error_string);						\
    9. 

  9. 	sprintf(error_string,"csrc2 = %g  %g",csrc2.re,csrc2.im);	\
    10. 

  10. 	advise(error_string);
    11. 

  11. 

  12. #define CPX_PROD_RE(c1,c2)	( c1.re*c2.re - c1.im*c2.im )
    13. 

  13. #define CPX_PROD_IM(c1,c2)	( c1.re*c2.im + c1.im*c2.re )
    14. 

  14. 

  15. _VEC_FUNC_CPX_2V( cvmov ,		cdst.re = csrc1.re ; cdst.im = csrc1.im )
    16. 

  16. _VEC_FUNC_CPX_2V( cvneg ,		cdst.re = - csrc1.re ; cdst.im = - csrc1.im )
    17. 

  17. _VEC_FUNC_CPX_2V_T2( cvsqr ,		tmpc.re = CPX_PROD_RE(csrc1,csrc1);
    18. 

  18. 					tmpc.im = csrc1.re*csrc1.im*2 ;
    19. 

  19. 					ASSIGN_CPX(cdst,tmpc); )
    20. 

  20. 

  21. _VEC_FUNC_CPX_2V( vconj ,		cdst.re = csrc1.re;
    22. 

  22. 					cdst.im = - csrc1.im )
    23. 

  23. 

  24. // complex exponential - e ^ a + bi = e^a (cos b + i sin b)
    25. 

  25. // This can work in-place...
    26. 

  26. _VEC_FUNC_CPX_2V_T2( cvexp ,		tmpc.re = exp_func(csrc1.re);		\
    27. 

  27. 					cdst.re = tmpc.re * cos_func(csrc1.im);	\
    28. 

  28. 					cdst.im = tmpc.re * sin_func(csrc1.im);	\
    29. 

  29. 					)
    30. 

  30. 

  31. _VEC_FUNC_CPX_3V( cvadd , 	cdst.re = csrc1.re + csrc2.re ; cdst.im = csrc1.im + csrc2.im )
    32. 

  32. _VEC_FUNC_CPX_3V( cvsub ,	cdst.re = csrc2.re - csrc1.re ; cdst.im = csrc2.im - csrc1.im )
    33. 

  33. 

  34. #define ASSIGN_CPX_PROD(cd,c1,c2)	{ cd.re = CPX_PROD_RE(c1,c2);		\
    35. 

  35. 					cd.im = CPX_PROD_IM(c1,c2); }
    36. 

  36. 

  37. _VEC_FUNC_CPX_3V_T2( cvmul ,	ASSIGN_CPX_PROD(tmpc,csrc1,csrc2)
    38. 

  38. 					ASSIGN_CPX(cdst,tmpc) )
    39. 

  39. 

  40. #define CPX_NORM(c)		( c.re*c.re +c.im*c.im )
    41. 

  41. 

  42. // conjugate second operand
    43. 

  43. #define CPX_CPROD_RE(c1,c2)	( c1.re*c2.re + c1.im*c2.im )
    44. 

  44. #define CPX_CPROD_IM(c1,c2)	( c2.re*c1.im - c2.im*c1.re )
    45. 

  45. 

  46. #define ASSIGN_CPX_CPROD(cd,c1,c2)		{ cd.re = CPX_CPROD_RE(c1,c2);		\
    47. 

  47. 						cd.im = CPX_CPROD_IM(c1,c2); }
    48. 

  48. 

  49. #define ASSIGN_CPX_CPROD_NORM(cd,c1,c2,denom)	{ cd.re = CPX_CPROD_RE(c1,c2)/denom;		\
    50. 

  50. 						cd.im = CPX_CPROD_IM(c1,c2)/denom; }
    51. 

  51. 

  52. // are we dividing by src1 or src2 ???
    53. 

  53. 

  54. _VEC_FUNC_CPX_3V_T3( cvdiv ,	tmp_denom = CPX_NORM(csrc2);
    55. 

  55. 					ASSIGN_CPX_CPROD_NORM(tmpc,csrc1,csrc2,tmp_denom)
    56. 

  56. 					ASSIGN_CPX(cdst,tmpc) )
    57. 

  57. 

  58. /* vcmul seems to be redundant with cvmul, but actually it is conjugate multiplication? */
    59. 

  59. _VEC_FUNC_CPX_3V_T2( vcmul , 	ASSIGN_CPX_CPROD(tmpc,csrc1,csrc2)
    60. 

  60. 					ASSIGN_CPX(cdst,tmpc) )
    61. 

  61. 

  62. /* float times complex */
    63. 

  63. 

  64. _VEC_FUNC_CCR_3V( mvadd , cdst.re = csrc1.re + src2; cdst.im = csrc1.im )
    65. 

  65. _VEC_FUNC_CCR_3V( mvsub , cdst.re = csrc1.re - src2; cdst.im = csrc1.im )
    66. 

  66. _VEC_FUNC_CCR_3V( mvmul , cdst.re = csrc1.re * src2; cdst.im = csrc1.im * src2 )
    67. 

  67. _VEC_FUNC_CCR_3V( mvdiv , cdst.re=csrc1.re/src2; cdst.im = csrc1.im / src2 )
    68. 

  68. 

  69. _VEC_FUNC_2V_MIXED( vmgsq , dst = csrc1.re*csrc1.re + csrc1.im*csrc1.im )
    70. 

  70. 

  71. 

  72. /* BUG check for divide by zero */
    73. 

  73. // These appear to have a complex destination, but a real source,
    74. 

  74. // and real scalar...  what's the point?
    75. 

  75. _VEC_FUNC_CR_1S_2V( mvsdiv ,	cdst.re = scalar1_val / src1 ;
    76. 

  76. 					cdst.im = 0
    77. 

  77. 					)
    78. 

  78. 

  79. _VEC_FUNC_CR_1S_2V( mvsdiv2 ,	cdst.re = src1 / scalar1_val ;
    80. 

  80. 					cdst.im = 0
    81. 

  81. 					)
    82. 

  82. 

  83. _VEC_FUNC_CR_1S_2V( mvsmul ,	cdst.re = scalar1_val * src1 ;
    84. 

  84. 					cdst.im = 0
    85. 

  85. 					)
    86. 

  86. 

  87. _VEC_FUNC_CR_1S_2V( mvssub ,	cdst.re = scalar1_val - src1 ;
    88. 

  88. 					cdst.im = 0
    89. 

  89. 					)
    90. 

  90. 

  91. _VEC_FUNC_CR_1S_2V( mvsadd ,	cdst.re = src1 + scalar1_val ;
    92. 

  92. 					cdst.im = 0
    93. 

  93. 					)
    94. 

  94. 

  95. _VEC_FUNC_CPX_1S_2V( cvsadd ,	cdst.re = csrc1.re + cscalar1_val.re ;
    96. 

  96. 					cdst.im = csrc1.im + cscalar1_val.im
    97. 

  97. 					)
    98. 

  98. 

  99. _VEC_FUNC_CPX_1S_2V( cvssub ,	cdst.re = cscalar1_val.re - csrc1.re ;
    100. 

  100. 					cdst.im = cscalar1_val.im - csrc1.im
    101. 

  101. 					)
    102. 

  102. _VEC_FUNC_CPX_1S_2V_T2( cvsmul ,	ASSIGN_CPX_PROD(tmpc,csrc1,cscalar1_val)
    103. 

  103. 					ASSIGN_CPX(cdst,tmpc)
    104. 

  104. 					)
    105. 

  105. 

  106. #define QUAT_NORM(q)	( q.re * q.re + q._i * q._i + q._j * q._j + q._k * q._k )
    107. 

  107. 

  108. // dst = scalar / src
    109. 

  109. _VEC_FUNC_CPX_1S_2V_T3( cvsdiv ,	tmp_denom=CPX_NORM(csrc1);
    110. 

  110. 					ASSIGN_CPX_CPROD_NORM(tmpc,cscalar1_val,csrc1,tmp_denom)
    111. 

  111. 					ASSIGN_CPX(cdst,tmpc)
    112. 

  112. 					)
    113. 

  113. 

  114. _VEC_FUNC_CPX_1S_2V_T3( cvsdiv2 ,	tmp_denom=CPX_NORM(cscalar1_val);
    115. 

  115. 					ASSIGN_CPX_CPROD_NORM(tmpc,csrc1,cscalar1_val,tmp_denom)
    116. 

  116. 					ASSIGN_CPX(cdst,tmpc)
    117. 

  117. 					)
    118. 

  118. 

  119. /* for mixed (MDECLS2), v1 is complex and v2 is real? */
    120. 

  120. 

  121. 

  122. _VEC_FUNC_CPX_1S_1V( cvset , cdst.re = cscalar1_val.re ; cdst.im = cscalar1_val.im )
    123. 

  123. 

  124. #ifdef NOT_YET
    125. 

  125. 

  126. /* dot product with complex conjugate */
    127. 

  127. 

  128. FUNC_DECL( vcdot )
    129. 

  129. {
    130. 

  130. 	RCSCALAR_DECL;
    131. 

  131. 	CINIT2;
    132. 

  132. 	RSCALAR_SETUP;
    133. 

  133. 

  134. 	scalar->re = scalar->im = 0.0;
    135. 

  135. 

  136. 	V2LOOP( scalar->re += csrc1.re * csrc2.re + csrc1.im * csrc2.im ; scalar->im += csrc1.re * csrc2.im - csrc1.im * csrc2.re )
    137. 

  137. }
    138. 

  138. #endif /* NOT_YET */
    139. 

  139. 

  140. /* We use std_tmp here so this will work if called w/ in-place argument (v3 = v1 or v2)
    141. 

  141.  */
    142. 

  142. 

  143. 

  144. 

  145. /* conjugated vsmul ? */
    146. 

  146. 

  147. _VEC_FUNC_CPX_1S_2V_T2( vscml ,	ASSIGN_CPX_CPROD(tmpc,csrc1,cscalar1_val)
    148. 

  148. 					ASSIGN_CPX(cdst,tmpc) )
    149. 

  149. 

  150. 

  151. /* These are clean, but don't work when destination and source have different precisions */
    152. 

  152. /*
    153. 

  153. _VEC_FUNC_SBM_CPX_3V( cvvv_slct ,	cdst = srcbit ? csrc1 : csrc2 )
    154. 

  154. CPX_VS_SELECTION_METHOD( cvvs_slct ,	cdst = srcbit ? csrc1 : cscalar1_val )
    155. 

  155. CPX_SS_SELECTION_METHOD( cvss_slct ,	cdst = srcbit ? cscalar1_val : cscalar2_val )
    156. 

  156. */
    157. 

  157. 

  158. // why not structure assign?
    159. 

  159. #define COPY_CPX( c )	{ cdst.re=c.re; cdst.im=c.im; }
    160. 

  160. 

  161. _VEC_FUNC_SBM_CPX_3V( cvvv_slct ,	if( srcbit ) COPY_CPX(csrc1) else COPY_CPX(csrc2) )
    162. 

  162. 

  163. _VEC_FUNC_SBM_CPX_1S_2V( cvvs_slct ,	if( srcbit ) COPY_CPX(csrc1) else COPY_CPX(cscalar1_val) )
    164. 

  164. _VEC_FUNC_SBM_CPX_2S_1V( cvss_slct ,	if( srcbit ) COPY_CPX(cscalar1_val) else COPY_CPX(cscalar2_val) )
    165. 

  165. 

  166. // no CPX in this macro?
    167. 

  167. _VEC_FUNC_CPX_2V_PROJ( cvsum,
    168. 

  168. 	cdst.re = 0 ; cdst.im = 0 ,
    169. 

  169. 	cdst.re += csrc1.re; cdst.im += csrc1.im ,
    170. 

  170. 	psrc1.re + psrc2.re,
    171. 

  171. 	psrc1.im + psrc2.im
    172. 

  172. 	)
    173. 

  173. 

  174. _VEC_FUNC_CPX_3V_PROJ( cvdot, cdst.re = 0; cdst.im = 0 , cdst.re += csrc1.re * csrc2.re - csrc1.im * csrc2.im; cdst.im += csrc1.re * csrc2.im + csrc1.im * csrc2.re  )
    175. 

  175. 

  176. #ifndef BUILD_FOR_GPU
    177. 

  177. _VEC_FUNC_CPX_2V( cvrand , cdst.re = rn((u_long)csrc1.re); cdst.im = rn((u_long)csrc1.im)	)
    178. 

  178. #endif /* ! BUILD_FOR_GPU */
    179. 

  179. 

  180. 

  181. #ifdef QUATERNION_SUPPORT
    182. 

  182. 

  183. /* Quaternions */
    184. 

  184. 

  185. /* Here is the multiplication chart:
    186. 

  186.  * note that multiplication of the imaginary terms is non-commutative...
    187. 

  187.  *
    188. 

  188.  *	X		1	i	j	k
    189. 

  189.  *
    190. 

  190.  *	1		1	i	j	k
    191. 

  191.  *	i		i	-1	k	-j
    192. 

  192.  *	j		j	-k	-1	i
    193. 

  193.  *	k		k	j	-i	-1
    194. 

  194.  */
    195. 

  195. 

  196. #define QUAT_PROD_RE(q1,q2)	( q1.re * q2.re - q1._i * q2._i - q1._j * q2._j - q1._k * q2._k )
    197. 

  197. #define QUAT_PROD_I(q1,q2)	( q1.re * q2._i + q1._i * q2.re + q1._j * q2._k - q1._k * q2._j )
    198. 

  198. #define QUAT_PROD_J(q1,q2)	( q1.re * q2._j + q1._j * q2.re + q1._k * q2._i - q1._i * q2._k )
    199. 

  199. #define QUAT_PROD_K(q1,q2)	( q1.re * q2._k + q1._k * q2.re + q1._i * q2._j - q1._j * q2._i )
    200. 

  200. 

  201. _VEC_FUNC_QUAT_2V( qvmov ,		qdst.re = qsrc1.re ;
    202. 

  202. 					qdst._i = qsrc1._i ;
    203. 

  203. 					qdst._j = qsrc1._j ;
    204. 

  204. 					qdst._k = qsrc1._k )
    205. 

  205. 

  206. _VEC_FUNC_QUAT_2V( qvneg ,		qdst.re = - qsrc1.re ;
    207. 

  207. 					qdst._i = - qsrc1._i ;
    208. 

  208. 					qdst._j = - qsrc1._j ;
    209. 

  209. 					qdst._k = - qsrc1._k )
    210. 

  210. 

  211. _VEC_FUNC_QUAT_2V_T4( qvsqr ,		tmpq.re = QUAT_PROD_RE(qsrc1,qsrc1);
    212. 

  212. 					tmpq._i =	2 * qsrc1.re * qsrc1._i;
    213. 

  213. 					tmpq._j =	2 * qsrc1.re * qsrc1._j;
    214. 

  214. 					tmpq._k =	2 * qsrc1.re * qsrc1._k;
    215. 

  215. 					ASSIGN_QUAT(qdst,tmpq) )
    216. 

  216. 

  217. _VEC_FUNC_QUAT_3V( qvadd , 		qdst.re = qsrc1.re + qsrc2.re ;
    218. 

  218. 					qdst._i = qsrc1._i + qsrc2._i ;
    219. 

  219. 					qdst._j = qsrc1._j + qsrc2._j ;
    220. 

  220. 					qdst._k = qsrc1._k + qsrc2._k )
    221. 

  221. 

  222. _VEC_FUNC_QUAT_3V( qvsub ,		qdst.re = qsrc2.re - qsrc1.re ;
    223. 

  223. 					qdst._i = qsrc2._i - qsrc1._i ;
    224. 

  224. 					qdst._j = qsrc2._j - qsrc1._j ;
    225. 

  225. 					qdst._k = qsrc2._k - qsrc1._k )
    226. 

  226. 

  227. #define ASSIGN_QUAT_PROD(qd,q1,q2)	{ qd.re = QUAT_PROD_RE(q1,q2);	\
    228. 

  228. 					qd._i = QUAT_PROD_I(q1,q2);	\
    229. 

  229. 					qd._j = QUAT_PROD_J(q1,q2);	\
    230. 

  230. 					qd._k = QUAT_PROD_K(q1,q2); }
    231. 

  231. 

  232. _VEC_FUNC_QUAT_3V_T4( qvmul ,	ASSIGN_QUAT_PROD(tmpq,qsrc1,qsrc2)
    233. 

  233. 					ASSIGN_QUAT(qdst,tmpq) )
    234. 

  234. 

  235. // Quaternion division is like complex division:  q1 / q2 = q1 * conj(q2) / maqsq(q2)
    236. 

  236. // Conjugation negates all three imaginary components...
    237. 

  237. 

  238. // T4 declares tmpq, T5 tmpq plus tmp_denom
    239. 

  239. 

  240. #define QUAT_NORM(q)	( q.re * q.re + q._i * q._i + q._j * q._j + q._k * q._k )
    241. 

  241. 

  242. // QUAT_CPROD conjugates the second operand...
    243. 

  243. 

  244. #define QUAT_CPROD_RE(q1,q2)	( q1.re * q2.re + q1._i * q2._i + q1._j * q2._j + q1._k * q2._k )
    245. 

  245. #define QUAT_CPROD_I(q1,q2)	( - q1.re * q2._i + q1._i * q2.re - q1._j * q2._k + q1._k * q2._j )
    246. 

  246. #define QUAT_CPROD_J(q1,q2)	( - q1.re * q2._j + q1._j * q2.re - q1._k * q2._i + q1._i * q2._k )
    247. 

  247. #define QUAT_CPROD_K(q1,q2)	( - q1.re * q2._k + q1._k * q2.re - q1._i * q2._j + q1._j * q2._i )
    248. 

  248. 

  249. #define ASSIGN_QUAT_CPROD_NORM(qd,q1,q2,denom)	{ qd.re = QUAT_CPROD_RE(q1,q2)/denom;	\
    250. 

  250. 						qd._i = QUAT_CPROD_I(q1,q2)/denom;	\
    251. 

  251. 						qd._j = QUAT_CPROD_J(q1,q2)/denom;	\
    252. 

  252. 						qd._k = QUAT_CPROD_K(q1,q2)/denom; }
    253. 

  253. 

  254. _VEC_FUNC_QUAT_3V_T5( qvdiv ,	tmp_denom =	QUAT_NORM(qsrc2);
    255. 

  255. 					ASSIGN_QUAT_CPROD_NORM(tmpq,qsrc1,qsrc2,tmp_denom)
    256. 

  256. 					ASSIGN_QUAT(qdst,tmpq) )
    257. 

  257. 

  258. // dst = scalar / src1
    259. 

  259. 

  260. _VEC_FUNC_QUAT_1S_2V_T5( qvsdiv ,	tmp_denom =	QUAT_NORM(qsrc1);
    261. 

  261. 					ASSIGN_QUAT_CPROD_NORM(tmpq,qscalar1_val,qsrc1,tmp_denom)
    262. 

  262. 					ASSIGN_QUAT(qdst,tmpq) )
    263. 

  263. 

  264. // dst = src1 / scalar
    265. 

  265. 

  266. _VEC_FUNC_QUAT_1S_2V_T5( qvsdiv2 ,	tmp_denom =	QUAT_NORM(qscalar1_val);
    267. 

  267. 					ASSIGN_QUAT_CPROD_NORM(tmpq,qsrc1,qscalar1_val,tmp_denom)
    268. 

  268. 					ASSIGN_QUAT(qdst,tmpq) )
    269. 

  269. 

  270. 

  271. /* float times quaternion */
    272. 

  272. 

  273. // These appear to have a quaternion destination, but a real source,
    274. 

  274. // and real scalar...  what's the point?
    275. 

  275. 

  276. _VEC_FUNC_QQR_3V( pvadd ,		qdst.re = qsrc1.re + src2;
    277. 

  277. 					qdst._i = qsrc1._i ;
    278. 

  278. 					qdst._j = qsrc1._j ;
    279. 

  279. 					qdst._k = qsrc1._k )
    280. 

  280. 					
    281. 

  281. _VEC_FUNC_QQR_3V( pvsub ,		qdst.re = qsrc1.re - src2;
    282. 

  282. 					qdst._i = qsrc1._i ;
    283. 

  283. 					qdst._j = qsrc1._j ;
    284. 

  284. 					qdst._k = qsrc1._k )
    285. 

  285. 

  286. _VEC_FUNC_QQR_3V( pvmul ,		qdst.re = qsrc1.re * src2;
    287. 

  287. 					qdst._i = qsrc1._i * src2 ;
    288. 

  288. 					qdst._j = qsrc1._j * src2 ;
    289. 

  289. 					qdst._k = qsrc1._k * src2 )
    290. 

  290. 

  291. _VEC_FUNC_QQR_3V( pvdiv ,		qdst.re = qsrc1.re / src2;
    292. 

  292. 					qdst._i = qsrc1._i / src2 ;
    293. 

  293. 					qdst._j = qsrc1._j / src2 ;
    294. 

  294. 					qdst._k = qsrc1._k / src2 )
    295. 

  295. 

  296. /* BUG check for divide by zero */
    297. 

  297. // 
    298. 

  298. //_VF_QR_1S_2V( name, type_code, stat)
    299. 

  299. _VEC_FUNC_QR_1S_2V( pvsdiv ,	qdst.re = scalar1_val / src1 ;
    300. 

  300. 					qdst._i = 0;
    301. 

  301. 					qdst._j = 0;
    302. 

  302. 					qdst._k = 0
    303. 

  303. 					)
    304. 

  304. 

  305. _VEC_FUNC_QR_1S_2V( pvsdiv2 ,	qdst.re = src1 / scalar1_val ;
    306. 

  306. 					qdst._i = 0;
    307. 

  307. 					qdst._j = 0;
    308. 

  308. 					qdst._k = 0
    309. 

  309. 					)
    310. 

  310. 

  311. _VEC_FUNC_QR_1S_2V( pvsmul ,	qdst.re = scalar1_val * src1 ;
    312. 

  312. 					qdst._i = 0;
    313. 

  313. 					qdst._j = 0;
    314. 

  314. 					qdst._k = 0
    315. 

  315. 					)
    316. 

  316. 

  317. _VEC_FUNC_QR_1S_2V( pvssub ,	qdst.re = scalar1_val - src1 ;
    318. 

  318. 					qdst._i = 0;
    319. 

  319. 					qdst._j = 0;
    320. 

  320. 					qdst._k = 0
    321. 

  321. 					)
    322. 

  322. 

  323. _VEC_FUNC_QR_1S_2V( pvsadd ,	qdst.re = src1 + scalar1_val ;
    324. 

  324. 					qdst._i = 0;
    325. 

  325. 					qdst._j = 0;
    326. 

  326. 					qdst._k = 0
    327. 

  327. 					)
    328. 

  328. 

  329. _VEC_FUNC_QUAT_1S_2V( qvsadd ,	qdst.re = qsrc1.re + qscalar1_val.re ;
    330. 

  330. 					qdst._i = qsrc1._i + qscalar1_val._i ;
    331. 

  331. 					qdst._j = qsrc1._j + qscalar1_val._j ;
    332. 

  332. 					qdst._k = qsrc1._k + qscalar1_val._k
    333. 

  333. 					)
    334. 

  334. 

  335. _VEC_FUNC_QUAT_1S_2V( qvssub ,	qdst.re = qscalar1_val.re - qsrc1.re ;
    336. 

  336. 					qdst._i = qscalar1_val._i - qsrc1._i ;
    337. 

  337. 					qdst._j = qscalar1_val._j - qsrc1._j ;
    338. 

  338. 					qdst._k = qscalar1_val._k - qsrc1._k
    339. 

  339. 					)
    340. 

  340. 

  341. /* For real or complex, multiplication is commutative, but not for quaternions!? */
    342. 

  342. 

  343. _VEC_FUNC_QUAT_1S_2V_T4( qvsmul ,	ASSIGN_QUAT_PROD(tmpq,qsrc1,qscalar1_val)
    344. 

  344. 					ASSIGN_QUAT(qdst,tmpq) )
    345. 

  345. 

  346. /* not yet...
    347. 

  347. _VEC_FUNC_QUAT_1S_2V_T4( qvsmul2 ,ASSIGN_QUAT_PROD(tmpq,qscalar1_val,qsrc1)
    348. 

  348. 					ASSIGN_QUAT(qdst,tmpq) )
    349. 

  349. */
    350. 

  350. 

  351. _VEC_FUNC_QUAT_1S_1V( qvset ,	qdst.re = qscalar1_val.re ;
    352. 

  352. 					qdst._i = qscalar1_val._i ;
    353. 

  353. 					qdst._j = qscalar1_val._j ;
    354. 

  354. 					qdst._k = qscalar1_val._k )
    355. 

  355. 

  356. 

  357. /*
    358. 

  358. QUAT_VV_SELECTION_METHOD( qvvv_slct ,	qdst = srcbit ? qsrc1 : qsrc2 )
    359. 

  359. QUAT_VS_SELECTION_METHOD( qvvs_slct ,	qdst = srcbit ? qsrc1 : qscalar1_val )
    360. 

  360. QUAT_SS_SELECTION_METHOD( qvss_slct ,	qdst = srcbit ? qscalar1_val : qscalar2_val )
    361. 

  361. */
    362. 

  362. #define COPY_QUAT( q )	{ qdst.re=q.re; qdst._i=q._i; qdst._j=q._j; qdst._k=q._k; }
    363. 

  363. 

  364. _VEC_FUNC_SBM_QUAT_3V( qvvv_slct ,	if( srcbit ) COPY_QUAT(qsrc1) else COPY_QUAT(qsrc2) )
    365. 

  365. _VEC_FUNC_SBM_QUAT_1S_2V( qvvs_slct ,	if( srcbit ) COPY_QUAT(qsrc1) else COPY_QUAT(qscalar1_val) )
    366. 

  366. _VEC_FUNC_SBM_QUAT_2S_1V( qvss_slct ,	if( srcbit ) COPY_QUAT(qscalar1_val) else COPY_QUAT(qscalar2_val) )
    367. 

  367. 

  368. /* BUG - gpu implementation? */
    369. 

  369. 

  370. _VEC_FUNC_QUAT_2V_PROJ( qvsum,
    371. 

  371. 					qdst.re = 0 ;
    372. 

  372. 					qdst._i = 0 ;
    373. 

  373. 					qdst._j = 0 ;
    374. 

  374. 					qdst._k = 0
    375. 

  375. 					,
    376. 

  376. 					qdst.re += qsrc1.re ;
    377. 

  377. 					qdst._i += qsrc1._i ;
    378. 

  378. 					qdst._j += qsrc1._j ;
    379. 

  379. 					qdst._k += qsrc1._k
    380. 

  380. 					,
    381. 

  381. 					psrc1.re + psrc2.re,
    382. 

  382. 					psrc1._i + psrc2._i,
    383. 

  383. 					psrc1._j + psrc2._j,
    384. 

  384. 					psrc1._k + psrc2._k
    385. 

  385. 					)
    386. 

  386. 

  387. 

  388. #endif /* QUATERNION_SUPPORT */
    389. 

  389. 

  390.