#include "SimCore/Identifier.hpp"
#include "SimCore/Orientation.hpp"
#include "SimCore/Position.hpp"
#include "WHISPER/Messages/Message.hpp"
#include <SimCore/SimCore.hpp>
#include <memory>
#include <string>
#include <thread>
#include <tuple>
#define CATCH_CONFIG_MAIN
#include <catch2/catch.hpp>
#include <Entities/Entity.hpp>

// SimCore::Identifier OwnID, SimCore::Identifier ParentID, SimCore::SensorKinds SensorKind,std::uint32_t GroundTruthPort, std::uint32_t ParentPort,std::string ParentIPAddress
class Ship : public Entities::Entity 
{
 public: 
    Ship(SimCore::Identifier OwnID, 
        std::string EntityName,
        WHISPER::SourceType ownType,
        SimCore::Identifier ParentID, 
        SimCore::EntityKind EntityKind,
        std::uint32_t GroundTruthPort, 
        std::uint32_t CommandPort
        ):
    Entity( OwnID,EntityName,ownType,  ParentID,  EntityKind, GroundTruthPort,  CommandPort)
          {
            SimCore::Position pos1;
            pos1.setGeodesicPos(55, 6, 0);
            // Movement_.setPosition(pos1);
            // Movement_.setCourse(0);
            // Movement_.setSpeed(100);

            // LOG_S(INFO)<<std::endl<<Movement_.getPosition().getGeodesicPos();

          }
  
  private:

    void specificPhysicsCalculations(std::chrono::milliseconds::rep duration) override
    {
      SimCore::Position pos1;
      pos1.setGeodesicPos(55, 6, 0);


      // LOG_S(INFO)<<std::endl<<Movement_.getPosition().getGeodesicPos();
      // double distance, bearing1;
      // std::tie(distance, bearing1) = Movement_.getPosition().distanceBearingToPosition(pos1);
      // LOG_S(INFO)<<"distance from start is:" << distance;
      LOG_S(INFO)<<"calculating every " << duration << " milliseconds";
    };

    void specificReloadCharacteristicts() override 
    { 


     LOG_S(INFO)<<"loading specifications";
    };
};




SCENARIO("Testing the SimCore Sensor")
{
  GIVEN("different Attributes for a Track in different forms")
  {
    SimCore::Identifier IDParent(0,1,false);
    SimCore::Identifier ID1(0,2,false);
    Ship Ship(ID1,"FGSHamburg",WHISPER::SourceType::ENTITY,IDParent,SimCore::EntityKind::SURFACE,8000,8001);
    Ship.start();
    std::this_thread::sleep_for(std::chrono::milliseconds(10000));   
    Ship.stop();
    WHEN("constructing Track Object with data")
    {
       
      THEN("check if Track attributes are correct")
      {
        // REQUIRE(testOperator == true);
       




      } //THEN
    } // WHEN
  } // GIVEN
} //SCENARIO