X-Git-Url: http://dolda2000.com/gitweb/?a=blobdiff_plain;f=src%2Fcore%2Flevel%2Fmod.rs;h=47a4703e8904f65315d8fe76c6b971237ab13289;hb=d67471eea7777938ffe9fb82ac2e060133b655d9;hp=bdc6cb0e292bad415ad694d05fcc8eaf3c61391b;hpb=b1075e661c2ce2f107350b8d4f5f9a92e047b93e;p=kaka%2Frust-sdl-test.git

diff --git a/src/core/level/mod.rs b/src/core/level/mod.rs
index bdc6cb0..47a4703 100644
--- a/src/core/level/mod.rs
+++ b/src/core/level/mod.rs
@@ -106,7 +106,7 @@ impl Level {
 	    for e in &wall.edges {
 		if !debug_mode {
 		    let c = (e.p1 + e.p2) / 2.0;
-		    let a = (e.p2 - e.p1).to_angle() - std::f64::consts::FRAC_PI_2.radians();
+		    let a = e.normal().reverse();
 
 		    renderer.draw_line(
 			<(i32, i32)>::from(c.to_i32()),
@@ -204,8 +204,7 @@ pub struct WallRegion {
 }
 
 impl WallRegion {
-    pub fn new(points: Vec<Point<f64>>) -> Self {
-	let index: RegionIndex = 0; // use as param
+    pub fn new(index: RegionIndex, points: Vec<Point<f64>>) -> Self {
 	let mut edges = Vec::with_capacity(points.len());
 
 	for i in 0..points.len() {
@@ -223,12 +222,12 @@ impl WallRegion {
 
     fn next(&self, index: EdgeIndex) -> Rc<WallEdge> {
     	let index = (index + 1) % self.edges.len();
-    	Rc::clone(&self.edges[index])
+    	self.edges[index].clone()
     }
 
     fn previous(&self, index: EdgeIndex) -> Rc<WallEdge> {
-    	let index = (index + self.edges.len() + 1) % self.edges.len();
-    	Rc::clone(&self.edges[index])
+    	let index = (index + self.edges.len() - 1) % self.edges.len();
+    	self.edges[index].clone()
     }
 }
 
@@ -250,6 +249,15 @@ impl WallEdge {
 	let cross = (self.p2 - self.p1).cross_product(p - self.p1);
 	cross > 0.0
     }
+
+    fn normal(&self) -> Angle {
+	self.angle() + std::f64::consts::FRAC_PI_2.radians()
+    }
+
+    /// Angle from the right to the left point if the normal is up.
+    fn angle(&self) -> Angle {
+	(self.p2 - self.p1).to_angle()
+    }
 }
 
 ////////// WALL ////////////////////////////////////////////////////////////////
@@ -261,22 +269,48 @@ pub struct Wall {
 
 impl Wall {
     #[allow(dead_code)]
-    pub fn next(self) -> Wall {
+    pub fn next(&self) -> Wall {
 	Wall {
 	    edge: self.region.next(self.edge.id),
-	    region: self.region,
+	    region: self.region.clone(),
 	}
     }
 
     #[allow(dead_code)]
-    pub fn previous(self) -> Wall {
+    pub fn previous(&self) -> Wall {
 	Wall {
 	    edge: self.region.previous(self.edge.id),
-	    region: self.region,
+	    region: self.region.clone(),
 	}
     }
 
     pub fn normal(&self) -> Angle {
-	(self.edge.p2 - self.edge.p1).to_angle() + std::f64::consts::FRAC_PI_2.radians()
+	self.edge.normal()
+    }
+
+    pub fn angle(&self) -> Angle {
+	self.edge.angle()
+    }
+
+    pub fn from_2d(&self, pos: &Point<f64>, vel: &Point<f64>) -> (f64, f64) {
+	let pos = self.projection_of(*pos - self.edge.p1);
+	let vel = self.projection_of(*vel);
+	(pos, vel)
+    }
+
+    pub fn to_2d(&self, pos: f64, vel: f64) -> (Point<f64>, Point<f64>) {
+	let a = Point::from(self.edge.angle());
+	let pos = self.edge.p1 + a * pos;
+	let vel = a * vel;
+	(pos, vel)
+    }
+
+    /// Returns the 1D position of a point projected onto this wall.
+    /// This is done by rotating the point using a rotation matrix and then taking the resulting x value.
+    /// x'=xcos−ysin	<- only this is used
+    /// y'=xsin+ycos
+    fn projection_of(&self, p: Point<f64>) -> f64 {
+	let r = Point::from(self.edge.angle());
+	p.x * r.x + p.y * r.y // r.y is inverted here instead of inverting the angle
     }
 }