Method sampleCost2D

src/FactorGraph.cpp:458–466

  }

  void FactorGraph::sampleCost2D(const string StateName,
                                 const double Timestamp,
                                 const int Number,
                                 const int PointCount,
                                 const double Range,
                                 StateDataSet &Result)
  {
    EvaluateCostSurface<2>(_Graph, _StateData.getElement(StateName, Timestamp, Number).getMeanPointer(), PointCount, Range, Result);
  }

  StateDataSet &FactorGraph::getStateData()
  {