Changeset 8714 in orxonox.OLD for branches/bsp_model/src/lib/collision_reaction

Timestamp:

Jun 22, 2006, 1:40:09 PM (19 years ago)

Author:

bottac

Message:

Ground walk

File:

• branches/bsp_model/src/lib/collision_reaction/cr_physics_ground_walk.cc (modified) (6 diffs)

branches/bsp_model/src/lib/collision_reaction/cr_physics_ground_walk.cc

@@ -1 +1 @@
 /*
    orxonox - the future of 3D-vertical-scrollers
-
+ 
    Copyright (C) 2004 orx
-
+ 
    This program is free software; you can redistribute it and/or modify
    it under the terms of the GNU General Public License as published by
    the Free Software Foundation; either version 2, or (at your option)
    any later version.
-
+ 
    ### File Specific:
    main-programmer: Patrick Boenzli
@@ -24 +24 @@
 #include "cr_physics_ground_walk.h"
 
-#include "aabb.h"
-
-#include "debug.h"
-
 #include <vector>
 
@@ -37 +33 @@
  */
 CRPhysicsGroundWalk::CRPhysicsGroundWalk ()
-  : CollisionReaction()
+    : CollisionReaction()
 {
   this->setClassID(CL_CR_PHYSICS_GROUND_WALK, "CRPhysicsGroundWalk");
@@ -47 +43 @@
  */
 CRPhysicsGroundWalk::~CRPhysicsGroundWalk ()
-{
-}
+{}
 
 
@@ -59 +54 @@
   CollisionEvent* ce = collision->getCollisionEvents().front();
   Vector normal = ce->getGroundNormal();
+  // normal.normalize();
 
-  AABB* box = ce->getEntityB()->getModelAABB();
+  // put it back
+  //   PRINTF(0)("putting it back to lastPos: \n");
+  //   this->lastPositions[0].debug();
+  //   PRINTF(0)("current pos:\n");
+  //   collision->getEntityB()->getAbsCoor().debug();
 
-  Vector center = ce->getEntityB()->getAbsCoor() /*+ box->center*/;
-  Vector collisionPos = ce->getCollisionPosition() - center;
 
-  float objSize = box->halfLength[1];
+  Vector height = ce->getCollisionPosition() - collision->getEntityB()->getAbsCoor();
 
-  if( normal.len() <= 0.1f)
-  {
+  if(ce->getCollisionPosition().x <= 0.9 && ce->getGroundNormal().len() <= 1.4f) {
     collision->getEntityB()->setAbsCoor(collision->getEntityB()->getLastAbsCoor());
     return;
   }
-
-  if( collisionPos.y <= -(objSize + 0.1f))
-  {
+  if(ce->getGroundNormal().len() <= 0.1f) {
+    collision->getEntityB()->setAbsCoor(collision->getEntityB()->getLastAbsCoor());
+    return;
+  }
+  if(ce->getGroundNormal().len() >= 1.4f) {
     downspeed++;
-    collision->getEntityB()->setAbsCoor(collision->getEntityB()->getAbsCoor() + Vector(0.0, -0.03 * downspeed, 0.0));
-  }
-  else
-  {
-    if( collisionPos.y > -objSize  &&
-        collisionPos.y < (objSize + 0.4))
-    {
-      //if(downspeed <= 0) downspeed =1;
-      collision->getEntityB()->setAbsCoor(collision->getEntityB()->getAbsCoor() +
-                                          Vector(0.0, collisionPos.y + objSize + 0.1, 0.0));
-    }
-      downspeed = 0;
+    collision->getEntityB()->setAbsCoor(collision->getEntityB()->getAbsCoor() + Vector(0.0,-0.08*downspeed,0.0));
+    return;
   }
 
 
+  if(height.y < -3.510001 + 10.0) // Above ground
+  {
+    if(height.y > -15.6) // Snap in
+    {
+      downspeed = 0;
+      collision->getEntityB()->setAbsCoor(collision->getEntityB()->getAbsCoor() + Vector(0.0,height.y+3.500005 + 10.0,0.0));
+    } else
+    {
+      downspeed++;
+      collision->getEntityB()->setAbsCoor(collision->getEntityB()->getAbsCoor() + Vector(0.0,-0.08*downspeed,0.0));
+    }
+
+  }
+  else {
+    if(height.y > -3.50000 + 10.0  && height.y <    9.9+ 10.0) // below ground
+    {
+      //if(downspeed <= 0) downspeed =1;
+      collision->getEntityB()->setAbsCoor(collision->getEntityB()->getAbsCoor() + Vector(0.0, 0.00001 /*height.y+3.500005 + 10.0*/,0.0));
+      //collision->getEntityB()->setVelocity(Vector(0.0,0.0,0.0));
+      downspeed = 0;
+    }
+
+  }
+
+
+  /*
+  PRINTF(0)("Collision with Ground: \n");
+  collision->getEntityB()->getAbsCoor().debug();
+  collision->getEntityB()->setVelocity(Vector());
+  collision->getEntityB()->setAbsCoor(this->lastPositions[1]);
+
+  */
 }
 
@@ -103 +124 @@
   for( int i = 9; i > 0; i--) {
     this->lastPositions[i] = this->lastPositions[i-1];
-//     PRINTF(0)("lastPosition[%i]: %f, %f, %f\n", i, lastPositions[i].x, lastPositions[i].y, lastPositions[i].z);
+    //     PRINTF(0)("lastPosition[%i]: %f, %f, %f\n", i, lastPositions[i].x, lastPositions[i].y, lastPositions[i].z);
   }
   this->lastPositions[0] = owner->getAbsCoor();