author | unc0rr |
Fri, 26 Oct 2007 18:55:27 +0000 | |
changeset 623 | ca1c1bd15915 |
parent 611 | 8cf6d27cec86 |
child 738 | d7f640e99b17 |
permissions | -rw-r--r-- |
351 | 1 |
(* |
2 |
* Hedgewars, a Worms style game |
|
3 |
* Copyright (c) 2007 Andrey Korotaev <unC0Rr@gmail.com> |
|
4 |
* |
|
5 |
* This program is free software; you can redistribute it and/or modify |
|
6 |
* it under the terms of the GNU General Public License as published by |
|
7 |
* the Free Software Foundation; version 2 of the License |
|
8 |
* |
|
9 |
* This program is distributed in the hope that it will be useful, |
|
10 |
* but WITHOUT ANY WARRANTY; without even the implied warranty of |
|
11 |
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the |
|
12 |
* GNU General Public License for more details. |
|
13 |
* |
|
14 |
* You should have received a copy of the GNU General Public License |
|
15 |
* along with this program; if not, write to the Free Software |
|
16 |
* Foundation, Inc., 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA |
|
17 |
*) |
|
18 |
||
19 |
unit uFloat; |
|
20 |
interface |
|
21 |
||
22 |
{$IFDEF FPC} |
|
23 |
{$ifdef FPC_LITTLE_ENDIAN} |
|
24 |
type hwFloat = record |
|
25 |
isNegative: boolean; |
|
26 |
case byte of |
|
27 |
0: (Frac, Round: Longword); |
|
28 |
1: (QWordValue : QWord); |
|
29 |
end; |
|
30 |
{$else FPC_LITTLE_ENDIAN} |
|
31 |
type hwFloat = record |
|
32 |
isNegative: boolean; |
|
33 |
case byte of |
|
34 |
0: (Round, Frac: Longword); |
|
35 |
1: (QWordValue : QWord); |
|
36 |
end; |
|
37 |
{$endif FPC_LITTLE_ENDIAN} |
|
38 |
||
515 | 39 |
function int2hwFloat (const i: LongInt) : hwFloat; |
351 | 40 |
|
515 | 41 |
operator + (const z1, z2: hwFloat) z : hwFloat; |
42 |
operator - (const z1, z2: hwFloat) z : hwFloat; |
|
43 |
operator - (const z1: hwFloat) z : hwFloat; |
|
351 | 44 |
|
515 | 45 |
operator * (const z1, z2: hwFloat) z : hwFloat; |
46 |
operator * (const z1: hwFloat; const z2: LongInt) z : hwFloat; |
|
47 |
operator / (const z1: hwFloat; z2: hwFloat) z : hwFloat; |
|
48 |
operator / (const z1: hwFloat; const z2: LongInt) z : hwFloat; |
|
351 | 49 |
|
515 | 50 |
operator < (const z1, z2: hwFloat) b : boolean; |
51 |
operator > (const z1, z2: hwFloat) b : boolean; |
|
351 | 52 |
|
515 | 53 |
function cstr(const z: hwFloat): string; |
54 |
function hwRound(const t: hwFloat): LongInt; |
|
55 |
function hwAbs(const t: hwFloat): hwFloat; |
|
56 |
function hwSqr(const t: hwFloat): hwFloat; |
|
57 |
function hwSqrt(const t: hwFloat): hwFloat; |
|
58 |
function Distance(const dx, dy: hwFloat): hwFloat; |
|
59 |
function DistanceI(const dx, dy: LongInt): hwFloat; |
|
60 |
function AngleSin(const Angle: Longword): hwFloat; |
|
61 |
function AngleCos(const Angle: Longword): hwFloat; |
|
62 |
function SignAs(const num, signum: hwFloat): hwFloat; |
|
351 | 63 |
|
538 | 64 |
{$J-} |
611 | 65 |
{$WARNINGS OFF} |
351 | 66 |
const _1div1024: hwFloat = (isNegative: false; QWordValue: 4194304); |
67 |
_1div10000: hwFloat = (isNegative: false; QWordValue: 429496); |
|
68 |
_1div50000: hwFloat = (isNegative: false; QWordValue: 85899); |
|
69 |
_1div100000: hwFloat = (isNegative: false; QWordValue: 42950); |
|
70 |
_1div3: hwFloat = (isNegative: false; QWordValue: 1431655766); |
|
71 |
hwPi: hwFloat = (isNegative: false; QWordValue: 13493037704); |
|
72 |
_0_000004: hwFloat = (isNegative: false; QWordValue: 17179); |
|
73 |
_0_0002: hwFloat = (isNegative: false; QWordValue: 858993); |
|
74 |
_0_001: hwFloat = (isNegative: false; QWordValue: 4294967); |
|
75 |
_0_003: hwFloat = (isNegative: false; QWordValue: 12884902); |
|
76 |
_0_004: hwFloat = (isNegative: false; QWordValue: 17179869); |
|
77 |
_0_005: hwFloat = (isNegative: false; QWordValue: 21474836); |
|
78 |
_0_01: hwFloat = (isNegative: false; QWordValue: 42949673); |
|
79 |
_0_02: hwFloat = (isNegative: false; QWordValue: 85899345); |
|
80 |
_0_03: hwFloat = (isNegative: false; QWordValue: 128849018); |
|
81 |
_0_08: hwFloat = (isNegative: false; QWordValue: 343597383); |
|
365 | 82 |
_0_1: hwFloat = (isNegative: false; QWordValue: 429496730); |
351 | 83 |
_0_15: hwFloat = (isNegative: false; QWordValue: 644245094); |
84 |
_0_2: hwFloat = (isNegative: false; QWordValue: 858993459); |
|
85 |
_0_25: hwFloat = (isNegative: false; QWordValue: 1073741824); |
|
86 |
_0_3: hwFloat = (isNegative: false; QWordValue: 1288490189); |
|
87 |
_0_35: hwFloat = (isNegative: false; QWordValue: 1503238553); |
|
88 |
_0_4: hwFloat = (isNegative: false; QWordValue: 1717986918); |
|
89 |
_0_45: hwFloat = (isNegative: false; QWordValue: 1932735283); |
|
90 |
_0_5: hwFloat = (isNegative: false; QWordValue: 2147483648); |
|
91 |
_0_55: hwFloat = (isNegative: false; QWordValue: 2362232012); |
|
92 |
_0_6: hwFloat = (isNegative: false; QWordValue: 2576980377); |
|
358 | 93 |
_0_7: hwFloat = (isNegative: false; QWordValue: 3006477107); |
351 | 94 |
_0_8: hwFloat = (isNegative: false; QWordValue: 3435973837); |
95 |
_0_84: hwFloat = (isNegative: false; QWordValue: 3607772528); |
|
96 |
_0_87: hwFloat = (isNegative: false; QWordValue: 3736621547); |
|
97 |
_0_9: hwFloat = (isNegative: false; QWordValue: 3865470566); |
|
98 |
_0_93: hwFloat = (isNegative: false; QWordValue: 3994319585); |
|
99 |
_0_96: hwFloat = (isNegative: false; QWordValue: 4123168604); |
|
100 |
_0_995: hwFloat = (isNegative: false; QWordValue: 4273492459); |
|
101 |
_0_999: hwFloat = (isNegative: false; QWordValue: 4290672328); |
|
102 |
_1_9: hwFloat = (isNegative: false; QWordValue: 8160437862); |
|
498 | 103 |
_0: hwFloat = (isNegative: false; QWordValue: 0); |
104 |
_1: hwFloat = (isNegative: false; QWordValue: 4294967296); |
|
513
69e06d710d46
Moving hedgehog could get another hedgehog moving forward
unc0rr
parents:
498
diff
changeset
|
105 |
_1_5: hwFloat = (isNegative: false; QWordValue: 4294967296 * 3 div 2); |
498 | 106 |
_2: hwFloat = (isNegative: false; QWordValue: 4294967296 * 2); |
107 |
_3: hwFloat = (isNegative: false; QWordValue: 4294967296 * 3); |
|
108 |
_4: hwFloat = (isNegative: false; QWordValue: 4294967296 * 4); |
|
109 |
_5: hwFloat = (isNegative: false; QWordValue: 4294967296 * 5); |
|
110 |
_6: hwFloat = (isNegative: false; QWordValue: 4294967296 * 6); |
|
111 |
_10: hwFloat = (isNegative: false; QWordValue: 4294967296 * 10); |
|
112 |
_16: hwFloat = (isNegative: false; QWordValue: 4294967296 * 16); |
|
113 |
_19: hwFloat = (isNegative: false; QWordValue: 4294967296 * 19); |
|
114 |
_20: hwFloat = (isNegative: false; QWordValue: 4294967296 * 20); |
|
115 |
_25: hwFloat = (isNegative: false; QWordValue: 4294967296 * 25); |
|
116 |
_30: hwFloat = (isNegative: false; QWordValue: 4294967296 * 30); |
|
117 |
_128: hwFloat = (isNegative: false; QWordValue: 4294967296 * 128); |
|
118 |
_450: hwFloat = (isNegative: false; QWordValue: 4294967296 * 450); |
|
611 | 119 |
_1024: hwFloat = (isNegative: false; QWordValue: 4294967296 * 1024); |
120 |
_2048: hwFloat = (isNegative: false; QWordValue: 4294967296 * 2048); |
|
498 | 121 |
_10000: hwFloat = (isNegative: false; QWordValue: 4294967296 * 10000); |
351 | 122 |
|
123 |
cLittle: hwFloat = (isNegative: false; QWordValue: 1); |
|
538 | 124 |
cHHKick: hwFloat = (isNegative: false; QWordValue: 128849018); // _0_03 |
611 | 125 |
{$WARNINGS ON} |
351 | 126 |
{$ENDIF} |
127 |
||
128 |
{$IFNDEF FPC} |
|
129 |
type hwFloat = Extended; |
|
130 |
{$ENDIF} |
|
131 |
||
132 |
implementation |
|
133 |
uses uConsts; |
|
134 |
||
135 |
{$IFDEF FPC} |
|
136 |
||
515 | 137 |
function int2hwFloat (const i: LongInt) : hwFloat; |
351 | 138 |
begin |
498 | 139 |
int2hwFloat.isNegative:= i < 0; |
140 |
int2hwFloat.Round:= abs(i); |
|
141 |
int2hwFloat.Frac:= 0 |
|
351 | 142 |
end; |
143 |
||
515 | 144 |
operator + (const z1, z2: hwFloat) z : hwFloat; |
351 | 145 |
begin |
146 |
if z1.isNegative = z2.isNegative then |
|
147 |
begin |
|
148 |
z.isNegative:= z1.isNegative; |
|
149 |
z.QWordValue:= z1.QWordValue + z2.QWordValue |
|
150 |
end |
|
151 |
else |
|
152 |
if z1.QWordValue > z2.QWordValue then |
|
153 |
begin |
|
154 |
z.isNegative:= z1.isNegative; |
|
155 |
z.QWordValue:= z1.QWordValue - z2.QWordValue |
|
156 |
end else |
|
157 |
begin |
|
158 |
z.isNegative:= z2.isNegative; |
|
159 |
z.QWordValue:= z2.QWordValue - z1.QWordValue |
|
160 |
end |
|
161 |
end; |
|
162 |
||
515 | 163 |
operator - (const z1, z2: hwFloat) z : hwFloat; |
351 | 164 |
begin |
165 |
if z1.isNegative = z2.isNegative then |
|
166 |
if z1.QWordValue > z2.QWordValue then |
|
167 |
begin |
|
168 |
z.isNegative:= z1.isNegative; |
|
169 |
z.QWordValue:= z1.QWordValue - z2.QWordValue |
|
170 |
end else |
|
171 |
begin |
|
172 |
z.isNegative:= not z2.isNegative; |
|
173 |
z.QWordValue:= z2.QWordValue - z1.QWordValue |
|
174 |
end |
|
175 |
else begin |
|
176 |
z.isNegative:= z1.isNegative; |
|
177 |
z.QWordValue:= z1.QWordValue + z2.QWordValue |
|
178 |
end |
|
179 |
end; |
|
180 |
||
515 | 181 |
operator - (const z1: hwFloat) z : hwFloat; |
351 | 182 |
begin |
183 |
z:= z1; |
|
184 |
z.isNegative:= not z.isNegative |
|
185 |
end; |
|
186 |
||
187 |
||
515 | 188 |
operator * (const z1, z2: hwFloat) z : hwFloat; |
351 | 189 |
begin |
190 |
z.isNegative:= z1.isNegative xor z2.isNegative; |
|
191 |
z.QWordValue:= QWord(z1.Round) * z2.Frac + |
|
192 |
QWord(z1.Frac) * z2.Round + |
|
193 |
((QWord(z1.Frac) * z2.Frac) shr 32); |
|
194 |
z.Round:= z.Round + QWord(z1.Round) * z2.Round; |
|
195 |
end; |
|
196 |
||
515 | 197 |
operator * (const z1: hwFloat; const z2: LongInt) z : hwFloat; |
351 | 198 |
begin |
199 |
z.isNegative:= z1.isNegative xor (z2 < 0); |
|
515 | 200 |
z.QWordValue:= z1.QWordValue * abs(z2) |
351 | 201 |
end; |
202 |
||
515 | 203 |
operator / (const z1: hwFloat; z2: hwFloat) z : hwFloat; |
351 | 204 |
var t: hwFloat; |
205 |
begin |
|
206 |
z.isNegative:= z1.isNegative xor z2.isNegative; |
|
207 |
z.Round:= z1.QWordValue div z2.QWordValue; |
|
208 |
t:= z1 - z2 * z.Round; |
|
209 |
if t.QWordValue = 0 then |
|
210 |
z.Frac:= 0 |
|
211 |
else |
|
212 |
begin |
|
213 |
while ((t.QWordValue and $8000000000000000) = 0) and |
|
214 |
((z2.QWordValue and $8000000000000000) = 0) do |
|
215 |
begin |
|
216 |
t.QWordValue:= t.QWordValue shl 1; |
|
217 |
z2.QWordValue:= z2.QWordValue shl 1 |
|
218 |
end; |
|
543
465e2ec8f05f
- Better randomness of placing hedgehogs on the land
unc0rr
parents:
538
diff
changeset
|
219 |
if z2.Round > 0 then z.Frac:= (t.QWordValue) div (z2.Round) |
465e2ec8f05f
- Better randomness of placing hedgehogs on the land
unc0rr
parents:
538
diff
changeset
|
220 |
else z.Frac:= 0 |
351 | 221 |
end |
222 |
end; |
|
223 |
||
515 | 224 |
operator / (const z1: hwFloat; const z2: LongInt) z : hwFloat; |
498 | 225 |
begin |
226 |
z.isNegative:= z1.isNegative xor (z2 < 0); |
|
515 | 227 |
z.QWordValue:= z1.QWordValue div abs(z2) |
498 | 228 |
end; |
229 |
||
515 | 230 |
operator < (const z1, z2: hwFloat) b : boolean; |
351 | 231 |
begin |
232 |
if z1.isNegative <> z2.isNegative then |
|
233 |
b:= z1.isNegative |
|
234 |
else |
|
235 |
if z1.QWordValue = z2.QWordValue then |
|
236 |
b:= false |
|
237 |
else |
|
238 |
b:= (z1.QWordValue < z2.QWordValue) xor z1.isNegative |
|
239 |
end; |
|
240 |
||
515 | 241 |
operator > (const z1, z2: hwFloat) b : boolean; |
351 | 242 |
begin |
243 |
if z1.isNegative <> z2.isNegative then |
|
244 |
b:= z2.isNegative |
|
245 |
else |
|
246 |
if z1.QWordValue = z2.QWordValue then |
|
247 |
b:= false |
|
248 |
else |
|
249 |
b:= (z1.QWordValue > z2.QWordValue) xor z2.isNegative |
|
250 |
end; |
|
251 |
||
515 | 252 |
function cstr(const z: hwFloat): string; |
351 | 253 |
var tmpstr: string; |
254 |
begin |
|
255 |
str(z.Round, cstr); |
|
256 |
if z.Frac <> 0 then |
|
257 |
begin |
|
258 |
str(z.Frac / $100000000:1:15, tmpstr); |
|
259 |
delete(tmpstr, 1, 2); |
|
260 |
cstr:= cstr + '.' + tmpstr |
|
261 |
end; |
|
262 |
if z.isNegative then cstr:= '-' + cstr |
|
263 |
end; |
|
264 |
||
515 | 265 |
function hwRound(const t: hwFloat): LongInt; |
351 | 266 |
begin |
267 |
if t.isNegative then hwRound:= -t.Round |
|
268 |
else hwRound:= t.Round |
|
269 |
end; |
|
270 |
||
515 | 271 |
function hwAbs(const t: hwFloat): hwFloat; |
351 | 272 |
begin |
273 |
hwAbs:= t; |
|
274 |
hwAbs.isNegative:= false |
|
275 |
end; |
|
276 |
||
515 | 277 |
function hwSqr(const t: hwFloat): hwFloat; |
351 | 278 |
begin |
279 |
hwSqr:= t * t |
|
280 |
end; |
|
281 |
||
515 | 282 |
function hwSqrt(const t: hwFloat): hwFloat; |
357 | 283 |
begin |
284 |
hwSqrt.isNegative:= false; |
|
285 |
hwSqrt.QWordValue:= Round(sqrt(1.0 / $100000000 * (t.QWordValue)) * $100000000) |
|
286 |
end; |
|
287 |
||
515 | 288 |
function Distance(const dx, dy: hwFloat): hwFloat; |
351 | 289 |
var x, y: hwFloat; |
290 |
Result: hwFloat; |
|
291 |
begin |
|
292 |
x:= dx * dx; |
|
293 |
y:= dy * dy; |
|
294 |
Result:= x + y; |
|
357 | 295 |
Result.QWordValue:= Round(sqrt(1.0 / $100000000 * (Result.QWordValue)) * $100000000); |
351 | 296 |
Distance:= Result |
297 |
end; |
|
298 |
||
515 | 299 |
function DistanceI(const dx, dy: LongInt): hwFloat; |
498 | 300 |
begin |
301 |
DistanceI:= Distance(int2hwFloat(dx), int2hwFloat(dy)) |
|
302 |
end; |
|
303 |
||
515 | 304 |
function SignAs(const num, signum: hwFloat): hwFloat; |
498 | 305 |
begin |
306 |
SignAs:= num; |
|
307 |
SignAs.isNegative:= signum.isNegative |
|
308 |
end; |
|
309 |
||
357 | 310 |
{$INCLUDE SinTable.inc} |
311 |
||
515 | 312 |
function AngleSin(const Angle: Longword): hwFloat; |
351 | 313 |
begin |
314 |
AngleSin.isNegative:= false; |
|
357 | 315 |
if Angle < 1024 then AngleSin.QWordValue:= SinTable[Angle] |
316 |
else AngleSin.QWordValue:= SinTable[2048 - Angle] |
|
351 | 317 |
end; |
318 |
||
515 | 319 |
function AngleCos(const Angle: Longword): hwFloat; |
351 | 320 |
begin |
357 | 321 |
AngleCos.isNegative:= Angle > 1024; |
322 |
if Angle < 1024 then AngleCos.QWordValue:= SinTable[1024 - Angle] |
|
323 |
else AngleCos.QWordValue:= SinTable[Angle - 1024] |
|
351 | 324 |
end; |
325 |
||
326 |
{$ENDIF} |
|
327 |
||
328 |
end. |