Commit | Line | Data |
---|---|---|
3719602c PC |
1 | /* Copyright (C) 2010-2020 The RetroArch team |
2 | * | |
3 | * --------------------------------------------------------------------------------------- | |
4 | * The following license statement only applies to this file (vector_2.h). | |
5 | * --------------------------------------------------------------------------------------- | |
6 | * | |
7 | * Permission is hereby granted, free of charge, | |
8 | * to any person obtaining a copy of this software and associated documentation files (the "Software"), | |
9 | * to deal in the Software without restriction, including without limitation the rights to | |
10 | * use, copy, modify, merge, publish, distribute, sublicense, and/or sell copies of the Software, | |
11 | * and to permit persons to whom the Software is furnished to do so, subject to the following conditions: | |
12 | * | |
13 | * The above copyright notice and this permission notice shall be included in all copies or substantial portions of the Software. | |
14 | * | |
15 | * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR IMPLIED, | |
16 | * INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, | |
17 | * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. | |
18 | * IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, | |
19 | * WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, | |
20 | * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE. | |
21 | */ | |
22 | ||
23 | #ifndef __LIBRETRO_SDK_GFX_MATH_VECTOR_2_H__ | |
24 | #define __LIBRETRO_SDK_GFX_MATH_VECTOR_2_H__ | |
25 | ||
26 | #include <stdint.h> | |
27 | #include <math.h> | |
28 | ||
29 | #include <retro_common_api.h> | |
30 | #include <retro_inline.h> | |
31 | ||
32 | RETRO_BEGIN_DECLS | |
33 | ||
34 | typedef float vec2_t[2]; | |
35 | ||
36 | #define vec2_dot(a, b) ((a[0] * b[0]) + (a[1] * b[1])) | |
37 | ||
38 | #define vec2_cross(a, b) ((a[0]*b[1]) - (a[1]*b[0])) | |
39 | ||
40 | #define vec2_add(dst, src) \ | |
41 | dst[0] += src[0]; \ | |
42 | dst[1] += src[1] | |
43 | ||
44 | #define vec2_subtract(dst, src) \ | |
45 | dst[0] -= src[0]; \ | |
46 | dst[1] -= src[1] | |
47 | ||
48 | #define vec2_copy(dst, src) \ | |
49 | dst[0] = src[0]; \ | |
50 | dst[1] = src[1] | |
51 | ||
52 | static INLINE float overflow(void) | |
53 | { | |
54 | unsigned i; | |
55 | volatile float f = 1e10; | |
56 | ||
57 | for (i = 0; i < 10; ++i) | |
58 | f *= f; | |
59 | return f; | |
60 | } | |
61 | ||
62 | static INLINE int16_t tofloat16(float f) | |
63 | { | |
64 | union uif32 | |
65 | { | |
66 | float f; | |
67 | uint32_t i; | |
68 | }; | |
69 | ||
70 | int i, s, e, m; | |
71 | union uif32 Entry; | |
72 | Entry.f = f; | |
73 | i = (int)Entry.i; | |
74 | s = (i >> 16) & 0x00008000; | |
75 | e = ((i >> 23) & 0x000000ff) - (127 - 15); | |
76 | m = i & 0x007fffff; | |
77 | ||
78 | if (e <= 0) | |
79 | { | |
80 | if (e < -10) | |
81 | return (int16_t)(s); | |
82 | ||
83 | m = (m | 0x00800000) >> (1 - e); | |
84 | ||
85 | if (m & 0x00001000) | |
86 | m += 0x00002000; | |
87 | ||
88 | return (int16_t)(s | (m >> 13)); | |
89 | } | |
90 | ||
91 | if (e == 0xff - (127 - 15)) | |
92 | { | |
93 | if (m == 0) | |
94 | return (int16_t)(s | 0x7c00); | |
95 | ||
96 | m >>= 13; | |
97 | ||
98 | return (int16_t)(s | 0x7c00 | m | (m == 0)); | |
99 | } | |
100 | ||
101 | if (m & 0x00001000) | |
102 | { | |
103 | m += 0x00002000; | |
104 | ||
105 | if (m & 0x00800000) | |
106 | { | |
107 | m = 0; | |
108 | e += 1; | |
109 | } | |
110 | } | |
111 | ||
112 | if (e > 30) | |
113 | { | |
114 | overflow(); | |
115 | ||
116 | return (int16_t)(s | 0x7c00); | |
117 | } | |
118 | ||
119 | return (int16_t)(s | (e << 10) | (m >> 13)); | |
120 | } | |
121 | ||
122 | static INLINE unsigned int vec2_packHalf2x16(float vec0, float vec1) | |
123 | { | |
124 | union | |
125 | { | |
126 | int16_t in[2]; | |
127 | unsigned int out; | |
128 | } u; | |
129 | ||
130 | u.in[0] = tofloat16(vec0); | |
131 | u.in[1] = tofloat16(vec1); | |
132 | ||
133 | return u.out; | |
134 | } | |
135 | ||
136 | RETRO_END_DECLS | |
137 | ||
138 | #endif |