1

     2

#include "PhysicsWorld.hh"

     3

#include "Engine.hh"

     4

     5

#include <algorithm>

     6

#include <functional>

     7

#include <cmath>

     8

     9

PhysicsWorld::PhysicsWorld (Vector gravity, Vector dimensions, Terrain &terrain) :

    10

    terrain(terrain),

    11

    dimensions(dimensions), 

    12

    gravity(gravity),

    13

    tick_timer(PHYSICS_TICK_MS)

    14

{

    15

    // wire up our timer

    16

    slots.connect(tick_timer.sig_tick(), this, &PhysicsWorld::tick);

    17

    tick_timer.start();

    18

}

    19

    20

void PhysicsWorld::addPhysicsObject (PhysicsObject *po) {

    21

    objects.push_back(po);

    22

}

    23

    24

void PhysicsWorld::removePhysicsObject (PhysicsObject *po) {

    25

    objects.remove(po);

    26

}

    27

    28

    29

float distancePointToLine(Vector l1, Vector l2, Vector p) {

    30

    Vector v(l2.y - l1.y, -(l2.x - l1.x));

    31

    Vector r(l1.x-p.x, l1.y-p.y);

    32

    v = v/v.length();

    33

    float dist = v*r/v.sqrLength();

    34

    return dist;

    35

}

    36

    37

void PhysicsWorld::tick (TimeMS tick_length) {

    38

    // tick each object in turn

    39

    for (std::list<PhysicsObject*>::iterator i = objects.begin(); i != objects.end(); i++) {

    40

        (*i)->tick(tick_length); 

    41

    }

    42

    // Object - object collision detection

    43

    for (std::list<PhysicsObject*>::iterator i = objects.begin(); i != objects.end(); i++) {

    44

        for (std::list<PhysicsObject*>::iterator j = i; j != objects.end(); j++) {

    45

            if(i == j)

    46

                continue;

    47

            float range_sum_sqr = 2;

    48

            if((*i)->getType() == PLAYER) {

    49

                range_sum_sqr += PLAYER_RADIUS-1;

    50

            }

    51

            if((*j)->getType() == PLAYER) {

    52

                range_sum_sqr += PLAYER_RADIUS-1;

    53

            }

    54

            range_sum_sqr *= range_sum_sqr;

    55

            bool collision = false;

    56

            Vector a2 = (*i)->getPosition();

    57

            Vector b2 = (*j)->getPosition();

    58

            float dab = (a2-b2).sqrLength();

    59

            if(dab < range_sum_sqr) {

    60

                collision = true;

    61

            }

    62

            if(collision) {

    63

                (*i)->onCollision(a2, *j);

    64

                (*j)->onCollision(b2, *i);

    65

            }

    66

        }

    67

    }

    68

    69

    // Delete destroyed objects

    70

    objects.remove_if(std::mem_fun(&PhysicsObject::removeIfDestroyed));

    71

}

    72

    73

TickCount PhysicsWorld::getTicks (void) {

    74

    return tick_timer.get_ticks();

    75

}

    76