C++ (Cpp) SE3Quatの例

コード例 #1

ファイル: parameter_se3_offset.cpp プロジェクト: Florenc/g2o

 bool ParameterSE3Offset::read(std::istream& is) {
   Vector7d off;
   for (int i=0; i<7; i++) {
     is >> off[i];
     std::cerr << off[i] << " " ;
   }
   std::cerr <<  std::endl;
   setOffset(SE3Quat(off));
   return is.good();
 }

コード例 #2

ファイル: vertex_se3_quat.cpp プロジェクト: rmihalyi/g2o

  bool VertexSE3::read(std::istream& is)
  {

    Vector7d est;
    for (int i=0; i<7; i++)
      is  >> est[i];
    setEstimate(SE3Quat(est));
    updateCache();
    return true;
  }