42 for (
int i=0; i<3; i++)
50 for (
int i=0; i<3; i++){
virtual bool write(std::ostream &os) const
write the vertex to a stream
virtual bool read(std::istream &is)
read the vertex from a stream, i.e., the internal state of the vertex
EIGEN_MAKE_ALIGNED_OPERATOR_NEW VertexSBAPointXYZ()
const EstimateType & estimate() const
return the current estimate of the vertex