Changeset 10670 for code/branches/AI_HS15/src/orxonox/controllers/AIController.cc

Timestamp:

Oct 19, 2015, 4:01:54 PM (9 years ago)

Author:

gania

Message:

hold position in formation with waypoints

File:

• code/branches/AI_HS15/src/orxonox/controllers/AIController.cc (modified) (5 diffs)

code/branches/AI_HS15/src/orxonox/controllers/AIController.cc

@@ -86 +86 @@
         }
 
+
         if (this->state_ == SLAVE && this->formationMode_ == ATTACK) 
         {
@@ -108 +109 @@
             //-------------------------------------------------------
             //collect data for AI behaviour
-            Vector3 meanOfEnemies;
-            Vector3 meanOfAllies;
+            Vector3* meanOfEnemiesPtr = new Vector3(0.0,0.0,0.0);
+            Vector3* meanOfAlliesPtr  = new Vector3(0.0,0.0,0.0);
+            Vector3 meanOfAllies = *meanOfAlliesPtr;
+            Vector3 meanOfEnemies = *meanOfEnemiesPtr;
+
 
             for (ObjectList<AIController>::iterator it = ObjectList<AIController>::begin(); it; ++it)
@@ -121 +125 @@
                 if (!FormationController::sameTeam(this->getControllableEntity(), it->getControllableEntity(),gt))
                 {
-                    enemies.push_back(*it);
+                    enemies_.push_back(*it);
                 } 
                 else {
-                    allies.push_back(*it);
+                    allies_.push_back(*it);
                 } 
             }
-            if (enemies.size() != 0 && allies.size() != 0){
-            for (std::vector<AIController*>::iterator it = enemies.begin() ; it != enemies.end(); ++it)
-                meanOfEnemies += (*it)->getControllableEntity()->getPosition();
-            meanOfEnemies /= enemies.size();
-            for (std::vector<AIController*>::iterator it = allies.begin() ; it != allies.end(); ++it)
-                meanOfAllies += (*it)->getControllableEntity()->getPosition();
-            meanOfAllies /= allies.size();
-            //orxout(internal_error) << "There are " << enemiesCounter << " enemies, mean position is " << meanOfEnemies << endl;
-            orxout(internal_error) << "Distance is " << (meanOfEnemies-meanOfAllies).length() << endl;
-            orxout(internal_error) << "mean of Allies is " << meanOfAllies << ", with a size " << allies.size() << endl;
-            orxout(internal_error) << "mean of Enemies is " << meanOfEnemies << ", with a size " << enemies.size() << endl;
+            if (enemies_.size() != 0 && allies_.size() != 0){
+                for (std::vector<WeakPtr<AIController> >::iterator it = enemies_.begin() ; it != enemies_.end(); ++it)
+                    meanOfEnemies += (*it)->getControllableEntity()->getWorldPosition();
+
+                meanOfEnemies /= enemies_.size();
+
+                for (std::vector<WeakPtr<AIController> >::iterator it = allies_.begin() ; it != allies_.end(); ++it)
+                    meanOfAllies += (*it)->getControllableEntity()->getWorldPosition();
+
+                meanOfAllies /= allies_.size();
+
+                //orxout(internal_error) << "There are " << enemies_Counter << " enemies_, mean position is " << meanOfEnemies << endl;
+                orxout(internal_error) << "Distance is " << (meanOfEnemies-meanOfAllies).length() << endl;
+                orxout(internal_error) << "mean of allies_ is " << meanOfAllies << ", with a size " << allies_.size() << endl;
+                orxout(internal_error) << "mean of enemies_ is " << meanOfEnemies << ", with a size " << enemies_.size() << endl;
             }
             //-------------------------------------------------------
             
-
+            //Decide which formationMode to choose
             this->setFormationMode(ATTACK);
-            
-            this->commandSlaves();
+            this->setDesiredPositionOfSlaves();
+
+            //this->commandSlaves();
 
             if  (this->specificMasterAction_ != NONE)
@@ -184 +193 @@
             }
         }
-        allies.clear();
-        enemies.clear();
+        allies_.clear();
+        enemies_.clear();
     }
 
@@ -196 +205 @@
         float maxrand = 100.0f / ACTION_INTERVAL;
         ControllableEntity* controllable = this->getControllableEntity();
+        if (this->state_ == SLAVE)
+        {
+            Vector3 desiredAbsolutePosition = this->myMaster_->getControllableEntity()->getWorldPosition() + this->myMaster_->getControllableEntity()->getWorldOrientation()*desiredRelativePosition_;
+            
+            orxonox::WeakPtr<MovableEntity> waypoint = new MovableEntity(this->center_->getContext());
+            waypoint->setPosition(desiredAbsolutePosition);
+            
+            this->addWaypoint(waypoint);
+        }
         //DOES: Either move to the waypoint or search for a Point of interest
         if (controllable && this->mode_ == DEFAULT)// bot is ready to move to a target