author | unc0rr |
Mon, 04 Jun 2007 21:29:05 +0000 | |
changeset 537 | 4d2e60623e44 |
parent 515 | 270f10276d2e |
child 538 | 74219eadab5e |
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 |
|
64 |
const _1div1024: hwFloat = (isNegative: false; QWordValue: 4194304); |
|
65 |
_1div10000: hwFloat = (isNegative: false; QWordValue: 429496); |
|
66 |
_1div50000: hwFloat = (isNegative: false; QWordValue: 85899); |
|
67 |
_1div100000: hwFloat = (isNegative: false; QWordValue: 42950); |
|
68 |
_1div3: hwFloat = (isNegative: false; QWordValue: 1431655766); |
|
69 |
hwPi: hwFloat = (isNegative: false; QWordValue: 13493037704); |
|
70 |
_0_000004: hwFloat = (isNegative: false; QWordValue: 17179); |
|
71 |
_0_0002: hwFloat = (isNegative: false; QWordValue: 858993); |
|
72 |
_0_001: hwFloat = (isNegative: false; QWordValue: 4294967); |
|
73 |
_0_003: hwFloat = (isNegative: false; QWordValue: 12884902); |
|
74 |
_0_004: hwFloat = (isNegative: false; QWordValue: 17179869); |
|
75 |
_0_005: hwFloat = (isNegative: false; QWordValue: 21474836); |
|
76 |
_0_01: hwFloat = (isNegative: false; QWordValue: 42949673); |
|
77 |
_0_02: hwFloat = (isNegative: false; QWordValue: 85899345); |
|
78 |
_0_03: hwFloat = (isNegative: false; QWordValue: 128849018); |
|
79 |
_0_08: hwFloat = (isNegative: false; QWordValue: 343597383); |
|
365 | 80 |
_0_1: hwFloat = (isNegative: false; QWordValue: 429496730); |
351 | 81 |
_0_15: hwFloat = (isNegative: false; QWordValue: 644245094); |
82 |
_0_2: hwFloat = (isNegative: false; QWordValue: 858993459); |
|
83 |
_0_25: hwFloat = (isNegative: false; QWordValue: 1073741824); |
|
84 |
_0_3: hwFloat = (isNegative: false; QWordValue: 1288490189); |
|
85 |
_0_35: hwFloat = (isNegative: false; QWordValue: 1503238553); |
|
86 |
_0_4: hwFloat = (isNegative: false; QWordValue: 1717986918); |
|
87 |
_0_45: hwFloat = (isNegative: false; QWordValue: 1932735283); |
|
88 |
_0_5: hwFloat = (isNegative: false; QWordValue: 2147483648); |
|
89 |
_0_55: hwFloat = (isNegative: false; QWordValue: 2362232012); |
|
90 |
_0_6: hwFloat = (isNegative: false; QWordValue: 2576980377); |
|
358 | 91 |
_0_7: hwFloat = (isNegative: false; QWordValue: 3006477107); |
351 | 92 |
_0_8: hwFloat = (isNegative: false; QWordValue: 3435973837); |
93 |
_0_84: hwFloat = (isNegative: false; QWordValue: 3607772528); |
|
94 |
_0_87: hwFloat = (isNegative: false; QWordValue: 3736621547); |
|
95 |
_0_9: hwFloat = (isNegative: false; QWordValue: 3865470566); |
|
96 |
_0_93: hwFloat = (isNegative: false; QWordValue: 3994319585); |
|
97 |
_0_96: hwFloat = (isNegative: false; QWordValue: 4123168604); |
|
98 |
_0_995: hwFloat = (isNegative: false; QWordValue: 4273492459); |
|
99 |
_0_999: hwFloat = (isNegative: false; QWordValue: 4290672328); |
|
100 |
_1_9: hwFloat = (isNegative: false; QWordValue: 8160437862); |
|
498 | 101 |
_0: hwFloat = (isNegative: false; QWordValue: 0); |
102 |
_1: hwFloat = (isNegative: false; QWordValue: 4294967296); |
|
513
69e06d710d46
Moving hedgehog could get another hedgehog moving forward
unc0rr
parents:
498
diff
changeset
|
103 |
_1_5: hwFloat = (isNegative: false; QWordValue: 4294967296 * 3 div 2); |
498 | 104 |
_2: hwFloat = (isNegative: false; QWordValue: 4294967296 * 2); |
105 |
_3: hwFloat = (isNegative: false; QWordValue: 4294967296 * 3); |
|
106 |
_4: hwFloat = (isNegative: false; QWordValue: 4294967296 * 4); |
|
107 |
_5: hwFloat = (isNegative: false; QWordValue: 4294967296 * 5); |
|
108 |
_6: hwFloat = (isNegative: false; QWordValue: 4294967296 * 6); |
|
109 |
_10: hwFloat = (isNegative: false; QWordValue: 4294967296 * 10); |
|
110 |
_16: hwFloat = (isNegative: false; QWordValue: 4294967296 * 16); |
|
111 |
_19: hwFloat = (isNegative: false; QWordValue: 4294967296 * 19); |
|
112 |
_20: hwFloat = (isNegative: false; QWordValue: 4294967296 * 20); |
|
113 |
_25: hwFloat = (isNegative: false; QWordValue: 4294967296 * 25); |
|
114 |
_30: hwFloat = (isNegative: false; QWordValue: 4294967296 * 30); |
|
115 |
_128: hwFloat = (isNegative: false; QWordValue: 4294967296 * 128); |
|
116 |
_450: hwFloat = (isNegative: false; QWordValue: 4294967296 * 450); |
|
117 |
_1024: hwFloat = (isNegative: false; QWordValue: 4398046511104); |
|
118 |
_2048: hwFloat = (isNegative: false; QWordValue: 8796093022208); |
|
119 |
_10000: hwFloat = (isNegative: false; QWordValue: 4294967296 * 10000); |
|
351 | 120 |
|
121 |
cLittle: hwFloat = (isNegative: false; QWordValue: 1); |
|
122 |
cHHKick: hwFloat = (isNegative: false; QWordValue: 128849018); |
|
123 |
{$ENDIF} |
|
124 |
||
125 |
{$IFNDEF FPC} |
|
126 |
type hwFloat = Extended; |
|
127 |
{$ENDIF} |
|
128 |
||
129 |
implementation |
|
130 |
uses uConsts; |
|
131 |
||
132 |
{$IFDEF FPC} |
|
133 |
||
515 | 134 |
function int2hwFloat (const i: LongInt) : hwFloat; |
351 | 135 |
begin |
498 | 136 |
int2hwFloat.isNegative:= i < 0; |
137 |
int2hwFloat.Round:= abs(i); |
|
138 |
int2hwFloat.Frac:= 0 |
|
351 | 139 |
end; |
140 |
||
515 | 141 |
operator + (const z1, z2: hwFloat) z : hwFloat; |
351 | 142 |
begin |
143 |
if z1.isNegative = z2.isNegative then |
|
144 |
begin |
|
145 |
z.isNegative:= z1.isNegative; |
|
146 |
z.QWordValue:= z1.QWordValue + z2.QWordValue |
|
147 |
end |
|
148 |
else |
|
149 |
if z1.QWordValue > z2.QWordValue then |
|
150 |
begin |
|
151 |
z.isNegative:= z1.isNegative; |
|
152 |
z.QWordValue:= z1.QWordValue - z2.QWordValue |
|
153 |
end else |
|
154 |
begin |
|
155 |
z.isNegative:= z2.isNegative; |
|
156 |
z.QWordValue:= z2.QWordValue - z1.QWordValue |
|
157 |
end |
|
158 |
end; |
|
159 |
||
515 | 160 |
operator - (const z1, z2: hwFloat) z : hwFloat; |
351 | 161 |
begin |
162 |
if z1.isNegative = z2.isNegative then |
|
163 |
if z1.QWordValue > z2.QWordValue then |
|
164 |
begin |
|
165 |
z.isNegative:= z1.isNegative; |
|
166 |
z.QWordValue:= z1.QWordValue - z2.QWordValue |
|
167 |
end else |
|
168 |
begin |
|
169 |
z.isNegative:= not z2.isNegative; |
|
170 |
z.QWordValue:= z2.QWordValue - z1.QWordValue |
|
171 |
end |
|
172 |
else begin |
|
173 |
z.isNegative:= z1.isNegative; |
|
174 |
z.QWordValue:= z1.QWordValue + z2.QWordValue |
|
175 |
end |
|
176 |
end; |
|
177 |
||
515 | 178 |
operator - (const z1: hwFloat) z : hwFloat; |
351 | 179 |
begin |
180 |
z:= z1; |
|
181 |
z.isNegative:= not z.isNegative |
|
182 |
end; |
|
183 |
||
184 |
||
515 | 185 |
operator * (const z1, z2: hwFloat) z : hwFloat; |
351 | 186 |
begin |
187 |
z.isNegative:= z1.isNegative xor z2.isNegative; |
|
188 |
z.QWordValue:= QWord(z1.Round) * z2.Frac + |
|
189 |
QWord(z1.Frac) * z2.Round + |
|
190 |
((QWord(z1.Frac) * z2.Frac) shr 32); |
|
191 |
z.Round:= z.Round + QWord(z1.Round) * z2.Round; |
|
192 |
end; |
|
193 |
||
515 | 194 |
operator * (const z1: hwFloat; const z2: LongInt) z : hwFloat; |
351 | 195 |
begin |
196 |
z.isNegative:= z1.isNegative xor (z2 < 0); |
|
515 | 197 |
z.QWordValue:= z1.QWordValue * abs(z2) |
351 | 198 |
end; |
199 |
||
515 | 200 |
operator / (const z1: hwFloat; z2: hwFloat) z : hwFloat; |
351 | 201 |
var t: hwFloat; |
202 |
begin |
|
203 |
z.isNegative:= z1.isNegative xor z2.isNegative; |
|
204 |
z.Round:= z1.QWordValue div z2.QWordValue; |
|
205 |
t:= z1 - z2 * z.Round; |
|
206 |
if t.QWordValue = 0 then |
|
207 |
z.Frac:= 0 |
|
208 |
else |
|
209 |
begin |
|
210 |
while ((t.QWordValue and $8000000000000000) = 0) and |
|
211 |
((z2.QWordValue and $8000000000000000) = 0) do |
|
212 |
begin |
|
213 |
t.QWordValue:= t.QWordValue shl 1; |
|
214 |
z2.QWordValue:= z2.QWordValue shl 1 |
|
215 |
end; |
|
216 |
z.Frac:= (t.QWordValue) div (z2.Round) |
|
217 |
end |
|
218 |
end; |
|
219 |
||
515 | 220 |
operator / (const z1: hwFloat; const z2: LongInt) z : hwFloat; |
498 | 221 |
begin |
222 |
z.isNegative:= z1.isNegative xor (z2 < 0); |
|
515 | 223 |
z.QWordValue:= z1.QWordValue div abs(z2) |
498 | 224 |
end; |
225 |
||
515 | 226 |
operator < (const z1, z2: hwFloat) b : boolean; |
351 | 227 |
begin |
228 |
if z1.isNegative <> z2.isNegative then |
|
229 |
b:= z1.isNegative |
|
230 |
else |
|
231 |
if z1.QWordValue = z2.QWordValue then |
|
232 |
b:= false |
|
233 |
else |
|
234 |
b:= (z1.QWordValue < z2.QWordValue) xor z1.isNegative |
|
235 |
end; |
|
236 |
||
515 | 237 |
operator > (const z1, z2: hwFloat) b : boolean; |
351 | 238 |
begin |
239 |
if z1.isNegative <> z2.isNegative then |
|
240 |
b:= z2.isNegative |
|
241 |
else |
|
242 |
if z1.QWordValue = z2.QWordValue then |
|
243 |
b:= false |
|
244 |
else |
|
245 |
b:= (z1.QWordValue > z2.QWordValue) xor z2.isNegative |
|
246 |
end; |
|
247 |
||
515 | 248 |
function cstr(const z: hwFloat): string; |
351 | 249 |
var tmpstr: string; |
250 |
begin |
|
251 |
str(z.Round, cstr); |
|
252 |
if z.Frac <> 0 then |
|
253 |
begin |
|
254 |
str(z.Frac / $100000000:1:15, tmpstr); |
|
255 |
delete(tmpstr, 1, 2); |
|
256 |
cstr:= cstr + '.' + tmpstr |
|
257 |
end; |
|
258 |
if z.isNegative then cstr:= '-' + cstr |
|
259 |
end; |
|
260 |
||
515 | 261 |
function hwRound(const t: hwFloat): LongInt; |
351 | 262 |
begin |
263 |
if t.isNegative then hwRound:= -t.Round |
|
264 |
else hwRound:= t.Round |
|
265 |
end; |
|
266 |
||
515 | 267 |
function hwAbs(const t: hwFloat): hwFloat; |
351 | 268 |
begin |
269 |
hwAbs:= t; |
|
270 |
hwAbs.isNegative:= false |
|
271 |
end; |
|
272 |
||
515 | 273 |
function hwSqr(const t: hwFloat): hwFloat; |
351 | 274 |
begin |
275 |
hwSqr:= t * t |
|
276 |
end; |
|
277 |
||
515 | 278 |
function hwSqrt(const t: hwFloat): hwFloat; |
357 | 279 |
begin |
280 |
hwSqrt.isNegative:= false; |
|
281 |
hwSqrt.QWordValue:= Round(sqrt(1.0 / $100000000 * (t.QWordValue)) * $100000000) |
|
282 |
end; |
|
283 |
||
515 | 284 |
function Distance(const dx, dy: hwFloat): hwFloat; |
351 | 285 |
var x, y: hwFloat; |
286 |
Result: hwFloat; |
|
287 |
begin |
|
288 |
x:= dx * dx; |
|
289 |
y:= dy * dy; |
|
290 |
Result:= x + y; |
|
357 | 291 |
Result.QWordValue:= Round(sqrt(1.0 / $100000000 * (Result.QWordValue)) * $100000000); |
351 | 292 |
Distance:= Result |
293 |
end; |
|
294 |
||
515 | 295 |
function DistanceI(const dx, dy: LongInt): hwFloat; |
498 | 296 |
begin |
297 |
DistanceI:= Distance(int2hwFloat(dx), int2hwFloat(dy)) |
|
298 |
end; |
|
299 |
||
515 | 300 |
function SignAs(const num, signum: hwFloat): hwFloat; |
498 | 301 |
begin |
302 |
SignAs:= num; |
|
303 |
SignAs.isNegative:= signum.isNegative |
|
304 |
end; |
|
305 |
||
357 | 306 |
{$INCLUDE SinTable.inc} |
307 |
||
515 | 308 |
function AngleSin(const Angle: Longword): hwFloat; |
351 | 309 |
begin |
310 |
AngleSin.isNegative:= false; |
|
357 | 311 |
if Angle < 1024 then AngleSin.QWordValue:= SinTable[Angle] |
312 |
else AngleSin.QWordValue:= SinTable[2048 - Angle] |
|
351 | 313 |
end; |
314 |
||
515 | 315 |
function AngleCos(const Angle: Longword): hwFloat; |
351 | 316 |
begin |
357 | 317 |
AngleCos.isNegative:= Angle > 1024; |
318 |
if Angle < 1024 then AngleCos.QWordValue:= SinTable[1024 - Angle] |
|
319 |
else AngleCos.QWordValue:= SinTable[Angle - 1024] |
|
351 | 320 |
end; |
321 |
||
322 |
{$ENDIF} |
|
323 |
||
324 |
end. |