double EssentialMat_SSD(const Eigen::Matrix3d & E1, const Eigen::Matrix3d & E2, bool bVerbose) { Eigen::Matrix3d E1norm = E1/(E1.norm()); Eigen::Matrix3d E2norm = E2/(E2.norm()); double dDiff = std::min<double>((E1norm-E2norm).squaredNorm(), (E1norm+E2norm).squaredNorm()); if(bVerbose && dDiff > 0.01) { cout << "Matrices not equal: SSD=" << dDiff << endl; cout << "E1=" << endl << E1 << endl; cout << "E2 normalised=" << endl << E2 << endl; } return dDiff; }