Added extra update so converges faster, and matches test in Issue #412 Conflicts: tests/testVisualISAM2.cpp