added ball to ball collisions
[physics.git] / src / Entities / PhysicsEntity.cpp
1 /*
2  *  Copyright (C) 2008 Patrik Gornicz, Gornicz_P (at) hotmail (dot) com.
3  *
4  *  This program is free software: you can redistribute it and/or modify
5  *  it under the terms of the GNU General Public License as published by
6  *  the Free Software Foundation, either version 3 of the License, or
7  *  (at your option) any later version.
8  *
9  *  This program is distributed in the hope that it will be useful,
10  *  but WITHOUT ANY WARRANTY; without even the implied warranty of
11  *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
12  *  GNU General Public License for more details.
13  *
14  *  You should have received a copy of the GNU General Public License
15  *  along with this program.  If not, see <http://www.gnu.org/licenses/>.
16  */
17
18 #include "PhysicsEntity.h"
19 #include "../debug.h"
20
21 #include "../effectManager.h"
22 #include "../Vector2.h"
23
24
25 /// ***** Constructors/Destructors *****
26
27 PhysicsEntity::PhysicsEntity(const Vector2& pos)
28     : Entity(pos), force(0,0), mass(1), CoR(1)
29 {
30
31 }
32 PhysicsEntity::~PhysicsEntity()
33 {
34
35 }
36
37 /// ***** Public Class Methods *****
38
39 void PhysicsEntity::update(float time_step)
40 {
41     position = positionAt(time_step);
42     velocity = velocityAt(time_step);
43
44     force *= 0;
45 }
46
47 Vector2 PhysicsEntity::positionAt(float time_step) const
48 {
49     Vector2 newPosition = position;
50     Vector2 newVelocity = velocity;
51     Vector2 newForce = force;
52
53     newPosition += effect::positionDelta(this, time_step);
54     newVelocity += effect::velocityDelta(this, time_step);
55     newForce += effect::forceDelta(this, time_step);
56
57     return newForce/mass / 2 * time_step * time_step + newVelocity * time_step + newPosition;
58 }
59
60 Vector2 PhysicsEntity::velocityAt(float time_step) const
61 {
62     Vector2 newForce = force;
63     Vector2 newVelocity = velocity;
64
65     newForce += effect::forceDelta(this, time_step);
66     newVelocity += effect::velocityDelta(this, time_step);
67
68     return newForce/mass / 2 * time_step + newVelocity;
69 }
70
71 void PhysicsEntity::applyForce(const Vector2& force)
72 {
73     applyForce(force, position);
74 }
75 void PhysicsEntity::applyForce(const Vector2& force, const Vector2& at)
76 {
77     this->force += force;
78 }
79
80 void PhysicsEntity::applyImpulse(const Vector2& impulse)
81 {
82     applyImpulse(impulse, position);
83 }
84 void PhysicsEntity::applyImpulse(const Vector2& impulse, const Vector2& at)
85 {
86     velocity += impulse;
87 }