Changeset 6161 in orxonox.OLD for branches

Timestamp:

Dec 19, 2005, 12:50:50 PM (19 years ago)

Author:

snellen

Message:

guided_missile.cc in /world_entities/weapons updated

File:

• branches/spaceshipcontrol/src/world_entities/weapons/guided_missile.cc (modified) (1 diff)

branches/spaceshipcontrol/src/world_entities/weapons/guided_missile.cc

@@ -156 +156 @@
     speed = velocity.len();
     diffVector = ((target->getAbsCoor() - this->getAbsCoor()).getNormalized());
-    correctionVector = ( diffVector *  (speed * speed/( velocity.dot(diffVector ) ) ));
+
+    if(velocity.dot(diffVector) != 0)
+    {
+     correctionVector = (( ( diffVector *  (speed * speed/( velocity.dot(diffVector ) ) )) - velocity).getNormalized()) * agility;
 
       if(velocity.dot(diffVector) > 0)
-       velocity += (( correctionVector - velocity).getNormalized()) * agility;
+        velocity += correctionVector;
       else if (velocity.dot(diffVector) < 0)
-       velocity -= ( ( correctionVector - velocity).getNormalized()) * agility;
-      else
-       velocity += diffVector * agility;
+        velocity -= correctionVector;
+    }
+    else
+      velocity += diffVector * agility;
 
      this->setAbsDir(Quaternion(velocity, Vector(0,1,0)) * Quaternion ( -M_PI_2, Vector(0,1,0)));