]> git.localhorst.tv Git - gworm.git/blob - src/world/World.cpp
206105ba3d9c3cdf1ffdc5bd943fb3058e9cee99
[gworm.git] / src / world / World.cpp
1 #include "World.h"
2
3 #include "../graphics/const.h"
4
5
6 namespace gworm {
7
8 World::World(Vector<int> size)
9 : size(size)
10 , count(size.x * size.y)
11 , masses(count, 1000000000.0f)
12 , colors(count, Color(0x7F, 0x7F, 0x7F)) {
13
14 }
15
16
17 void World::Update(float dt) {
18         for (Entity &e : entities) {
19                 e.acc = ForceAt(e.pos, e.mass) / e.mass;
20                 e.Update(dt);
21         }
22 }
23
24
25 Entity &World::AddEntity(const Entity &e) {
26         entities.emplace_back(e);
27         return entities.back();
28 }
29
30
31 Vector<float> World::ForceAt(Vector<float> p1, float m1) const {
32         Vector<float> force(0, 0);
33
34         for (int i = 0; i < count; ++i) {
35                 const Vector<float> p2(i % size.y, i / size.y);
36                 if (p1 == p2) continue;
37
38                 const Vector<float> diff(p2 - p1);
39                 const Vector<float> dir(Norm(diff));
40
41                 const float m2 = masses[i];
42                 const float r2 = Dot(diff, diff);
43
44                 const float mag = G * ((m1 * m2) / r2) * 2; // double because m2 is our reference frame
45
46                 force += dir * mag;
47         }
48
49         return force;
50 }
51
52 }