1 |
|
|
/*************************************************************************** |
2 |
|
|
* Copyright (c) 2024 Microsoft Corporation |
3 |
|
|
* Copyright (c) 2026-present Eclipse ThreadX contributors |
4 |
|
|
* |
5 |
|
|
* This program and the accompanying materials are made available under the |
6 |
|
|
* terms of the MIT License which is available at |
7 |
|
|
* https://opensource.org/licenses/MIT. |
8 |
|
|
* |
9 |
|
|
* SPDX-License-Identifier: MIT |
10 |
|
|
**************************************************************************/ |
11 |
|
|
|
12 |
|
|
|
13 |
|
|
/**************************************************************************/ |
14 |
|
|
/**************************************************************************/ |
15 |
|
|
/** */ |
16 |
|
|
/** GUIX Component */ |
17 |
|
|
/** */ |
18 |
|
|
/** Utility (Utility) */ |
19 |
|
|
/** */ |
20 |
|
|
/**************************************************************************/ |
21 |
|
|
|
22 |
|
|
#define GX_SOURCE_CODE |
23 |
|
|
|
24 |
|
|
|
25 |
|
|
/* Include necessary system files. */ |
26 |
|
|
|
27 |
|
|
#include "gx_api.h" |
28 |
|
|
#include "gx_utility.h" |
29 |
|
|
/* define the the table of sin values for one quadrant, |
30 |
|
|
angle value is enlarged by 4, sine value is enlarged by 256.*/ |
31 |
|
|
static GX_CONST GX_UBYTE sin_value_table[360] = { |
32 |
|
|
0x00, 0x01, 0x02, 0x03, 0x04, 0x05, 0x06, 0x07, 0x08, 0x0a, 0x0b, 0x0c, 0x0d, 0x0e, 0x0f, |
33 |
|
|
0x10, 0x11, 0x12, 0x14, 0x15, 0x16, 0x17, 0x18, 0x19, 0x1a, 0x1b, 0x1c, 0x1e, 0x1f, 0x20, |
34 |
|
|
0x21, 0x22, 0x23, 0x24, 0x25, 0x26, 0x28, 0x29, 0x2a, 0x2b, 0x2c, 0x2d, 0x2e, 0x2f, 0x30, |
35 |
|
|
0x31, 0x33, 0x34, 0x35, 0x36, 0x37, 0x38, 0x39, 0x3a, 0x3b, 0x3c, 0x3d, 0x3f, 0x40, 0x41, |
36 |
|
|
0x42, 0x43, 0x44, 0x45, 0x46, 0x47, 0x48, 0x49, 0x4a, 0x4b, 0x4c, 0x4e, 0x4f, 0x50, 0x51, |
37 |
|
|
0x52, 0x53, 0x54, 0x55, 0x56, 0x57, 0x58, 0x59, 0x5a, 0x5b, 0x5c, 0x5d, 0x5e, 0x5f, 0x60, |
38 |
|
|
0x61, 0x62, 0x64, 0x65, 0x66, 0x67, 0x68, 0x69, 0x6a, 0x6b, 0x6c, 0x6d, 0x6e, 0x6f, 0x70, |
39 |
|
|
0x71, 0x72, 0x73, 0x74, 0x75, 0x76, 0x77, 0x78, 0x79, 0x7a, 0x7b, 0x7c, 0x7d, 0x7e, 0x7f, |
40 |
|
|
0x80, 0x80, 0x81, 0x82, 0x83, 0x84, 0x85, 0x86, 0x87, 0x88, 0x89, 0x8a, 0x8b, 0x8c, 0x8d, |
41 |
|
|
0x8e, 0x8f, 0x90, 0x90, 0x91, 0x92, 0x93, 0x94, 0x95, 0x96, 0x97, 0x98, 0x99, 0x9a, 0x9a, |
42 |
|
|
0x9b, 0x9c, 0x9d, 0x9e, 0x9f, 0xa0, 0xa1, 0xa1, 0xa2, 0xa3, 0xa4, 0xa5, 0xa6, 0xa7, 0xa7, |
43 |
|
|
0xa8, 0xa9, 0xaa, 0xab, 0xac, 0xac, 0xad, 0xae, 0xaf, 0xb0, 0xb1, 0xb1, 0xb2, 0xb3, 0xb4, |
44 |
|
|
0xb5, 0xb5, 0xb6, 0xb7, 0xb8, 0xb8, 0xb9, 0xba, 0xbb, 0xbb, 0xbc, 0xbd, 0xbe, 0xbe, 0xbf, |
45 |
|
|
0xc0, 0xc1, 0xc1, 0xc2, 0xc3, 0xc4, 0xc4, 0xc5, 0xc6, 0xc6, 0xc7, 0xc8, 0xc9, 0xc9, 0xca, |
46 |
|
|
0xcb, 0xcb, 0xcc, 0xcd, 0xcd, 0xce, 0xcf, 0xcf, 0xd0, 0xd1, 0xd1, 0xd2, 0xd2, 0xd3, 0xd4, |
47 |
|
|
0xd4, 0xd5, 0xd6, 0xd6, 0xd7, 0xd7, 0xd8, 0xd9, 0xd9, 0xda, 0xda, 0xdb, 0xdc, 0xdc, 0xdd, |
48 |
|
|
0xdd, 0xde, 0xde, 0xdf, 0xdf, 0xe0, 0xe0, 0xe1, 0xe2, 0xe2, 0xe3, 0xe3, 0xe4, 0xe4, 0xe5, |
49 |
|
|
0xe5, 0xe6, 0xe6, 0xe7, 0xe7, 0xe8, 0xe8, 0xe8, 0xe9, 0xe9, 0xea, 0xea, 0xeb, 0xeb, 0xec, |
50 |
|
|
0xec, 0xec, 0xed, 0xed, 0xee, 0xee, 0xee, 0xef, 0xef, 0xf0, 0xf0, 0xf0, 0xf1, 0xf1, 0xf2, |
51 |
|
|
0xf2, 0xf2, 0xf3, 0xf3, 0xf3, 0xf4, 0xf4, 0xf4, 0xf5, 0xf5, 0xf5, 0xf6, 0xf6, 0xf6, 0xf6, |
52 |
|
|
0xf7, 0xf7, 0xf7, 0xf8, 0xf8, 0xf8, 0xf8, 0xf9, 0xf9, 0xf9, 0xf9, 0xfa, 0xfa, 0xfa, 0xfa, |
53 |
|
|
0xfb, 0xfb, 0xfb, 0xfb, 0xfb, 0xfc, 0xfc, 0xfc, 0xfc, 0xfc, 0xfd, 0xfd, 0xfd, 0xfd, 0xfd, |
54 |
|
|
0xfd, 0xfd, 0xfe, 0xfe, 0xfe, 0xfe, 0xfe, 0xfe, 0xfe, 0xfe, 0xff, 0xff, 0xff, 0xff, 0xff, |
55 |
|
|
0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff |
56 |
|
|
}; |
57 |
|
|
|
58 |
|
|
|
59 |
|
|
/**************************************************************************/ |
60 |
|
|
/* */ |
61 |
|
|
/* FUNCTION RELEASE */ |
62 |
|
|
/* */ |
63 |
|
|
/* _gx_utility_math_sin_5_4_0 PORTABLE C */ |
64 |
|
|
/* 6.1 */ |
65 |
|
|
/* AUTHOR */ |
66 |
|
|
/* */ |
67 |
|
|
/* Kenneth Maxwell, Microsoft Corporation */ |
68 |
|
|
/* */ |
69 |
|
|
/* DESCRIPTION */ |
70 |
|
|
/* */ |
71 |
|
|
/* This service computes the sine of the supplied angl, which is an */ |
72 |
|
|
/* old version of _gx_utility_math_sin. */ |
73 |
|
|
/* */ |
74 |
|
|
/* INPUT */ |
75 |
|
|
/* */ |
76 |
|
|
/* angle Angle to compute sine of, */ |
77 |
|
|
/* the input angle should be */ |
78 |
|
|
/* scaled by 256. */ |
79 |
|
|
/* */ |
80 |
|
|
/* OUTPUT */ |
81 |
|
|
/* */ |
82 |
|
|
/* sine Sine of supplied angle */ |
83 |
|
|
/* */ |
84 |
|
|
/* CALLS */ |
85 |
|
|
/* */ |
86 |
|
|
/* None */ |
87 |
|
|
/* */ |
88 |
|
|
/* CALLED BY */ |
89 |
|
|
/* */ |
90 |
|
|
/* Application Code */ |
91 |
|
|
/* */ |
92 |
|
|
/**************************************************************************/ |
93 |
|
|
#if defined(GUIX_5_4_0_COMPATIBILITY) |
94 |
|
|
INT _gx_utility_math_sin_5_4_0(INT angle) |
95 |
|
|
{ |
96 |
|
|
INT y_sign; |
97 |
|
|
INT sine; |
98 |
|
|
|
99 |
|
|
/* normalize the incoming angle */ |
100 |
|
|
while (angle < 0) |
101 |
|
|
{ |
102 |
|
|
angle += (256 * 360); |
103 |
|
|
} |
104 |
|
|
while (angle > (256 * 360)) |
105 |
|
|
{ |
106 |
|
|
angle -= (256 * 360); |
107 |
|
|
} |
108 |
|
|
|
109 |
|
|
if ((angle >= 0) && (angle <= 23040)) |
110 |
|
|
{ |
111 |
|
|
y_sign = 1; |
112 |
|
|
} |
113 |
|
|
else if ((angle > 23040) && (angle <= 46080)) |
114 |
|
|
{ |
115 |
|
|
angle = 46080 - angle; |
116 |
|
|
y_sign = 1; |
117 |
|
|
} |
118 |
|
|
else if ((angle > 46080) && (angle <= 69120)) |
119 |
|
|
{ |
120 |
|
|
angle -= 46080; |
121 |
|
|
y_sign = -1; |
122 |
|
|
} |
123 |
|
|
else |
124 |
|
|
{ |
125 |
|
|
angle = 92160 - angle; |
126 |
|
|
y_sign = -1; |
127 |
|
|
} |
128 |
|
|
|
129 |
|
|
angle = (angle + 32) >> 6; |
130 |
|
|
|
131 |
|
|
if (angle == 360) |
132 |
|
|
{ |
133 |
|
|
sine = 256 * y_sign; |
134 |
|
|
} |
135 |
|
|
else |
136 |
|
|
{ |
137 |
|
|
sine = sin_value_table[angle] * y_sign; |
138 |
|
|
} |
139 |
|
|
return sine; |
140 |
|
|
} |
141 |
|
|
#endif |
142 |
|
|
|
143 |
|
|
/**************************************************************************/ |
144 |
|
|
/* */ |
145 |
|
|
/* FUNCTION RELEASE */ |
146 |
|
|
/* */ |
147 |
|
|
/* _gx_utility_math_sin PORTABLE C */ |
148 |
|
|
/* 6.1 */ |
149 |
|
|
/* AUTHOR */ |
150 |
|
|
/* */ |
151 |
|
|
/* Kenneth Maxwell, Microsoft Corporation */ |
152 |
|
|
/* */ |
153 |
|
|
/* DESCRIPTION */ |
154 |
|
|
/* */ |
155 |
|
|
/* This service computes the sine of the supplied angle. */ |
156 |
|
|
/* */ |
157 |
|
|
/* INPUT */ |
158 |
|
|
/* */ |
159 |
|
|
/* angle Angle to compute sine of. */ |
160 |
|
|
/* The input angle is a fixed */ |
161 |
|
|
/* point data type, call */ |
162 |
|
|
/* GX_FIXED_VAL_MAKE to covnert */ |
163 |
|
|
/* from INT to fixed point data. */ |
164 |
|
|
/* type. */ |
165 |
|
|
/* */ |
166 |
|
|
/* OUTPUT */ |
167 |
|
|
/* */ |
168 |
|
|
/* sine Sine of supplied angle. */ |
169 |
|
|
/* The return sin is a fixed */ |
170 |
|
|
/* point math data type, call */ |
171 |
|
|
/* GX_FIXED_VAL_TO_INT to convert*/ |
172 |
|
|
/* from fixed point data type to */ |
173 |
|
|
/* int. */ |
174 |
|
|
/* */ |
175 |
|
|
/* CALLS */ |
176 |
|
|
/* */ |
177 |
|
|
/* None */ |
178 |
|
|
/* */ |
179 |
|
|
/* CALLED BY */ |
180 |
|
|
/* */ |
181 |
|
|
/* Application Code */ |
182 |
|
|
/* */ |
183 |
|
|
/**************************************************************************/ |
184 |
|
263303 |
GX_FIXED_VAL _gx_utility_math_sin(GX_FIXED_VAL angle) |
185 |
|
|
{ |
186 |
|
|
INT y_sign; |
187 |
|
|
INT sine; |
188 |
|
|
|
189 |
|
|
/* normalize the incoming angle */ |
190 |
✓✓ |
263596 |
while (angle < 0) |
191 |
|
|
{ |
192 |
|
293 |
angle += GX_FIXED_VAL_MAKE(360); |
193 |
|
|
} |
194 |
✓✓ |
290319 |
while (angle > GX_FIXED_VAL_MAKE(360)) |
195 |
|
|
{ |
196 |
|
27016 |
angle -= GX_FIXED_VAL_MAKE(360); |
197 |
|
|
} |
198 |
|
|
|
199 |
✓✓ |
263303 |
if (angle <= GX_FIXED_VAL_MAKE(90)) |
200 |
|
|
{ |
201 |
|
83791 |
y_sign = 1; |
202 |
|
|
} |
203 |
✓✓ |
179512 |
else if (angle <= GX_FIXED_VAL_MAKE(180)) |
204 |
|
|
{ |
205 |
|
76595 |
angle = GX_FIXED_VAL_MAKE(180) - angle; |
206 |
|
76595 |
y_sign = 1; |
207 |
|
|
} |
208 |
✓✓ |
102917 |
else if (angle <= GX_FIXED_VAL_MAKE(270)) |
209 |
|
|
{ |
210 |
|
50639 |
angle -= GX_FIXED_VAL_MAKE(180); |
211 |
|
50639 |
y_sign = -1; |
212 |
|
|
} |
213 |
|
|
else |
214 |
|
|
{ |
215 |
|
52278 |
angle = GX_FIXED_VAL_MAKE(360) - angle; |
216 |
|
52278 |
y_sign = -1; |
217 |
|
|
} |
218 |
|
|
|
219 |
|
263303 |
angle = angle + (GX_FIXED_VAL_HALF >> 2); |
220 |
|
263303 |
angle = GX_FIXED_VAL_TO_INT(angle << 2); |
221 |
|
|
|
222 |
✓✓ |
263303 |
if (angle == 360) |
223 |
|
|
{ |
224 |
|
2430 |
sine = GX_FIXED_VAL_MAKE(y_sign); |
225 |
|
|
} |
226 |
|
|
else |
227 |
|
|
{ |
228 |
|
260873 |
sine = GX_FIXED_VAL_MAKE(sin_value_table[angle] * y_sign) >> 8; |
229 |
|
|
} |
230 |
|
263303 |
return sine; |
231 |
|
|
} |
232 |
|
|
|