Changeset 2313 for code/branches/physics/src/orxonox/objects/worldentities/WorldEntity.cc

Timestamp:

Dec 3, 2008, 1:17:12 AM (16 years ago)

Author:

rgrieder

Message:

Added body queue to Scene: Physical objects now request to be added to the physical world.

File:

• code/branches/physics/src/orxonox/objects/worldentities/WorldEntity.cc (modified) (9 diffs)

code/branches/physics/src/orxonox/objects/worldentities/WorldEntity.cc

@@ -89 +89 @@
                 this->getScene()->getSceneManager()->destroySceneNode(this->node_->getName());
 
-            this->setCollisionType(None);
+            if (this->physicalBody_)
+            {
+                if (this->physicalBody_->isInWorld())
+                    this->getScene()->getPhysicalWorld()->removeRigidBody(this->physicalBody_);
+                delete this->physicalBody_;
+            }
+            // TODO: Delete collisionShapes
         }
     }
@@ -147 +153 @@
             else if (object->isKinematic())
                 ThrowException(NotImplemented, "Cannot attach a kinematic object to a static or kinematic one: Not yet implemented.");
-            else if (object->physicalBody_->isInWorld() || this->physicalBody_->isInWorld())
-                ThrowException(PhysicsViolation, "Cannot attach a physical object at runtime.");
             else
             {
+                if (this->physicalBody_->isInWorld())
+                    removeFromPhysicalWorld();
+                if (object->physicalBody_->isInWorld())
+                    this->getScene()->removeRigidBody(object->physicalBody_);
+
                 // static to static/kinematic/dynamic --> merge shapes
                 this->childMass_ += object->getMass();
@@ -157 +166 @@
                 // That also implies that cannot add a physics WE to the child afterwards.
                 object->setCollisionType(None);
+
+                addToPhysicalWorld();
             }
         }
@@ -209 +220 @@
             // recalculate inertia tensor
             if (this->isDynamic())
-            {
                 internalSetMassProps();
-            }
         }
         else
@@ -228 +237 @@
         {
             if (this->physicalBody_->isInWorld())
-                COUT(2) << "Warning: Cannot attach a physical object at runtime.";
-            else
-                this->physicalBody_->setCollisionShape(this->collisionShape_->getCollisionShape());
-        }
+            {
+                COUT(2) << "Warning: Attaching collision shapes at run time causes its physical body to be removed and added again.";
+                removeFromPhysicalWorld();
+            }
+            this->physicalBody_->setCollisionShape(this->collisionShape_->getCollisionShape());
+        }
+
+        addToPhysicalWorld();
     }
 
@@ -257 +270 @@
     }
 
+    void WorldEntity::addToPhysicalWorld() const
+    {
+        if (this->isActive() && this->hasPhysics() && !this->physicalBody_->isInWorld())
+            this->getScene()->addRigidBody(this->physicalBody_);
+    }
+
+    void WorldEntity::removeFromPhysicalWorld() const
+    {
+        if (this->hasPhysics())
+            this->getScene()->removeRigidBody(this->physicalBody_);
+    }
+
     void WorldEntity::setScale3D(const Vector3& scale)
     {
@@ -278 +303 @@
         if (!this->hasPhysics())
             COUT(3) << "Warning: Setting the mass of a WorldEntity with no physics has no effect." << std::endl;
-        else if (this->physicalBody_->isInWorld())
-            COUT(2) << "Warning: Cannot set the physical mass at run time. Storing new mass." << std::endl;
-        else
+        else
+        {
+            if (this->physicalBody_->isInWorld())
+            {
+                COUT(2) << "Warning: Setting the mass of a WorldEntity at run time causes its physical body to be removed and added again." << std::endl;
+                removeFromPhysicalWorld();
+            }
             internalSetMassProps();
+        }
+
+        addToPhysicalWorld();
     }
 
@@ -340 +372 @@
         {
             // Destroy rigid body
-            if (this->physicalBody_->isInWorld())
-                this->getScene()->getPhysicalWorld()->removeRigidBody(this->physicalBody_);
+            assert(this->physicalBody_);
+            removeFromPhysicalWorld();
             delete this->physicalBody_;
             this->physicalBody_ = 0;
@@ -370 +402 @@
         // update mass and inertia tensor
         internalSetMassProps(); // type is not None! See case None: in switch
+
+        addToPhysicalWorld();
     }