97 lines
3.0 KiB
C++
Executable File
97 lines
3.0 KiB
C++
Executable File
|
|
// **************************************************************************
|
|
//
|
|
// (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
|