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;
}