cdbc37fd32cdb7353b7b1d77ff49c17ad36a1de4
[blender-staging.git] / intern / cycles / util / util_math.h
1 /*
2  * Copyright 2011-2013 Blender Foundation
3  *
4  * Licensed under the Apache License, Version 2.0 (the "License");
5  * you may not use this file except in compliance with the License.
6  * You may obtain a copy of the License at
7  *
8  * http://www.apache.org/licenses/LICENSE-2.0
9  *
10  * Unless required by applicable law or agreed to in writing, software
11  * distributed under the License is distributed on an "AS IS" BASIS,
12  * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
13  * See the License for the specific language governing permissions and
14  * limitations under the License.
15  */
16
17 #ifndef __UTIL_MATH_H__
18 #define __UTIL_MATH_H__
19
20 /* Math
21  *
22  * Basic math functions on scalar and vector types. This header is used by
23  * both the kernel code when compiled as C++, and other C++ non-kernel code. */
24
25 #ifndef __KERNEL_OPENCL__
26
27 #include <float.h>
28 #include <math.h>
29 #include <stdio.h>
30
31 #endif
32
33 #include "util_types.h"
34
35 CCL_NAMESPACE_BEGIN
36
37 /* Float Pi variations */
38
39 /* Division */
40 #ifndef M_PI_F
41 #define M_PI_F          ((float)3.14159265358979323846264338327950288)          /* pi */
42 #endif
43 #ifndef M_PI_2_F
44 #define M_PI_2_F        ((float)1.57079632679489661923132169163975144)          /* pi/2 */
45 #endif
46 #ifndef M_PI_4_F
47 #define M_PI_4_F        ((float)0.785398163397448309615660845819875721)         /* pi/4 */
48 #endif
49 #ifndef M_1_PI_F
50 #define M_1_PI_F        ((float)0.318309886183790671537767526745028724)         /* 1/pi */
51 #endif
52 #ifndef M_2_PI_F
53 #define M_2_PI_F        ((float)0.636619772367581343075535053490057448)         /* 2/pi */
54 #endif
55
56 /* Multiplication */
57 #ifndef M_2PI_F
58 #define M_2PI_F         ((float)6.283185307179586476925286766559005768)         /* 2*pi */
59 #endif
60 #ifndef M_4PI_F
61 #define M_4PI_F         ((float)12.56637061435917295385057353311801153)         /* 4*pi */
62 #endif
63
64 /* Float sqrt variations */
65
66 #ifndef M_SQRT2_F
67 #define M_SQRT2_F       ((float)1.41421356237309504880)                                         /* sqrt(2) */
68 #endif
69
70 #ifndef M_LN2_F
71 #define M_LN2_F      ((float)0.6931471805599453)        /* ln(2) */
72 #endif
73
74 #ifndef M_LN10_F
75 #define M_LN10_F     ((float)2.3025850929940457)        /* ln(10) */
76 #endif
77
78 /* Scalar */
79
80 #ifdef _WIN32
81
82 #ifndef __KERNEL_OPENCL__
83
84 ccl_device_inline float fmaxf(float a, float b)
85 {
86         return (a > b)? a: b;
87 }
88
89 ccl_device_inline float fminf(float a, float b)
90 {
91         return (a < b)? a: b;
92 }
93
94 #endif
95
96 #endif
97
98 #ifndef __KERNEL_GPU__
99
100 ccl_device_inline int max(int a, int b)
101 {
102         return (a > b)? a: b;
103 }
104
105 ccl_device_inline int min(int a, int b)
106 {
107         return (a < b)? a: b;
108 }
109
110 ccl_device_inline float max(float a, float b)
111 {
112         return (a > b)? a: b;
113 }
114
115 ccl_device_inline float min(float a, float b)
116 {
117         return (a < b)? a: b;
118 }
119
120 ccl_device_inline double max(double a, double b)
121 {
122         return (a > b)? a: b;
123 }
124
125 ccl_device_inline double min(double a, double b)
126 {
127         return (a < b)? a: b;
128 }
129
130 /* These 2 guys are templated for usage with registers data.
131  *
132  * NOTE: Since this is CPU-only functions it is ok to use references here.
133  * But for other devices we'll need to be careful about this.
134  */
135
136 template<typename T>
137 ccl_device_inline T min4(const T& a, const T& b, const T& c, const T& d)
138 {
139         return min(min(a,b),min(c,d));
140 }
141
142 template<typename T>
143 ccl_device_inline T max4(const T& a, const T& b, const T& c, const T& d)
144 {
145         return max(max(a,b),max(c,d));
146 }
147
148 #endif
149
150 ccl_device_inline float min4(float a, float b, float c, float d)
151 {
152         return min(min(a, b), min(c, d));
153 }
154
155 ccl_device_inline float max4(float a, float b, float c, float d)
156 {
157         return max(max(a, b), max(c, d));
158 }
159
160 #ifndef __KERNEL_OPENCL__
161
162 ccl_device_inline int clamp(int a, int mn, int mx)
163 {
164         return min(max(a, mn), mx);
165 }
166
167 ccl_device_inline float clamp(float a, float mn, float mx)
168 {
169         return min(max(a, mn), mx);
170 }
171
172 #endif
173
174 #ifndef __KERNEL_CUDA__
175
176 ccl_device_inline float saturate(float a)
177 {
178         return clamp(a, 0.0f, 1.0f);
179 }
180
181 #endif
182
183 ccl_device_inline int float_to_int(float f)
184 {
185         return (int)f;
186 }
187
188 ccl_device_inline int floor_to_int(float f)
189 {
190         return float_to_int(floorf(f));
191 }
192
193 ccl_device_inline int ceil_to_int(float f)
194 {
195         return float_to_int(ceilf(f));
196 }
197
198 ccl_device_inline float signf(float f)
199 {
200         return (f < 0.0f)? -1.0f: 1.0f;
201 }
202
203 ccl_device_inline float nonzerof(float f, float eps)
204 {
205         if(fabsf(f) < eps)
206                 return signf(f)*eps;
207         else
208                 return f;
209 }
210
211 ccl_device_inline float smoothstepf(float f)
212 {
213         float ff = f*f;
214         return (3.0f*ff - 2.0f*ff*f);
215 }
216
217 /* Float2 Vector */
218
219 #ifndef __KERNEL_OPENCL__
220
221 ccl_device_inline bool is_zero(const float2 a)
222 {
223         return (a.x == 0.0f && a.y == 0.0f);
224 }
225
226 #endif
227
228 #ifndef __KERNEL_OPENCL__
229
230 ccl_device_inline float average(const float2 a)
231 {
232         return (a.x + a.y)*(1.0f/2.0f);
233 }
234
235 #endif
236
237 #ifndef __KERNEL_OPENCL__
238
239 ccl_device_inline float2 operator-(const float2 a)
240 {
241         return make_float2(-a.x, -a.y);
242 }
243
244 ccl_device_inline float2 operator*(const float2 a, const float2 b)
245 {
246         return make_float2(a.x*b.x, a.y*b.y);
247 }
248
249 ccl_device_inline float2 operator*(const float2 a, float f)
250 {
251         return make_float2(a.x*f, a.y*f);
252 }
253
254 ccl_device_inline float2 operator*(float f, const float2 a)
255 {
256         return make_float2(a.x*f, a.y*f);
257 }
258
259 ccl_device_inline float2 operator/(float f, const float2 a)
260 {
261         return make_float2(f/a.x, f/a.y);
262 }
263
264 ccl_device_inline float2 operator/(const float2 a, float f)
265 {
266         float invf = 1.0f/f;
267         return make_float2(a.x*invf, a.y*invf);
268 }
269
270 ccl_device_inline float2 operator/(const float2 a, const float2 b)
271 {
272         return make_float2(a.x/b.x, a.y/b.y);
273 }
274
275 ccl_device_inline float2 operator+(const float2 a, const float2 b)
276 {
277         return make_float2(a.x+b.x, a.y+b.y);
278 }
279
280 ccl_device_inline float2 operator-(const float2 a, const float2 b)
281 {
282         return make_float2(a.x-b.x, a.y-b.y);
283 }
284
285 ccl_device_inline float2 operator+=(float2& a, const float2 b)
286 {
287         return a = a + b;
288 }
289
290 ccl_device_inline float2 operator*=(float2& a, const float2 b)
291 {
292         return a = a * b;
293 }
294
295 ccl_device_inline float2 operator*=(float2& a, float f)
296 {
297         return a = a * f;
298 }
299
300 ccl_device_inline float2 operator/=(float2& a, const float2 b)
301 {
302         return a = a / b;
303 }
304
305 ccl_device_inline float2 operator/=(float2& a, float f)
306 {
307         float invf = 1.0f/f;
308         return a = a * invf;
309 }
310
311
312 ccl_device_inline float dot(const float2 a, const float2 b)
313 {
314         return a.x*b.x + a.y*b.y;
315 }
316
317 ccl_device_inline float cross(const float2 a, const float2 b)
318 {
319         return (a.x*b.y - a.y*b.x);
320 }
321
322 #endif
323
324 #ifndef __KERNEL_OPENCL__
325
326 ccl_device_inline bool operator==(const int2 a, const int2 b)
327 {
328         return (a.x == b.x && a.y == b.y);
329 }
330
331 ccl_device_inline float len(const float2 a)
332 {
333         return sqrtf(dot(a, a));
334 }
335
336 ccl_device_inline float2 normalize(const float2 a)
337 {
338         return a/len(a);
339 }
340
341 ccl_device_inline float2 normalize_len(const float2 a, float *t)
342 {
343         *t = len(a);
344         return a/(*t);
345 }
346
347 ccl_device_inline float2 safe_normalize(const float2 a)
348 {
349         float t = len(a);
350         return (t != 0.0f)? a/t: a;
351 }
352
353 ccl_device_inline bool operator==(const float2 a, const float2 b)
354 {
355         return (a.x == b.x && a.y == b.y);
356 }
357
358 ccl_device_inline bool operator!=(const float2 a, const float2 b)
359 {
360         return !(a == b);
361 }
362
363 ccl_device_inline float2 min(float2 a, float2 b)
364 {
365         return make_float2(min(a.x, b.x), min(a.y, b.y));
366 }
367
368 ccl_device_inline float2 max(float2 a, float2 b)
369 {
370         return make_float2(max(a.x, b.x), max(a.y, b.y));
371 }
372
373 ccl_device_inline float2 clamp(float2 a, float2 mn, float2 mx)
374 {
375         return min(max(a, mn), mx);
376 }
377
378 ccl_device_inline float2 fabs(float2 a)
379 {
380         return make_float2(fabsf(a.x), fabsf(a.y));
381 }
382
383 ccl_device_inline float2 as_float2(const float4 a)
384 {
385         return make_float2(a.x, a.y);
386 }
387
388 #endif
389
390 #ifndef __KERNEL_GPU__
391
392 ccl_device_inline void print_float2(const char *label, const float2& a)
393 {
394         printf("%s: %.8f %.8f\n", label, (double)a.x, (double)a.y);
395 }
396
397 #endif
398
399 #ifndef __KERNEL_OPENCL__
400
401 ccl_device_inline float2 interp(float2 a, float2 b, float t)
402 {
403         return a + t*(b - a);
404 }
405
406 #endif
407
408 /* Float3 Vector */
409
410 #ifndef __KERNEL_OPENCL__
411
412 ccl_device_inline float3 operator-(const float3 a)
413 {
414         return make_float3(-a.x, -a.y, -a.z);
415 }
416
417 ccl_device_inline float3 operator*(const float3 a, const float3 b)
418 {
419         return make_float3(a.x*b.x, a.y*b.y, a.z*b.z);
420 }
421
422 ccl_device_inline float3 operator*(const float3 a, float f)
423 {
424         return make_float3(a.x*f, a.y*f, a.z*f);
425 }
426
427 ccl_device_inline float3 operator*(float f, const float3 a)
428 {
429         return make_float3(a.x*f, a.y*f, a.z*f);
430 }
431
432 ccl_device_inline float3 operator/(float f, const float3 a)
433 {
434         return make_float3(f/a.x, f/a.y, f/a.z);
435 }
436
437 ccl_device_inline float3 operator/(const float3 a, float f)
438 {
439         float invf = 1.0f/f;
440         return make_float3(a.x*invf, a.y*invf, a.z*invf);
441 }
442
443 ccl_device_inline float3 operator/(const float3 a, const float3 b)
444 {
445         return make_float3(a.x/b.x, a.y/b.y, a.z/b.z);
446 }
447
448 ccl_device_inline float3 operator+(const float3 a, const float3 b)
449 {
450         return make_float3(a.x+b.x, a.y+b.y, a.z+b.z);
451 }
452
453 ccl_device_inline float3 operator-(const float3 a, const float3 b)
454 {
455         return make_float3(a.x-b.x, a.y-b.y, a.z-b.z);
456 }
457
458 ccl_device_inline float3 operator+=(float3& a, const float3 b)
459 {
460         return a = a + b;
461 }
462
463 ccl_device_inline float3 operator*=(float3& a, const float3 b)
464 {
465         return a = a * b;
466 }
467
468 ccl_device_inline float3 operator*=(float3& a, float f)
469 {
470         return a = a * f;
471 }
472
473 ccl_device_inline float3 operator/=(float3& a, const float3 b)
474 {
475         return a = a / b;
476 }
477
478 ccl_device_inline float3 operator/=(float3& a, float f)
479 {
480         float invf = 1.0f/f;
481         return a = a * invf;
482 }
483
484 ccl_device_inline float dot(const float3 a, const float3 b)
485 {
486 #if defined(__KERNEL_SSE41__) && defined(__KERNEL_SSE__)
487         return _mm_cvtss_f32(_mm_dp_ps(a, b, 0x7F));
488 #else   
489         return a.x*b.x + a.y*b.y + a.z*b.z;
490 #endif
491 }
492
493 ccl_device_inline float dot(const float4 a, const float4 b)
494 {
495 #if defined(__KERNEL_SSE41__) && defined(__KERNEL_SSE__)
496         return _mm_cvtss_f32(_mm_dp_ps(a, b, 0xFF));
497 #else   
498         return (a.x*b.x + a.y*b.y) + (a.z*b.z + a.w*b.w);
499 #endif
500 }
501
502 ccl_device_inline float3 cross(const float3 a, const float3 b)
503 {
504         float3 r = make_float3(a.y*b.z - a.z*b.y, a.z*b.x - a.x*b.z, a.x*b.y - a.y*b.x);
505         return r;
506 }
507
508 #endif
509
510 ccl_device_inline float len(const float3 a)
511 {
512 #if defined(__KERNEL_SSE41__) && defined(__KERNEL_SSE__)
513         return _mm_cvtss_f32(_mm_sqrt_ss(_mm_dp_ps(a.m128, a.m128, 0x7F)));
514 #else
515         return sqrtf(dot(a, a));
516 #endif
517 }
518
519 ccl_device_inline float len_squared(const float3 a)
520 {
521         return dot(a, a);
522 }
523
524 #ifndef __KERNEL_OPENCL__
525
526 ccl_device_inline float len_squared(const float4 a)
527 {
528         return dot(a, a);
529 }
530
531 ccl_device_inline float3 normalize(const float3 a)
532 {
533 #if defined(__KERNEL_SSE41__) && defined(__KERNEL_SSE__)
534         __m128 norm = _mm_sqrt_ps(_mm_dp_ps(a.m128, a.m128, 0x7F));
535         return _mm_div_ps(a.m128, norm);
536 #else
537         return a/len(a);
538 #endif
539 }
540
541 #endif
542
543 ccl_device_inline float3 normalize_len(const float3 a, float *t)
544 {
545         *t = len(a);
546         return a/(*t);
547 }
548
549 ccl_device_inline float3 safe_normalize(const float3 a)
550 {
551         float t = len(a);
552         return (t != 0.0f)? a/t: a;
553 }
554
555 #ifndef __KERNEL_OPENCL__
556
557 ccl_device_inline bool operator==(const float3 a, const float3 b)
558 {
559 #ifdef __KERNEL_SSE__
560         return (_mm_movemask_ps(_mm_cmpeq_ps(a.m128, b.m128)) & 7) == 7;
561 #else
562         return (a.x == b.x && a.y == b.y && a.z == b.z);
563 #endif
564 }
565
566 ccl_device_inline bool operator!=(const float3 a, const float3 b)
567 {
568         return !(a == b);
569 }
570
571 ccl_device_inline float3 min(float3 a, float3 b)
572 {
573 #ifdef __KERNEL_SSE__
574         return _mm_min_ps(a.m128, b.m128);
575 #else
576         return make_float3(min(a.x, b.x), min(a.y, b.y), min(a.z, b.z));
577 #endif
578 }
579
580 ccl_device_inline float3 max(float3 a, float3 b)
581 {
582 #ifdef __KERNEL_SSE__
583         return _mm_max_ps(a.m128, b.m128);
584 #else
585         return make_float3(max(a.x, b.x), max(a.y, b.y), max(a.z, b.z));
586 #endif
587 }
588
589 ccl_device_inline float3 clamp(float3 a, float3 mn, float3 mx)
590 {
591         return min(max(a, mn), mx);
592 }
593
594 ccl_device_inline float3 fabs(float3 a)
595 {
596 #ifdef __KERNEL_SSE__
597         __m128 mask = _mm_castsi128_ps(_mm_set1_epi32(0x7fffffff));
598         return _mm_and_ps(a.m128, mask);
599 #else
600         return make_float3(fabsf(a.x), fabsf(a.y), fabsf(a.z));
601 #endif
602 }
603
604 #endif
605
606 ccl_device_inline float3 float2_to_float3(const float2 a)
607 {
608         return make_float3(a.x, a.y, 0.0f);
609 }
610
611 ccl_device_inline float3 float4_to_float3(const float4 a)
612 {
613         return make_float3(a.x, a.y, a.z);
614 }
615
616 ccl_device_inline float4 float3_to_float4(const float3 a)
617 {
618         return make_float4(a.x, a.y, a.z, 1.0f);
619 }
620
621 #ifndef __KERNEL_GPU__
622
623 ccl_device_inline void print_float3(const char *label, const float3& a)
624 {
625         printf("%s: %.8f %.8f %.8f\n", label, (double)a.x, (double)a.y, (double)a.z);
626 }
627
628 ccl_device_inline float3 rcp(const float3& a)
629 {
630 #ifdef __KERNEL_SSE__
631         float4 r = _mm_rcp_ps(a.m128);
632         return _mm_sub_ps(_mm_add_ps(r, r), _mm_mul_ps(_mm_mul_ps(r, r), a));
633 #else
634         return make_float3(1.0f/a.x, 1.0f/a.y, 1.0f/a.z);
635 #endif
636 }
637
638 #endif
639
640 ccl_device_inline float3 interp(float3 a, float3 b, float t)
641 {
642         return a + t*(b - a);
643 }
644
645 ccl_device_inline bool is_zero(const float3 a)
646 {
647 #ifdef __KERNEL_SSE__
648         return a == make_float3(0.0f);
649 #else
650         return (a.x == 0.0f && a.y == 0.0f && a.z == 0.0f);
651 #endif
652 }
653
654 ccl_device_inline float reduce_add(const float3 a)
655 {
656         return (a.x + a.y + a.z);
657 }
658
659 ccl_device_inline float average(const float3 a)
660 {
661         return reduce_add(a)*(1.0f/3.0f);
662 }
663
664 /* Float4 Vector */
665
666 #ifdef __KERNEL_SSE__
667
668 template<size_t index_0, size_t index_1, size_t index_2, size_t index_3> __forceinline const float4 shuffle(const float4& b)
669 {
670         return _mm_castsi128_ps(_mm_shuffle_epi32(_mm_castps_si128(b), _MM_SHUFFLE(index_3, index_2, index_1, index_0)));
671 }
672
673 template<> __forceinline const float4 shuffle<0, 0, 2, 2>(const float4& b)
674 {
675         return _mm_moveldup_ps(b);
676 }
677
678 template<> __forceinline const float4 shuffle<1, 1, 3, 3>(const float4& b)
679 {
680         return _mm_movehdup_ps(b);
681 }
682
683 template<> __forceinline const float4 shuffle<0, 1, 0, 1>(const float4& b)
684 {
685         return _mm_castpd_ps(_mm_movedup_pd(_mm_castps_pd(b)));
686 }
687
688 #endif
689
690 #ifndef __KERNEL_OPENCL__
691
692 ccl_device_inline float4 operator-(const float4& a)
693 {
694 #ifdef __KERNEL_SSE__
695         __m128 mask = _mm_castsi128_ps(_mm_set1_epi32(0x80000000));
696         return _mm_xor_ps(a.m128, mask);
697 #else
698         return make_float4(-a.x, -a.y, -a.z, -a.w);
699 #endif
700 }
701
702 ccl_device_inline float4 operator*(const float4& a, const float4& b)
703 {
704 #ifdef __KERNEL_SSE__
705         return _mm_mul_ps(a.m128, b.m128);
706 #else
707         return make_float4(a.x*b.x, a.y*b.y, a.z*b.z, a.w*b.w);
708 #endif
709 }
710
711 ccl_device_inline float4 operator*(const float4& a, float f)
712 {
713 #ifdef __KERNEL_SSE__
714         return a * make_float4(f);
715 #else
716         return make_float4(a.x*f, a.y*f, a.z*f, a.w*f);
717 #endif
718 }
719
720 ccl_device_inline float4 operator*(float f, const float4& a)
721 {
722         return a * f;
723 }
724
725 ccl_device_inline float4 rcp(const float4& a)
726 {
727 #ifdef __KERNEL_SSE__
728         float4 r = _mm_rcp_ps(a.m128);
729         return _mm_sub_ps(_mm_add_ps(r, r), _mm_mul_ps(_mm_mul_ps(r, r), a));
730 #else
731         return make_float4(1.0f/a.x, 1.0f/a.y, 1.0f/a.z, 1.0f/a.w);
732 #endif
733 }
734
735 ccl_device_inline float4 operator/(const float4& a, float f)
736 {
737         return a * (1.0f/f);
738 }
739
740 ccl_device_inline float4 operator/(const float4& a, const float4& b)
741 {
742 #ifdef __KERNEL_SSE__
743         return a * rcp(b);
744 #else
745         return make_float4(a.x/b.x, a.y/b.y, a.z/b.z, a.w/b.w);
746 #endif
747
748 }
749
750 ccl_device_inline float4 operator+(const float4& a, const float4& b)
751 {
752 #ifdef __KERNEL_SSE__
753         return _mm_add_ps(a.m128, b.m128);
754 #else
755         return make_float4(a.x+b.x, a.y+b.y, a.z+b.z, a.w+b.w);
756 #endif
757 }
758
759 ccl_device_inline float4 operator-(const float4& a, const float4& b)
760 {
761 #ifdef __KERNEL_SSE__
762         return _mm_sub_ps(a.m128, b.m128);
763 #else
764         return make_float4(a.x-b.x, a.y-b.y, a.z-b.z, a.w-b.w);
765 #endif
766 }
767
768 ccl_device_inline float4 operator+=(float4& a, const float4& b)
769 {
770         return a = a + b;
771 }
772
773 ccl_device_inline float4 operator*=(float4& a, const float4& b)
774 {
775         return a = a * b;
776 }
777
778 ccl_device_inline float4 operator/=(float4& a, float f)
779 {
780         return a = a / f;
781 }
782
783 ccl_device_inline int4 operator<(const float4& a, const float4& b)
784 {
785 #ifdef __KERNEL_SSE__
786         return _mm_cvtps_epi32(_mm_cmplt_ps(a.m128, b.m128)); /* todo: avoid cvt */
787 #else
788         return make_int4(a.x < b.x, a.y < b.y, a.z < b.z, a.w < b.w);
789 #endif
790 }
791
792 ccl_device_inline int4 operator>=(float4 a, float4 b)
793 {
794 #ifdef __KERNEL_SSE__
795         return _mm_cvtps_epi32(_mm_cmpge_ps(a.m128, b.m128)); /* todo: avoid cvt */
796 #else
797         return make_int4(a.x >= b.x, a.y >= b.y, a.z >= b.z, a.w >= b.w);
798 #endif
799 }
800
801 ccl_device_inline int4 operator<=(const float4& a, const float4& b)
802 {
803 #ifdef __KERNEL_SSE__
804         return _mm_cvtps_epi32(_mm_cmple_ps(a.m128, b.m128)); /* todo: avoid cvt */
805 #else
806         return make_int4(a.x <= b.x, a.y <= b.y, a.z <= b.z, a.w <= b.w);
807 #endif
808 }
809
810 ccl_device_inline bool operator==(const float4 a, const float4 b)
811 {
812 #ifdef __KERNEL_SSE__
813         return (_mm_movemask_ps(_mm_cmpeq_ps(a.m128, b.m128)) & 15) == 15;
814 #else
815         return (a.x == b.x && a.y == b.y && a.z == b.z && a.w == b.w);
816 #endif
817 }
818
819 ccl_device_inline float4 cross(const float4& a, const float4& b)
820 {
821 #ifdef __KERNEL_SSE__
822         return (shuffle<1,2,0,0>(a)*shuffle<2,0,1,0>(b)) - (shuffle<2,0,1,0>(a)*shuffle<1,2,0,0>(b));
823 #else
824         return make_float4(a.y*b.z - a.z*b.y, a.z*b.x - a.x*b.z, a.x*b.y - a.y*b.x, 0.0f);
825 #endif
826 }
827
828 ccl_device_inline bool is_zero(const float4& a)
829 {
830 #ifdef __KERNEL_SSE__
831         return a == make_float4(0.0f);
832 #else
833         return (a.x == 0.0f && a.y == 0.0f && a.z == 0.0f && a.w == 0.0f);
834 #endif
835 }
836
837 ccl_device_inline float reduce_add(const float4& a)
838 {
839 #ifdef __KERNEL_SSE__
840         float4 h = shuffle<1,0,3,2>(a) + a;
841         return _mm_cvtss_f32(shuffle<2,3,0,1>(h) + h); /* todo: efficiency? */
842 #else
843         return ((a.x + a.y) + (a.z + a.w));
844 #endif
845 }
846
847 ccl_device_inline float average(const float4& a)
848 {
849         return reduce_add(a) * 0.25f;
850 }
851
852 ccl_device_inline float len(const float4 a)
853 {
854         return sqrtf(dot(a, a));
855 }
856
857 ccl_device_inline float4 normalize(const float4 a)
858 {
859         return a/len(a);
860 }
861
862 ccl_device_inline float4 safe_normalize(const float4 a)
863 {
864         float t = len(a);
865         return (t != 0.0f)? a/t: a;
866 }
867
868 ccl_device_inline float4 min(float4 a, float4 b)
869 {
870 #ifdef __KERNEL_SSE__
871         return _mm_min_ps(a.m128, b.m128);
872 #else
873         return make_float4(min(a.x, b.x), min(a.y, b.y), min(a.z, b.z), min(a.w, b.w));
874 #endif
875 }
876
877 ccl_device_inline float4 max(float4 a, float4 b)
878 {
879 #ifdef __KERNEL_SSE__
880         return _mm_max_ps(a.m128, b.m128);
881 #else
882         return make_float4(max(a.x, b.x), max(a.y, b.y), max(a.z, b.z), max(a.w, b.w));
883 #endif
884 }
885
886 #endif
887
888 #ifndef __KERNEL_GPU__
889
890 ccl_device_inline float4 select(const int4& mask, const float4& a, const float4& b)
891 {
892 #ifdef __KERNEL_SSE__
893         return _mm_or_ps(_mm_and_ps(_mm_cvtepi32_ps(mask), a), _mm_andnot_ps(_mm_cvtepi32_ps(mask), b)); /* todo: avoid cvt */
894 #else
895         return make_float4((mask.x)? a.x: b.x, (mask.y)? a.y: b.y, (mask.z)? a.z: b.z, (mask.w)? a.w: b.w);
896 #endif
897 }
898
899 ccl_device_inline float4 reduce_min(const float4& a)
900 {
901 #ifdef __KERNEL_SSE__
902         float4 h = min(shuffle<1,0,3,2>(a), a);
903         return min(shuffle<2,3,0,1>(h), h);
904 #else
905         return make_float4(min(min(a.x, a.y), min(a.z, a.w)));
906 #endif
907 }
908
909 ccl_device_inline float4 reduce_max(const float4& a)
910 {
911 #ifdef __KERNEL_SSE__
912         float4 h = max(shuffle<1,0,3,2>(a), a);
913         return max(shuffle<2,3,0,1>(h), h);
914 #else
915         return make_float4(max(max(a.x, a.y), max(a.z, a.w)));
916 #endif
917 }
918
919 #if 0
920 ccl_device_inline float4 reduce_add(const float4& a)
921 {
922 #ifdef __KERNEL_SSE__
923         float4 h = shuffle<1,0,3,2>(a) + a;
924         return shuffle<2,3,0,1>(h) + h;
925 #else
926         return make_float4((a.x + a.y) + (a.z + a.w));
927 #endif
928 }
929 #endif
930
931 ccl_device_inline void print_float4(const char *label, const float4& a)
932 {
933         printf("%s: %.8f %.8f %.8f %.8f\n", label, (double)a.x, (double)a.y, (double)a.z, (double)a.w);
934 }
935
936 #endif
937
938 /* Int2 */
939
940 #ifndef __KERNEL_OPENCL__
941
942 ccl_device_inline int2 operator+(const int2 &a, const int2 &b)
943 {
944         return make_int2(a.x + b.x, a.y + b.y);
945 }
946
947 ccl_device_inline int2 operator+=(int2 &a, const int2 &b)
948 {
949         return a = a + b;
950 }
951
952 ccl_device_inline int2 operator-(const int2 &a, const int2 &b)
953 {
954         return make_int2(a.x - b.x, a.y - b.y);
955 }
956
957 ccl_device_inline int2 operator*(const int2 &a, const int2 &b)
958 {
959         return make_int2(a.x * b.x, a.y * b.y);
960 }
961
962 ccl_device_inline int2 operator/(const int2 &a, const int2 &b)
963 {
964         return make_int2(a.x / b.x, a.y / b.y);
965 }
966
967 #endif
968
969 /* Int3 */
970
971 #ifndef __KERNEL_OPENCL__
972
973 ccl_device_inline int3 min(int3 a, int3 b)
974 {
975 #if defined(__KERNEL_SSE__) && defined(__KERNEL_SSE41__)
976         return _mm_min_epi32(a.m128, b.m128);
977 #else
978         return make_int3(min(a.x, b.x), min(a.y, b.y), min(a.z, b.z));
979 #endif
980 }
981
982 ccl_device_inline int3 max(int3 a, int3 b)
983 {
984 #if defined(__KERNEL_SSE__) && defined(__KERNEL_SSE41__)
985         return _mm_max_epi32(a.m128, b.m128);
986 #else
987         return make_int3(max(a.x, b.x), max(a.y, b.y), max(a.z, b.z));
988 #endif
989 }
990
991 ccl_device_inline int3 clamp(const int3& a, int mn, int mx)
992 {
993 #ifdef __KERNEL_SSE__
994         return min(max(a, make_int3(mn)), make_int3(mx));
995 #else
996         return make_int3(clamp(a.x, mn, mx), clamp(a.y, mn, mx), clamp(a.z, mn, mx));
997 #endif
998 }
999
1000 ccl_device_inline int3 clamp(const int3& a, int3& mn, int mx)
1001 {
1002 #ifdef __KERNEL_SSE__
1003         return min(max(a, mn), make_int3(mx));
1004 #else
1005         return make_int3(clamp(a.x, mn.x, mx), clamp(a.y, mn.y, mx), clamp(a.z, mn.z, mx));
1006 #endif
1007 }
1008
1009 #endif
1010
1011 #ifndef __KERNEL_GPU__
1012
1013 ccl_device_inline void print_int3(const char *label, const int3& a)
1014 {
1015         printf("%s: %d %d %d\n", label, a.x, a.y, a.z);
1016 }
1017
1018 #endif
1019
1020 /* Int4 */
1021
1022 #ifndef __KERNEL_GPU__
1023
1024 ccl_device_inline int4 operator+(const int4& a, const int4& b)
1025 {
1026 #ifdef __KERNEL_SSE__
1027         return _mm_add_epi32(a.m128, b.m128);
1028 #else
1029         return make_int4(a.x+b.x, a.y+b.y, a.z+b.z, a.w+b.w);
1030 #endif
1031 }
1032
1033 ccl_device_inline int4 operator+=(int4& a, const int4& b)
1034 {
1035         return a = a + b;
1036 }
1037
1038 ccl_device_inline int4 operator>>(const int4& a, int i)
1039 {
1040 #ifdef __KERNEL_SSE__
1041         return _mm_srai_epi32(a.m128, i);
1042 #else
1043         return make_int4(a.x >> i, a.y >> i, a.z >> i, a.w >> i);
1044 #endif
1045 }
1046
1047 ccl_device_inline int4 min(int4 a, int4 b)
1048 {
1049 #if defined(__KERNEL_SSE__) && defined(__KERNEL_SSE41__)
1050         return _mm_min_epi32(a.m128, b.m128);
1051 #else
1052         return make_int4(min(a.x, b.x), min(a.y, b.y), min(a.z, b.z), min(a.w, b.w));
1053 #endif
1054 }
1055
1056 ccl_device_inline int4 max(int4 a, int4 b)
1057 {
1058 #if defined(__KERNEL_SSE__) && defined(__KERNEL_SSE41__)
1059         return _mm_max_epi32(a.m128, b.m128);
1060 #else
1061         return make_int4(max(a.x, b.x), max(a.y, b.y), max(a.z, b.z), max(a.w, b.w));
1062 #endif
1063 }
1064
1065 ccl_device_inline int4 clamp(const int4& a, const int4& mn, const int4& mx)
1066 {
1067         return min(max(a, mn), mx);
1068 }
1069
1070 ccl_device_inline int4 select(const int4& mask, const int4& a, const int4& b)
1071 {
1072 #ifdef __KERNEL_SSE__
1073         __m128 m = _mm_cvtepi32_ps(mask);
1074         return _mm_castps_si128(_mm_or_ps(_mm_and_ps(m, _mm_castsi128_ps(a)), _mm_andnot_ps(m, _mm_castsi128_ps(b)))); /* todo: avoid cvt */
1075 #else
1076         return make_int4((mask.x)? a.x: b.x, (mask.y)? a.y: b.y, (mask.z)? a.z: b.z, (mask.w)? a.w: b.w);
1077 #endif
1078 }
1079
1080 ccl_device_inline void print_int4(const char *label, const int4& a)
1081 {
1082         printf("%s: %d %d %d %d\n", label, a.x, a.y, a.z, a.w);
1083 }
1084
1085 #endif
1086
1087 /* Int/Float conversion */
1088
1089 #ifndef __KERNEL_OPENCL__
1090
1091 ccl_device_inline int as_int(uint i)
1092 {
1093         union { uint ui; int i; } u;
1094         u.ui = i;
1095         return u.i;
1096 }
1097
1098 ccl_device_inline uint as_uint(int i)
1099 {
1100         union { uint ui; int i; } u;
1101         u.i = i;
1102         return u.ui;
1103 }
1104
1105 ccl_device_inline uint as_uint(float f)
1106 {
1107         union { uint i; float f; } u;
1108         u.f = f;
1109         return u.i;
1110 }
1111
1112 ccl_device_inline int __float_as_int(float f)
1113 {
1114         union { int i; float f; } u;
1115         u.f = f;
1116         return u.i;
1117 }
1118
1119 ccl_device_inline float __int_as_float(int i)
1120 {
1121         union { int i; float f; } u;
1122         u.i = i;
1123         return u.f;
1124 }
1125
1126 ccl_device_inline uint __float_as_uint(float f)
1127 {
1128         union { uint i; float f; } u;
1129         u.f = f;
1130         return u.i;
1131 }
1132
1133 ccl_device_inline float __uint_as_float(uint i)
1134 {
1135         union { uint i; float f; } u;
1136         u.i = i;
1137         return u.f;
1138 }
1139
1140 /* Interpolation */
1141
1142 template<class A, class B> A lerp(const A& a, const A& b, const B& t)
1143 {
1144         return (A)(a * ((B)1 - t) + b * t);
1145 }
1146
1147 /* Triangle */
1148
1149 ccl_device_inline float triangle_area(const float3 v1, const float3 v2, const float3 v3)
1150 {
1151         return len(cross(v3 - v2, v1 - v2))*0.5f;
1152 }
1153
1154 #endif
1155
1156 /* Orthonormal vectors */
1157
1158 ccl_device_inline void make_orthonormals(const float3 N, float3 *a, float3 *b)
1159 {
1160 #if 0
1161         if(fabsf(N.y) >= 0.999f) {
1162                 *a = make_float3(1, 0, 0);
1163                 *b = make_float3(0, 0, 1);
1164                 return;
1165         }
1166         if(fabsf(N.z) >= 0.999f) {
1167                 *a = make_float3(1, 0, 0);
1168                 *b = make_float3(0, 1, 0);
1169                 return;
1170         }
1171 #endif
1172
1173         if(N.x != N.y || N.x != N.z)
1174                 *a = make_float3(N.z-N.y, N.x-N.z, N.y-N.x);  //(1,1,1)x N
1175         else
1176                 *a = make_float3(N.z-N.y, N.x+N.z, -N.y-N.x);  //(-1,1,1)x N
1177
1178         *a = normalize(*a);
1179         *b = cross(N, *a);
1180 }
1181
1182 /* Color division */
1183
1184 ccl_device_inline float3 safe_invert_color(float3 a)
1185 {
1186         float x, y, z;
1187
1188         x = (a.x != 0.0f)? 1.0f/a.x: 0.0f;
1189         y = (a.y != 0.0f)? 1.0f/a.y: 0.0f;
1190         z = (a.z != 0.0f)? 1.0f/a.z: 0.0f;
1191
1192         return make_float3(x, y, z);
1193 }
1194
1195 ccl_device_inline float3 safe_divide_color(float3 a, float3 b)
1196 {
1197         float x, y, z;
1198
1199         x = (b.x != 0.0f)? a.x/b.x: 0.0f;
1200         y = (b.y != 0.0f)? a.y/b.y: 0.0f;
1201         z = (b.z != 0.0f)? a.z/b.z: 0.0f;
1202
1203         return make_float3(x, y, z);
1204 }
1205
1206 ccl_device_inline float3 safe_divide_even_color(float3 a, float3 b)
1207 {
1208         float x, y, z;
1209
1210         x = (b.x != 0.0f)? a.x/b.x: 0.0f;
1211         y = (b.y != 0.0f)? a.y/b.y: 0.0f;
1212         z = (b.z != 0.0f)? a.z/b.z: 0.0f;
1213
1214         /* try to get grey even if b is zero */
1215         if(b.x == 0.0f) {
1216                 if(b.y == 0.0f) {
1217                         x = z;
1218                         y = z;
1219                 }
1220                 else if(b.z == 0.0f) {
1221                         x = y;
1222                         z = y;
1223                 }
1224                 else
1225                         x = 0.5f*(y + z);
1226         }
1227         else if(b.y == 0.0f) {
1228                 if(b.z == 0.0f) {
1229                         y = x;
1230                         z = x;
1231                 }
1232                 else
1233                         y = 0.5f*(x + z);
1234         }
1235         else if(b.z == 0.0f) {
1236                 z = 0.5f*(x + y);
1237         }
1238
1239         return make_float3(x, y, z);
1240 }
1241
1242 /* Rotation of point around axis and angle */
1243
1244 ccl_device_inline float3 rotate_around_axis(float3 p, float3 axis, float angle)
1245 {
1246         float costheta = cosf(angle);
1247         float sintheta = sinf(angle);
1248         float3 r;
1249
1250         r.x = ((costheta + (1 - costheta) * axis.x * axis.x) * p.x) +
1251                 (((1 - costheta) * axis.x * axis.y - axis.z * sintheta) * p.y) +
1252                 (((1 - costheta) * axis.x * axis.z + axis.y * sintheta) * p.z);
1253
1254         r.y = (((1 - costheta) * axis.x * axis.y + axis.z * sintheta) * p.x) +
1255                 ((costheta + (1 - costheta) * axis.y * axis.y) * p.y) +
1256                 (((1 - costheta) * axis.y * axis.z - axis.x * sintheta) * p.z);
1257
1258         r.z = (((1 - costheta) * axis.x * axis.z - axis.y * sintheta) * p.x) +
1259                 (((1 - costheta) * axis.y * axis.z + axis.x * sintheta) * p.y) +
1260                 ((costheta + (1 - costheta) * axis.z * axis.z) * p.z);
1261
1262         return r;
1263 }
1264
1265 /* NaN-safe math ops */
1266
1267 ccl_device_inline float safe_sqrtf(float f)
1268 {
1269         return sqrtf(max(f, 0.0f));
1270 }
1271
1272 ccl_device float safe_asinf(float a)
1273 {
1274         return asinf(clamp(a, -1.0f, 1.0f));
1275 }
1276
1277 ccl_device float safe_acosf(float a)
1278 {
1279         return acosf(clamp(a, -1.0f, 1.0f));
1280 }
1281
1282 ccl_device float compatible_powf(float x, float y)
1283 {
1284 #ifdef __KERNEL_GPU__
1285         if(y == 0.0f) /* x^0 -> 1, including 0^0 */
1286                 return 1.0f;
1287
1288         /* GPU pow doesn't accept negative x, do manual checks here */
1289         if(x < 0.0f) {
1290                 if(fmodf(-y, 2.0f) == 0.0f)
1291                         return powf(-x, y);
1292                 else
1293                         return -powf(-x, y);
1294         }
1295         else if(x == 0.0f)
1296                 return 0.0f;
1297 #endif
1298         return powf(x, y);
1299 }
1300
1301 ccl_device float safe_powf(float a, float b)
1302 {
1303         if(UNLIKELY(a < 0.0f && b != float_to_int(b)))
1304                 return 0.0f;
1305
1306         return compatible_powf(a, b);
1307 }
1308
1309 ccl_device float safe_logf(float a, float b)
1310 {
1311         if(UNLIKELY(a < 0.0f || b < 0.0f))
1312                 return 0.0f;
1313
1314         return logf(a)/logf(b);
1315 }
1316
1317 ccl_device float safe_divide(float a, float b)
1318 {
1319         return (b != 0.0f)? a/b: 0.0f;
1320 }
1321
1322 ccl_device float safe_modulo(float a, float b)
1323 {
1324         return (b != 0.0f)? fmodf(a, b): 0.0f;
1325 }
1326
1327 /* Ray Intersection */
1328
1329 ccl_device bool ray_sphere_intersect(
1330         float3 ray_P, float3 ray_D, float ray_t,
1331         float3 sphere_P, float sphere_radius,
1332         float3 *isect_P, float *isect_t)
1333 {
1334         float3 d = sphere_P - ray_P;
1335         float radiussq = sphere_radius*sphere_radius;
1336         float tsq = dot(d, d);
1337
1338         if(tsq > radiussq) { /* ray origin outside sphere */
1339                 float tp = dot(d, ray_D);
1340
1341                 if(tp < 0.0f) /* dir points away from sphere */
1342                         return false;
1343
1344                 float dsq = tsq - tp*tp; /* pythagoras */
1345
1346                 if(dsq > radiussq) /* closest point on ray outside sphere */
1347                         return false;
1348
1349                 float t = tp - sqrtf(radiussq - dsq); /* pythagoras */
1350
1351                 if(t < ray_t) {
1352                         *isect_t = t;
1353                         *isect_P = ray_P + ray_D*t;
1354                         return true;
1355                 }
1356         }
1357
1358         return false;
1359 }
1360
1361 ccl_device bool ray_aligned_disk_intersect(
1362         float3 ray_P, float3 ray_D, float ray_t,
1363         float3 disk_P, float disk_radius,
1364         float3 *isect_P, float *isect_t)
1365 {
1366         /* aligned disk normal */
1367         float disk_t;
1368         float3 disk_N = normalize_len(ray_P - disk_P, &disk_t);
1369         float div = dot(ray_D, disk_N);
1370
1371         if(UNLIKELY(div == 0.0f))
1372                 return false;
1373
1374         /* compute t to intersection point */
1375         float t = -disk_t/div;
1376         if(t < 0.0f || t > ray_t)
1377                 return false;
1378         
1379         /* test if within radius */
1380         float3 P = ray_P + ray_D*t;
1381         if(len_squared(P - disk_P) > disk_radius*disk_radius)
1382                 return false;
1383
1384         *isect_P = P;
1385         *isect_t = t;
1386
1387         return true;
1388 }
1389
1390 ccl_device bool ray_triangle_intersect(
1391         float3 ray_P, float3 ray_D, float ray_t,
1392         float3 v0, float3 v1, float3 v2,
1393         float3 *isect_P, float *isect_t)
1394 {
1395         /* Calculate intersection */
1396         float3 e1 = v1 - v0;
1397         float3 e2 = v2 - v0;
1398         float3 s1 = cross(ray_D, e2);
1399
1400         const float divisor = dot(s1, e1);
1401         if(UNLIKELY(divisor == 0.0f))
1402                 return false;
1403
1404         const float invdivisor = 1.0f/divisor;
1405
1406         /* compute first barycentric coordinate */
1407         const float3 d = ray_P - v0;
1408         const float u = dot(d, s1)*invdivisor;
1409         if(u < 0.0f)
1410                 return false;
1411
1412         /* Compute second barycentric coordinate */
1413         const float3 s2 = cross(d, e1);
1414         const float v = dot(ray_D, s2)*invdivisor;
1415         if(v < 0.0f)
1416                 return false;
1417
1418         const float b0 = 1.0f - u - v;
1419         if(b0 < 0.0f)
1420                 return false;
1421
1422         /* compute t to intersection point */
1423         const float t = dot(e2, s2)*invdivisor;
1424         if(t < 0.0f || t > ray_t)
1425                 return false;
1426
1427         *isect_t = t;
1428         *isect_P = ray_P + ray_D*t;
1429
1430         return true;
1431 }
1432
1433 ccl_device bool ray_triangle_intersect_uv(
1434         float3 ray_P, float3 ray_D, float ray_t,
1435         float3 v0, float3 v1, float3 v2,
1436         float *isect_u, float *isect_v, float *isect_t)
1437 {
1438         /* Calculate intersection */
1439         float3 e1 = v1 - v0;
1440         float3 e2 = v2 - v0;
1441         float3 s1 = cross(ray_D, e2);
1442
1443         const float divisor = dot(s1, e1);
1444         if(UNLIKELY(divisor == 0.0f))
1445                 return false;
1446
1447         const float invdivisor = 1.0f/divisor;
1448
1449         /* compute first barycentric coordinate */
1450         const float3 d = ray_P - v0;
1451         const float u = dot(d, s1)*invdivisor;
1452         if(u < 0.0f)
1453                 return false;
1454
1455         /* Compute second barycentric coordinate */
1456         const float3 s2 = cross(d, e1);
1457         const float v = dot(ray_D, s2)*invdivisor;
1458         if(v < 0.0f)
1459                 return false;
1460
1461         const float b0 = 1.0f - u - v;
1462         if(b0 < 0.0f)
1463                 return false;
1464
1465         /* compute t to intersection point */
1466         const float t = dot(e2, s2)*invdivisor;
1467         if(t < 0.0f || t > ray_t)
1468                 return false;
1469
1470         *isect_u = u;
1471         *isect_v = v;
1472         *isect_t = t;
1473
1474         return true;
1475 }
1476
1477 ccl_device bool ray_quad_intersect(float3 ray_P, float3 ray_D, float ray_t,
1478                                    float3 quad_P, float3 quad_u, float3 quad_v,
1479                                    float3 *isect_P, float *isect_t)
1480 {
1481         float3 v0 = quad_P - quad_u*0.5f - quad_v*0.5f;
1482         float3 v1 = quad_P + quad_u*0.5f - quad_v*0.5f;
1483         float3 v2 = quad_P + quad_u*0.5f + quad_v*0.5f;
1484         float3 v3 = quad_P - quad_u*0.5f + quad_v*0.5f;
1485
1486         if(ray_triangle_intersect(ray_P, ray_D, ray_t, v0, v1, v2, isect_P, isect_t))
1487                 return true;
1488         else if(ray_triangle_intersect(ray_P, ray_D, ray_t, v0, v2, v3, isect_P, isect_t))
1489                 return true;
1490         
1491         return false;
1492 }
1493
1494 /* projections */
1495 ccl_device_inline float2 map_to_tube(const float3 co)
1496 {
1497         float len, u, v;
1498         len = sqrtf(co.x * co.x + co.y * co.y);
1499         if(len > 0.0f) {
1500                 u = (1.0f - (atan2f(co.x / len, co.y / len) / M_PI_F)) * 0.5f;
1501                 v = (co.z + 1.0f) * 0.5f;
1502         }
1503         else {
1504                 u = v = 0.0f;
1505         }
1506         return make_float2(u, v);
1507 }
1508
1509 ccl_device_inline float2 map_to_sphere(const float3 co)
1510 {
1511         float l = len(co);
1512         float u, v;
1513         if(l > 0.0f) {
1514                 if(UNLIKELY(co.x == 0.0f && co.y == 0.0f)) {
1515                         u = 0.0f;  /* othwise domain error */
1516                 }
1517                 else {
1518                         u = (1.0f - atan2f(co.x, co.y) / M_PI_F) / 2.0f;
1519                 }
1520                 v = 1.0f - safe_acosf(co.z / l) / M_PI_F;
1521         }
1522         else {
1523                 u = v = 0.0f;
1524         }
1525         return make_float2(u, v);
1526 }
1527
1528 ccl_device_inline int util_max_axis(float3 vec)
1529 {
1530         if(vec.x > vec.y) {
1531                 if(vec.x > vec.z)
1532                         return 0;
1533                 else
1534                         return 2;
1535         }
1536         else {
1537                 if(vec.y > vec.z)
1538                         return 1;
1539                 else
1540                         return 2;
1541         }
1542 }
1543
1544 CCL_NAMESPACE_END
1545
1546 #endif /* __UTIL_MATH_H__ */
1547