summaryrefslogtreecommitdiff
path: root/libphysics/body.c
blob: 51a352dad8460e8a338cc8b2f48c89e645054efc (plain)
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
#include <vecmath.h>
#include <physics.h>
#include <stdlib.h>

#include "dat.h"

#define POOL_SIZE 2048

Body phxbodypool[POOL_SIZE];
int  phxbodypoolsize;

static BodyID allocbody(void);

BodyID
phxnew(BodyType type)
{
	BodyID b;

	if((b = allocbody()) == -1)
		return b;

	phxbodypool[b].type = type;
	return b;
}

void
phxdel(BodyID id)
{
	phxbodypool[id].active = 0;
}

void
phxsetpos(BodyID b, float x, float y)
{
	vec2_dup(phxbodypool[b].pos, (vec2){ x, y });
}

void
phxsetsize(BodyID b, float w, float h)
{
	vec2_dup(phxbodypool[b].size, (vec2){ w, h });
}

void
phxgetpos(BodyID b, float p[2])
{
	vec2_dup(p, phxbodypool[b].pos);
}

void
phxgetsize(BodyID b, float p[2])
{
	vec2_dup(p, phxbodypool[b].size);
}

void
phxapplyaccel(BodyID b, float a[2])
{
	vec2_add(phxbodypool[b].accel, phxbodypool[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;
	return i;
}