phys/simulator.cpp at master · andreybotanic/phys · GitHub

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
#include "simulator.h"

void simulator::init (renderer * r, ui * u)
{
	rend = r;
	UI = u;
	grav.x = 0.0;
	grav.y = 1.0;
}

void simulator::process()
{
	for (it = bodies.begin(); it < bodies.end(); it++)
	{
		(*it)->coll = false;
		(*it)->col_edge = 0;
	}
	for (it = bodies.begin(); it < bodies.end(); it++)
	{
		(*it)->addimpulse((*it)->centre_g, grav, (*it)->mass*9.8);
		(*it)->ishighlited = false;
		for (it2 = bodies.begin(); it2 < bodies.end(); it2++)
			if (it != it2)
				(*it)->check_coll(*it2);
		(*it)->process();
	}
	UI->body_at_cursor = BodyAtPos((UI->mouse_pos.x), (UI->mouse_pos.y));
}

pbody* simulator::BodyAtPos(float x, float y)
{
	for (bap = bodies.rbegin(); bap < bodies.rend(); bap++)
	{
		if (x < ((*bap)->bbox.left) ||  x > ((*bap)->bbox.right) ||   y < ((*bap)->bbox.top)  || y > ((*bap)->bbox.bottom))
			continue;
		if (PtInRegion((*bap)->pol, int(x*100.0),int(y*100.0)))
		{
			(*bap)->ishighlited = true;
			return (*bap);
		}
	}
	return NULL;
}

vector<POINT> simulator::penetration(vector<pbody*>::iterator b1, vector<pbody*>::iterator b2)
{
	vector <POINT> result;
	return result;

}