author | nemo |
Wed, 24 Feb 2010 03:03:43 +0000 | |
changeset 2856 | cc70797a0b75 |
parent 2784 | 1a2e3c7c6a46 |
child 2905 | f3c79f7193a9 |
permissions | -rw-r--r-- |
351 | 1 |
(* |
1066 | 2 |
* Hedgewars, a free turn based strategy game |
883 | 3 |
* Copyright (c) 2007, 2008 Andrey Korotaev <unC0Rr@gmail.com> |
351 | 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 |
||
2630 | 19 |
{$INCLUDE "options.inc"} |
20 |
||
351 | 21 |
unit uFloat; |
22 |
interface |
|
23 |
||
24 |
{$IFDEF FPC} |
|
2599 | 25 |
{$IFDEF ENDIAN_LITTLE} |
351 | 26 |
type hwFloat = record |
27 |
isNegative: boolean; |
|
28 |
case byte of |
|
29 |
0: (Frac, Round: Longword); |
|
30 |
1: (QWordValue : QWord); |
|
31 |
end; |
|
2599 | 32 |
{$ELSE} |
351 | 33 |
type hwFloat = record |
34 |
isNegative: boolean; |
|
35 |
case byte of |
|
36 |
0: (Round, Frac: Longword); |
|
37 |
1: (QWordValue : QWord); |
|
38 |
end; |
|
2599 | 39 |
{$ENDIF} |
351 | 40 |
|
515 | 41 |
function int2hwFloat (const i: LongInt) : hwFloat; |
351 | 42 |
|
515 | 43 |
operator + (const z1, z2: hwFloat) z : hwFloat; |
44 |
operator - (const z1, z2: hwFloat) z : hwFloat; |
|
45 |
operator - (const z1: hwFloat) z : hwFloat; |
|
351 | 46 |
|
515 | 47 |
operator * (const z1, z2: hwFloat) z : hwFloat; |
48 |
operator * (const z1: hwFloat; const z2: LongInt) z : hwFloat; |
|
49 |
operator / (const z1: hwFloat; z2: hwFloat) z : hwFloat; |
|
50 |
operator / (const z1: hwFloat; const z2: LongInt) z : hwFloat; |
|
351 | 51 |
|
515 | 52 |
operator < (const z1, z2: hwFloat) b : boolean; |
53 |
operator > (const z1, z2: hwFloat) b : boolean; |
|
351 | 54 |
|
515 | 55 |
function cstr(const z: hwFloat): string; |
56 |
function hwRound(const t: hwFloat): LongInt; |
|
57 |
function hwAbs(const t: hwFloat): hwFloat; |
|
58 |
function hwSqr(const t: hwFloat): hwFloat; |
|
59 |
function hwSqrt(const t: hwFloat): hwFloat; |
|
60 |
function Distance(const dx, dy: hwFloat): hwFloat; |
|
61 |
function DistanceI(const dx, dy: LongInt): hwFloat; |
|
62 |
function AngleSin(const Angle: Longword): hwFloat; |
|
63 |
function AngleCos(const Angle: Longword): hwFloat; |
|
64 |
function SignAs(const num, signum: hwFloat): hwFloat; |
|
351 | 65 |
|
2599 | 66 |
{$IFDEF FPC} |
538 | 67 |
{$J-} |
2599 | 68 |
{$ENDIF} |
611 | 69 |
{$WARNINGS OFF} |
351 | 70 |
const _1div1024: hwFloat = (isNegative: false; QWordValue: 4194304); |
71 |
_1div10000: hwFloat = (isNegative: false; QWordValue: 429496); |
|
72 |
_1div50000: hwFloat = (isNegative: false; QWordValue: 85899); |
|
73 |
_1div100000: hwFloat = (isNegative: false; QWordValue: 42950); |
|
74 |
_1div3: hwFloat = (isNegative: false; QWordValue: 1431655766); |
|
75 |
hwPi: hwFloat = (isNegative: false; QWordValue: 13493037704); |
|
76 |
_0_000004: hwFloat = (isNegative: false; QWordValue: 17179); |
|
77 |
_0_0002: hwFloat = (isNegative: false; QWordValue: 858993); |
|
1586 | 78 |
_0_0005: hwFloat = (isNegative: false; QWordValue: 2147484); |
351 | 79 |
_0_001: hwFloat = (isNegative: false; QWordValue: 4294967); |
80 |
_0_003: hwFloat = (isNegative: false; QWordValue: 12884902); |
|
81 |
_0_004: hwFloat = (isNegative: false; QWordValue: 17179869); |
|
82 |
_0_005: hwFloat = (isNegative: false; QWordValue: 21474836); |
|
83 |
_0_01: hwFloat = (isNegative: false; QWordValue: 42949673); |
|
84 |
_0_02: hwFloat = (isNegative: false; QWordValue: 85899345); |
|
85 |
_0_03: hwFloat = (isNegative: false; QWordValue: 128849018); |
|
86 |
_0_08: hwFloat = (isNegative: false; QWordValue: 343597383); |
|
365 | 87 |
_0_1: hwFloat = (isNegative: false; QWordValue: 429496730); |
351 | 88 |
_0_15: hwFloat = (isNegative: false; QWordValue: 644245094); |
89 |
_0_2: hwFloat = (isNegative: false; QWordValue: 858993459); |
|
90 |
_0_25: hwFloat = (isNegative: false; QWordValue: 1073741824); |
|
91 |
_0_3: hwFloat = (isNegative: false; QWordValue: 1288490189); |
|
92 |
_0_35: hwFloat = (isNegative: false; QWordValue: 1503238553); |
|
2784 | 93 |
_0_375: hwFloat = (isNegative: false; QWordValue: 4294967296 * 3 div 8); |
835
6f567934cc44
Automatically use parachute when vertical speed is high enough
unc0rr
parents:
745
diff
changeset
|
94 |
_0_39: hwFloat = (isNegative: false; QWordValue: 1675037245); |
351 | 95 |
_0_4: hwFloat = (isNegative: false; QWordValue: 1717986918); |
96 |
_0_45: hwFloat = (isNegative: false; QWordValue: 1932735283); |
|
97 |
_0_5: hwFloat = (isNegative: false; QWordValue: 2147483648); |
|
98 |
_0_55: hwFloat = (isNegative: false; QWordValue: 2362232012); |
|
99 |
_0_6: hwFloat = (isNegative: false; QWordValue: 2576980377); |
|
358 | 100 |
_0_7: hwFloat = (isNegative: false; QWordValue: 3006477107); |
351 | 101 |
_0_8: hwFloat = (isNegative: false; QWordValue: 3435973837); |
102 |
_0_84: hwFloat = (isNegative: false; QWordValue: 3607772528); |
|
103 |
_0_87: hwFloat = (isNegative: false; QWordValue: 3736621547); |
|
104 |
_0_9: hwFloat = (isNegative: false; QWordValue: 3865470566); |
|
105 |
_0_93: hwFloat = (isNegative: false; QWordValue: 3994319585); |
|
106 |
_0_96: hwFloat = (isNegative: false; QWordValue: 4123168604); |
|
107 |
_0_995: hwFloat = (isNegative: false; QWordValue: 4273492459); |
|
1433 | 108 |
_0_998: hwFloat = (isNegative: false; QWordValue: 4294967296); |
351 | 109 |
_0_999: hwFloat = (isNegative: false; QWordValue: 4290672328); |
110 |
_1_9: hwFloat = (isNegative: false; QWordValue: 8160437862); |
|
498 | 111 |
_0: hwFloat = (isNegative: false; QWordValue: 0); |
112 |
_1: hwFloat = (isNegative: false; QWordValue: 4294967296); |
|
513
69e06d710d46
Moving hedgehog could get another hedgehog moving forward
unc0rr
parents:
498
diff
changeset
|
113 |
_1_5: hwFloat = (isNegative: false; QWordValue: 4294967296 * 3 div 2); |
498 | 114 |
_2: hwFloat = (isNegative: false; QWordValue: 4294967296 * 2); |
115 |
_3: hwFloat = (isNegative: false; QWordValue: 4294967296 * 3); |
|
116 |
_4: hwFloat = (isNegative: false; QWordValue: 4294967296 * 4); |
|
117 |
_5: hwFloat = (isNegative: false; QWordValue: 4294967296 * 5); |
|
118 |
_6: hwFloat = (isNegative: false; QWordValue: 4294967296 * 6); |
|
119 |
_10: hwFloat = (isNegative: false; QWordValue: 4294967296 * 10); |
|
120 |
_16: hwFloat = (isNegative: false; QWordValue: 4294967296 * 16); |
|
121 |
_19: hwFloat = (isNegative: false; QWordValue: 4294967296 * 19); |
|
122 |
_20: hwFloat = (isNegative: false; QWordValue: 4294967296 * 20); |
|
1652 | 123 |
_0_3x70: hwFloat = (isNegative: false; QWordValue: 1288490189 * 70); |
498 | 124 |
_25: hwFloat = (isNegative: false; QWordValue: 4294967296 * 25); |
125 |
_30: hwFloat = (isNegative: false; QWordValue: 4294967296 * 30); |
|
126 |
_128: hwFloat = (isNegative: false; QWordValue: 4294967296 * 128); |
|
1915 | 127 |
_256: hwFloat = (isNegative: false; QWordValue: 4294967296 * 256); |
1124 | 128 |
_300: hwFloat = (isNegative: false; QWordValue: 4294967296 * 300); |
498 | 129 |
_450: hwFloat = (isNegative: false; QWordValue: 4294967296 * 450); |
611 | 130 |
_1024: hwFloat = (isNegative: false; QWordValue: 4294967296 * 1024); |
131 |
_2048: hwFloat = (isNegative: false; QWordValue: 4294967296 * 2048); |
|
1753 | 132 |
_4096: hwFloat = (isNegative: false; QWordValue: 4294967296 * 4096); |
498 | 133 |
_10000: hwFloat = (isNegative: false; QWordValue: 4294967296 * 10000); |
351 | 134 |
|
135 |
cLittle: hwFloat = (isNegative: false; QWordValue: 1); |
|
967 | 136 |
cHHKick: hwFloat = (isNegative: false; QWordValue: 42949673); // _0_01 |
611 | 137 |
{$WARNINGS ON} |
351 | 138 |
{$ENDIF} |
139 |
||
140 |
{$IFNDEF FPC} |
|
141 |
type hwFloat = Extended; |
|
142 |
{$ENDIF} |
|
143 |
||
144 |
implementation |
|
744 | 145 |
uses uConsts, uMisc; |
351 | 146 |
|
147 |
{$IFDEF FPC} |
|
148 |
||
515 | 149 |
function int2hwFloat (const i: LongInt) : hwFloat; |
351 | 150 |
begin |
498 | 151 |
int2hwFloat.isNegative:= i < 0; |
152 |
int2hwFloat.Round:= abs(i); |
|
153 |
int2hwFloat.Frac:= 0 |
|
351 | 154 |
end; |
155 |
||
515 | 156 |
operator + (const z1, z2: hwFloat) z : hwFloat; |
351 | 157 |
begin |
158 |
if z1.isNegative = z2.isNegative then |
|
159 |
begin |
|
160 |
z.isNegative:= z1.isNegative; |
|
161 |
z.QWordValue:= z1.QWordValue + z2.QWordValue |
|
162 |
end |
|
163 |
else |
|
164 |
if z1.QWordValue > z2.QWordValue then |
|
165 |
begin |
|
166 |
z.isNegative:= z1.isNegative; |
|
167 |
z.QWordValue:= z1.QWordValue - z2.QWordValue |
|
168 |
end else |
|
169 |
begin |
|
170 |
z.isNegative:= z2.isNegative; |
|
171 |
z.QWordValue:= z2.QWordValue - z1.QWordValue |
|
172 |
end |
|
173 |
end; |
|
174 |
||
515 | 175 |
operator - (const z1, z2: hwFloat) z : hwFloat; |
351 | 176 |
begin |
177 |
if z1.isNegative = z2.isNegative then |
|
178 |
if z1.QWordValue > z2.QWordValue then |
|
179 |
begin |
|
180 |
z.isNegative:= z1.isNegative; |
|
181 |
z.QWordValue:= z1.QWordValue - z2.QWordValue |
|
182 |
end else |
|
183 |
begin |
|
184 |
z.isNegative:= not z2.isNegative; |
|
185 |
z.QWordValue:= z2.QWordValue - z1.QWordValue |
|
186 |
end |
|
187 |
else begin |
|
188 |
z.isNegative:= z1.isNegative; |
|
189 |
z.QWordValue:= z1.QWordValue + z2.QWordValue |
|
190 |
end |
|
191 |
end; |
|
192 |
||
515 | 193 |
operator - (const z1: hwFloat) z : hwFloat; |
351 | 194 |
begin |
195 |
z:= z1; |
|
196 |
z.isNegative:= not z.isNegative |
|
197 |
end; |
|
198 |
||
199 |
||
515 | 200 |
operator * (const z1, z2: hwFloat) z : hwFloat; |
351 | 201 |
begin |
202 |
z.isNegative:= z1.isNegative xor z2.isNegative; |
|
203 |
z.QWordValue:= QWord(z1.Round) * z2.Frac + |
|
204 |
QWord(z1.Frac) * z2.Round + |
|
205 |
((QWord(z1.Frac) * z2.Frac) shr 32); |
|
206 |
z.Round:= z.Round + QWord(z1.Round) * z2.Round; |
|
207 |
end; |
|
208 |
||
515 | 209 |
operator * (const z1: hwFloat; const z2: LongInt) z : hwFloat; |
351 | 210 |
begin |
211 |
z.isNegative:= z1.isNegative xor (z2 < 0); |
|
515 | 212 |
z.QWordValue:= z1.QWordValue * abs(z2) |
351 | 213 |
end; |
214 |
||
515 | 215 |
operator / (const z1: hwFloat; z2: hwFloat) z : hwFloat; |
351 | 216 |
var t: hwFloat; |
217 |
begin |
|
218 |
z.isNegative:= z1.isNegative xor z2.isNegative; |
|
219 |
z.Round:= z1.QWordValue div z2.QWordValue; |
|
220 |
t:= z1 - z2 * z.Round; |
|
221 |
if t.QWordValue = 0 then |
|
222 |
z.Frac:= 0 |
|
223 |
else |
|
224 |
begin |
|
225 |
while ((t.QWordValue and $8000000000000000) = 0) and |
|
226 |
((z2.QWordValue and $8000000000000000) = 0) do |
|
227 |
begin |
|
228 |
t.QWordValue:= t.QWordValue shl 1; |
|
229 |
z2.QWordValue:= z2.QWordValue shl 1 |
|
230 |
end; |
|
543
465e2ec8f05f
- Better randomness of placing hedgehogs on the land
unc0rr
parents:
538
diff
changeset
|
231 |
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
|
232 |
else z.Frac:= 0 |
351 | 233 |
end |
234 |
end; |
|
235 |
||
515 | 236 |
operator / (const z1: hwFloat; const z2: LongInt) z : hwFloat; |
498 | 237 |
begin |
238 |
z.isNegative:= z1.isNegative xor (z2 < 0); |
|
515 | 239 |
z.QWordValue:= z1.QWordValue div abs(z2) |
498 | 240 |
end; |
241 |
||
515 | 242 |
operator < (const z1, z2: hwFloat) b : boolean; |
351 | 243 |
begin |
916 | 244 |
if z1.isNegative xor z2.isNegative then |
351 | 245 |
b:= z1.isNegative |
246 |
else |
|
247 |
if z1.QWordValue = z2.QWordValue then |
|
248 |
b:= false |
|
249 |
else |
|
250 |
b:= (z1.QWordValue < z2.QWordValue) xor z1.isNegative |
|
251 |
end; |
|
252 |
||
515 | 253 |
operator > (const z1, z2: hwFloat) b : boolean; |
351 | 254 |
begin |
916 | 255 |
if z1.isNegative xor z2.isNegative then |
351 | 256 |
b:= z2.isNegative |
257 |
else |
|
258 |
if z1.QWordValue = z2.QWordValue then |
|
259 |
b:= false |
|
260 |
else |
|
261 |
b:= (z1.QWordValue > z2.QWordValue) xor z2.isNegative |
|
262 |
end; |
|
263 |
||
515 | 264 |
function cstr(const z: hwFloat): string; |
351 | 265 |
var tmpstr: string; |
266 |
begin |
|
267 |
str(z.Round, cstr); |
|
268 |
if z.Frac <> 0 then |
|
269 |
begin |
|
270 |
str(z.Frac / $100000000:1:15, tmpstr); |
|
271 |
delete(tmpstr, 1, 2); |
|
272 |
cstr:= cstr + '.' + tmpstr |
|
273 |
end; |
|
274 |
if z.isNegative then cstr:= '-' + cstr |
|
275 |
end; |
|
276 |
||
515 | 277 |
function hwRound(const t: hwFloat): LongInt; |
351 | 278 |
begin |
2300 | 279 |
if t.isNegative then hwRound:= -(t.Round and $7FFFFFFF) |
280 |
else hwRound:= t.Round and $7FFFFFFF |
|
351 | 281 |
end; |
282 |
||
515 | 283 |
function hwAbs(const t: hwFloat): hwFloat; |
351 | 284 |
begin |
285 |
hwAbs:= t; |
|
286 |
hwAbs.isNegative:= false |
|
287 |
end; |
|
288 |
||
515 | 289 |
function hwSqr(const t: hwFloat): hwFloat; |
351 | 290 |
begin |
1433 | 291 |
hwSqr.isNegative:= false; |
292 |
hwSqr.QWordValue:= |
|
293 |
((QWord(t.Round) * t.Round) shl 32) |
|
294 |
+ QWord(t.Round) * t.Frac * 2 |
|
295 |
+ ((QWord(t.Frac) * t.Frac) shr 32); |
|
351 | 296 |
end; |
297 |
||
515 | 298 |
function hwSqrt(const t: hwFloat): hwFloat; |
738 | 299 |
var l, r: QWord; |
300 |
c: hwFloat; |
|
357 | 301 |
begin |
302 |
hwSqrt.isNegative:= false; |
|
744 | 303 |
|
304 |
if t.Round = 0 then |
|
305 |
begin |
|
306 |
l:= t.QWordValue; |
|
307 |
r:= $100000000 |
|
308 |
end else |
|
309 |
begin |
|
310 |
l:= $100000000; |
|
953
237fc147950c
Fix bug in hwSqrt when calculating square root of number >= 65536
unc0rr
parents:
916
diff
changeset
|
311 |
r:= t.QWordValue div 2 + $80000000; // r:= t / 2 + 0.5 |
237fc147950c
Fix bug in hwSqrt when calculating square root of number >= 65536
unc0rr
parents:
916
diff
changeset
|
312 |
if r > $FFFFFFFFFFFF then r:= $FFFFFFFFFFFF |
744 | 313 |
end; |
314 |
||
738 | 315 |
repeat |
316 |
c.QWordValue:= (l + r) div 2; |
|
317 |
if hwSqr(c).QWordValue > t.QWordValue then r:= c.QWordValue else l:= c.QWordValue |
|
318 |
until r - l <= 1; |
|
744 | 319 |
|
738 | 320 |
hwSqrt.QWordValue:= l |
357 | 321 |
end; |
322 |
||
515 | 323 |
function Distance(const dx, dy: hwFloat): hwFloat; |
351 | 324 |
begin |
738 | 325 |
Distance:= hwSqrt(hwSqr(dx) + hwSqr(dy)) |
351 | 326 |
end; |
327 |
||
515 | 328 |
function DistanceI(const dx, dy: LongInt): hwFloat; |
498 | 329 |
begin |
856 | 330 |
DistanceI:= hwSqrt(int2hwFloat(sqr(dx) + sqr(dy))) |
498 | 331 |
end; |
332 |
||
515 | 333 |
function SignAs(const num, signum: hwFloat): hwFloat; |
498 | 334 |
begin |
856 | 335 |
SignAs.QWordValue:= num.QWordValue; |
498 | 336 |
SignAs.isNegative:= signum.isNegative |
337 |
end; |
|
338 |
||
2599 | 339 |
{$INCLUDE "SinTable.inc"} |
357 | 340 |
|
515 | 341 |
function AngleSin(const Angle: Longword): hwFloat; |
351 | 342 |
begin |
1629 | 343 |
{$IFDEF DEBUGFILE} |
1640 | 344 |
TryDo((Angle >= 0) and (Angle <= 2048), 'Sin param exceeds limits', true); |
1629 | 345 |
{$ENDIF} |
351 | 346 |
AngleSin.isNegative:= false; |
357 | 347 |
if Angle < 1024 then AngleSin.QWordValue:= SinTable[Angle] |
348 |
else AngleSin.QWordValue:= SinTable[2048 - Angle] |
|
351 | 349 |
end; |
350 |
||
515 | 351 |
function AngleCos(const Angle: Longword): hwFloat; |
351 | 352 |
begin |
1629 | 353 |
{$IFDEF DEBUGFILE} |
1640 | 354 |
TryDo((Angle >= 0) and (Angle <= 2048), 'Cos param exceeds limits', true); |
1629 | 355 |
{$ENDIF} |
357 | 356 |
AngleCos.isNegative:= Angle > 1024; |
357 |
if Angle < 1024 then AngleCos.QWordValue:= SinTable[1024 - Angle] |
|
358 |
else AngleCos.QWordValue:= SinTable[Angle - 1024] |
|
351 | 359 |
end; |
360 |
||
361 |
{$ENDIF} |
|
362 |
||
363 |
end. |