コード例 #1
0
ファイル: appUtil.cpp プロジェクト: Fraency189/omplapp
 virtual void sampleFullState(const ompl::base::StateSamplerPtr &sampler,
 const std::vector<double>& coord, ompl::base::State *s) const
 {
     double* pos = space_->getValueAddressAtLocation(s, position_);
     sampler->sampleUniform(s);
     pos[0] = coord[0];
     pos[1] = coord[1];
 }
コード例 #2
0
 virtual void sampleFullState(const ob::StateSamplerPtr& sampler, const std::vector<double>& coord, ob::State* s) const
 {
    sampler->sampleUniform(s);
    ob::SE2StateSpace::StateType* ws = s->as<ob::SE2StateSpace::StateType>();
    ws->setXY(coord[0], coord[1]);
 }
コード例 #3
0
ファイル: TriangulationDemo.cpp プロジェクト: jvgomez/ompl
 void sampleFullState(const ob::StateSamplerPtr& sampler, const std::vector<double>& coord, ob::State* s) const override
 {
     sampler->sampleUniform(s);
     s->as<ob::SE2StateSpace::StateType>()->setXY(coord[0], coord[1]);
 }