1

     2

#include "PhysicsWorld.hh"

     3

#include "Engine.hh"

     4

     5

#include <functional>

     6

     9

    dimensions(dimensions), 

    10

    gravity(gravity),

    11

    tick_timer(PHYSICS_TICK_MS)

    12

{

    14

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

    15

    tick_timer.start();

    16

}

    17

    18

void PhysicsWorld::addPhysicsObject (PhysicsObject *po) {

    19

    objects.push_back(po);

    20

}

    21

    22

void PhysicsWorld::removePhysicsObject (PhysicsObject *po) {

    23

    objects.remove(po);

    24

}

    25

    26

    27

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

    28

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

    29

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

    30

    v = v/v.length();

    31

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

    32

    return dist;

    33

}

    34

    35

void PhysicsWorld::tick (TimeMS tick_length) {

    36

    // tick each object in turn

    37

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

    38

        (*i)->tick(tick_length); 

    39

    }

    40

    // Object - object collision detection

    41

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

    42

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

    43

            if(i == j)

    44

                continue;

    45

            float range_sum_sqr = 2;

    46

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

    47

                range_sum_sqr += PLAYER_RADIUS-1;

    48

            }

    49

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

    50

                range_sum_sqr += PLAYER_RADIUS-1;

    51

            }

    52

            range_sum_sqr *= range_sum_sqr;

    53

            bool collision = false;

    54

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

    55

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

    56

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

    57

            if(dab < range_sum_sqr) {

    58

                collision = true;

    59

            }

    60

            if(collision) {

    61

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

    62

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

    63

            }

    64

        }

    65

    }

    66

    67

    // Delete destroyed objects

    68

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

    69

}

    70

    71

TickCount PhysicsWorld::getTicks (void) {

    72

    return tick_timer.get_ticks();

    73

}

    74