Update opengv.cpp

Removed bug in opengv.cpp Matlab interface