Initial commit

Lts/Services/CentralEffectSimulation/Plugins/GeoPairing/GeoPairingImpl/GeoPairingImplAirTarget.cpp

@@ -0,0 +1,96 @@
+
+// **************************************************************************
+//
+//  (C) Copyright 2009   Swiss SIMTEC AG
+//
+// **************************************************************************
+//
+//  $HeadURL$
+//  $LastChangedBy$
+//  $LastChangedDate$
+//  $LastChangedRevision$
+//
+// **************************************************************************
+
+// manual class headers
+#include "GeoPairingImplAirTarget.hpp"
+
+// from cpp_includes
+#include <GBL_Types/GeoCoord.hpp>
+
+namespace N_GeoPairingImpl
+{
+
+
+// ---------------------------------------------------------------
+// Constructor
+// ---------------------------------------------------------------
+GeoPairingImplAirTarget::GeoPairingImplAirTarget(SInt32 a_playerID)
+  : m_PlayerID(a_playerID),
+    m_logger(CesGeoPairing::getLogger("Plugin.GeoPairing.GeoPairingImplAirTarget"))
+{
+  INFO_LOG(m_logger) << "Constructor : PlayerID " << m_PlayerID;
+}
+
+
+// ---------------------------------------------------------------
+// updates the position
+// ---------------------------------------------------------------
+bool GeoPairingImplAirTarget::updatePosition(Float64 a_positionLat, Float64 a_positionLon, Float64 a_positionAlt, UInt32 a_positionTime)
+{
+  if (a_positionTime <= m_PositionTime)
+  {
+    INFO_LOG(m_logger) << "No new position info for Player " << m_PlayerID
+                       << ", abandon update. PositionTime = "
+                       << a_positionTime;
+    return false;
+  }
+
+  INFO_LOG(m_logger) << "Set new Position for Player " << m_PlayerID;
+
+  N_Math::GeoCoord l_NewPositionUtm;
+  l_NewPositionUtm.setLlPositionDegree(a_positionLat, a_positionLon, a_positionAlt);
+
+  N_Types::Coord3 l_NewPosition(l_NewPositionUtm.utmEasting(), l_NewPositionUtm.utmNorthing(), l_NewPositionUtm.height());
+
+  if (m_PositionTime > 0)
+  {
+    UInt32 l_TimeDiff = a_positionTime - m_PositionTime;
+    INFO_LOG(m_logger) << "l_TimeDiff [s]: " << l_TimeDiff;
+
+    // when new position time is more current than existing one
+    if (l_TimeDiff > 0)
+    {
+      N_Types::Vec3 l_NewDirection = l_NewPosition - m_Position;
+      Float64 l_Distance = l_NewDirection.magnitude();
+      INFO_LOG(m_logger) << "l_Distance [m]: " << l_Distance;
+      l_NewDirection /= l_Distance;
+      m_Direction = l_NewDirection;
+      INFO_LOG(m_logger) << "m_Direction : " << m_Direction;
+
+      m_Speed = l_Distance / l_TimeDiff;
+      INFO_LOG(m_logger) << "m_Speed [m/s]: " << m_Speed;
+    }
+  }
+
+  m_Position = l_NewPosition;
+  INFO_LOG(m_logger) << "m_Position : " << m_Position;
+
+  m_PositionTime = a_positionTime;
+  INFO_LOG(m_logger) << "m_PositionTime : " << m_PositionTime;
+  return true;
+}
+
+
+// ---------------------------------------------------------------
+// updates the air target state
+// ---------------------------------------------------------------
+void GeoPairingImplAirTarget::updateState(SInt32 a_state)
+{
+  INFO_LOG(m_logger) << "Set new State for Player "
+                     << m_PlayerID << " : " << a_state;
+  m_State = a_state;
+}
+
+
+} // namespace N_GeoPairingImpl