Method convertStateToLocal

src/GNSS.cpp:149–171

  void TangentPlaneConverter::convertStateToLocal(Data &State)
  {
    /** check if the state has the right type */
    if(State.getType() != DataType::Point3)
    {
      PRINT_ERROR("Wrong state Type: ", State.getType());
      return;
    }

    /** extract values */
    const Vector3 MeanIn = State.getMean();
    const Matrix33 CovIn = State.getCovarianceMatrix();

    /** convert */
    Vector3 MeanOut;
    Matrix33 CovOut;
    this->convertToLocal(MeanIn, CovIn, MeanOut, CovOut);

    /** write back */
    Vector9 CovOutVect(CovOut.data());
    State.setMean(MeanOut);
    State.setCovarianceMatrix(CovOutVect);
  }

  void TangentPlaneConverter::convertStateToGlobal(Data &State)
  {