bool VertexLineEndpts::write(std::ostream &os) const { Vector6d lv; for (int i = 0; i < estimateDimension(); ++i) { os << lv[i] << " "; } return os.good(); }
bool VertexPlane3d::write(std::ostream &os) const { Eigen::Vector3d lv = estimate(); for (int i = 0; i < estimateDimension(); i++) os << lv[i] << " "; return os.good(); }