1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
|
#include <vecmath.h>
#include <physics.h>
#include <stdlib.h>
#include <assert.h>
#include "dat.h"
#define POOL_SIZE (1024 * 1024)
Body phxbodypool[POOL_SIZE];
int phxbodypoolsize;
static BodyID allocbody(void);
BodyID
phxnew(BodyType type)
{
BodyID b;
if((b = allocbody()) == -1)
return b;
__getbodydata(b)->type = type;
return b;
}
void
phxdel(BodyID id)
{
__getbodydata(id)->active = 0;
}
void
phxsetpos(BodyID b, float x, float y)
{
vec2_dup(__getbodydata(b)->pos, (vec2){ x, y });
}
void
phxsetsize(BodyID b, float w, float h)
{
vec2_dup(__getbodydata(b)->size, (vec2){ w, h });
}
void
phxgetpos(BodyID b, float p[2])
{
vec2_dup(p, __getbodydata(b)->pos);
}
void
phxgetsize(BodyID b, float p[2])
{
vec2_dup(p, __getbodydata(b)->size);
}
void
phxapplyaccel(BodyID b, float a[2])
{
vec2_add(__getbodydata(b)->accel, __getbodydata(b)->accel, a);
}
BodyID
allocbody(void)
{
int i;
for(i = 0; i < phxbodypoolsize; i++) {
if(!phxbodypool[i].active)
break;
}
if(i >= phxbodypoolsize) {
if(phxbodypoolsize == POOL_SIZE)
return -1;
i = phxbodypoolsize++;
}
phxbodypool[i].active = 1;
phxbodypool[i].generation++;
return __getbodyid(phxbodypool + i);
}
Body *
__getbodydata(BodyID id)
{
unsigned int i = id >> 16;
unsigned int g = id & 0xFFFF;
assert(i < POOL_SIZE);
assert((phxbodypool[i].generation & 0xFFFF) == g);
return phxbodypool + i;
}
BodyID
__getbodyid(Body *b)
{
unsigned int i = b - phxbodypool;
return (i << 16) | (phxbodypool[i].generation & 0xFFFF);
}
|
