forgot to add a few files
[supertux.git] / src / collision.cpp
1 //  $Id$
2 // 
3 //  SuperTux
4 //  Copyright (C) 2005 Matthias Braun <matze@braunis.de>
5 //
6 //  This program is free software; you can redistribute it and/or
7 //  modify it under the terms of the GNU General Public License
8 //  as published by the Free Software Foundation; either version 2
9 //  of the License, or (at your option) any later version.
10 //
11 //  This program is distributed in the hope that it will be useful,
12 //  but WITHOUT ANY WARRANTY; without even the implied warranty of
13 //  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
14 //  GNU General Public License for more details.
15 // 
16 //  You should have received a copy of the GNU General Public License
17 //  along with this program; if not, write to the Free Software
18 //  Foundation, Inc., 59 Temple Place - Suite 330, Boston, MA
19 //  02111-1307, USA.
20 #include <config.h>
21
22 #include "collision.h"
23
24 #include <algorithm>
25 #include <iostream>
26 #include <stdio.h>
27 #include <float.h>
28 #include <math.h>
29 #include "math/vector.h"
30 #include "math/aatriangle.h"
31 #include "math/rectangle.h"
32 #include "collision_hit.h"
33
34 static const float DELTA = .0001;
35
36 bool
37 Collision::rectangle_rectangle(CollisionHit& hit, const Rectangle& r1,
38     const Vector& movement, const Rectangle& r2)
39 {
40   if(r1.p2.x < r2.p1.x || r1.p1.x > r2.p2.x)
41     return false;
42   if(r1.p2.y < r2.p1.y || r1.p1.y > r2.p2.y)
43     return false;
44
45   if(movement.x > DELTA) {
46     hit.depth = r1.p2.x - r2.p1.x;
47     hit.time = hit.depth / movement.x;
48     hit.normal.x = -1;
49     hit.normal.y = 0;
50   } else if(movement.x < -DELTA) {
51     hit.depth = r2.p2.x - r1.p1.x;
52     hit.time = hit.depth / -movement.x;
53     hit.normal.x = 1;
54     hit.normal.y = 0;
55   } else {
56     if(movement.y > -DELTA && movement.y < DELTA) {
57       hit.time = 0;
58       hit.depth = 0;
59       hit.normal.x = 1;
60       hit.normal.y = 0;
61       return true;
62     }
63     hit.time = FLT_MAX;
64   }
65
66   if(movement.y > DELTA) {
67     float ydepth = r1.p2.y - r2.p1.y;
68     float yt = ydepth / movement.y;
69     if(yt < hit.time) {
70       hit.depth = ydepth;
71       hit.time = yt;
72       hit.normal.x = 0;
73       hit.normal.y = -1;
74     }
75   } else if(movement.y < -DELTA) {
76     float ydepth = r2.p2.y - r1.p1.y;
77     float yt = ydepth / -movement.y;
78     if(yt < hit.time) {
79       hit.depth = ydepth;
80       hit.time = yt;
81       hit.normal.x = 0;
82       hit.normal.y = 1;
83     }
84   }
85
86   return true;
87 }
88
89 //---------------------------------------------------------------------------
90
91 static void makePlane(const Vector& p1, const Vector& p2, Vector& n, float& c)
92 {
93   n = Vector(p2.y-p1.y, p1.x-p2.x);
94   c = -(p2 * n);
95   float nval = n.norm();             
96   n /= nval;
97   c /= nval;
98 }
99
100 bool
101 Collision::rectangle_aatriangle(CollisionHit& hit, const Rectangle& rect,
102     const Vector& movement, const AATriangle& triangle)
103 {
104   if(!rectangle_rectangle(hit, rect, movement, (const Rectangle&) triangle))
105     return false;
106
107   Vector normal;
108   float c;
109   Vector p1;
110   Vector tp1, tp2;
111   switch(triangle.dir & AATriangle::DEFORM_MASK) {
112     case 0:
113       tp1 = triangle.p1;
114       tp2 = triangle.p2;
115       break;
116     case AATriangle::DEFORM1:
117       tp1 = Vector(triangle.p1.x, triangle.p1.y + triangle.get_height()/2);
118       tp2 = triangle.p2;
119       break;
120     case AATriangle::DEFORM2:
121       tp1 = triangle.p1;
122       tp2 = Vector(triangle.p2.x, triangle.p1.y + triangle.get_height()/2);
123       break;
124     case AATriangle::DEFORM3:
125       tp1 = triangle.p1;
126       tp2 = Vector(triangle.p1.x + triangle.get_width()/2, triangle.p2.y);
127       break;
128     case AATriangle::DEFORM4:
129       tp1 = Vector(triangle.p1.x + triangle.get_width()/2, triangle.p1.y);
130       tp2 = triangle.p2;
131       break;
132     default:
133       assert(false);
134   } 
135   
136   switch(triangle.dir & AATriangle::DIRECTION_MASK) {
137     case AATriangle::SOUTHWEST:
138       p1 = Vector(rect.p1.x, rect.p2.y);
139       makePlane(tp1, tp2, normal, c);
140       break;
141     case AATriangle::NORTHEAST:
142       p1 = Vector(rect.p2.x, rect.p1.y);
143       makePlane(tp2, tp1, normal, c);
144       break;
145     case AATriangle::SOUTHEAST:
146       p1 = rect.p2;
147       makePlane(Vector(tp1.x, tp2.y),
148           Vector(tp2.x, tp1.y), normal, c);
149       break;
150     case AATriangle::NORTHWEST:
151       p1 = rect.p1;
152       makePlane(Vector(tp2.x, tp1.y),
153           Vector(tp1.x, tp2.y), normal, c);
154       break;
155     default:
156       assert(false);
157   }
158
159   float n_p1 = -(normal * p1);
160   float depth = n_p1 - c;
161   if(depth < 0)
162     return false;
163   float time = depth / -(normal * movement);
164   if(time < hit.time) {
165     hit.depth = depth;
166     hit.time = time;
167     hit.normal = normal;
168   }
169
170   return true;
171 }
172