ADD: added orientation

src/Entities/Entity.cpp

@@ -25,7 +25,8 @@ namespace Entities
                    SimCore::EntityKind EntityKind,
                    std::uint32_t GroundTruthPort, 
                    std::uint32_t CommandPort,
-                   std::string CommandIPAddress):EntityName_(EnttityName),
+                   std::string CommandIPAddress):
+                   EntityName_(EnttityName),
                    ownTrack_(OwnType, OwnID, SimCore::TrackKind::GROUND_TRUTH_TRACK),
                    ParentID_(ParentID),
                    EntityKind_(EntityKind),
@@ -37,6 +38,12 @@ namespace Entities
     
     }
 
+
+    Entity::~Entity()
+    {
+        stop();
+    }
+
     void Entity::start()
     {   
 
@@ -68,21 +75,19 @@ namespace Entities
         //     }
 
 
-    for (std::vector<std::thread>::iterator it = threads.begin(); it != threads.end();)
-    {
-        if (it->joinable()) 
+        for (std::vector<std::thread>::iterator it = threads.begin(); it != threads.end();)
         {
-            it->join();
-            it = threads.erase(it);
+            if (it->joinable()) 
+            {
+                it->join();
+                it = threads.erase(it);
+            }
+        
         }
-       
-    }
 
         LOG_S(ERROR)<< threads.size();
 
     
-
-
     }
 
     void Entity::physicsWorker()