Fixed potential error in new keyframe pose initialization
Merge branch 'experimental-srba-branch' of https://github.com/jlblancoc/mrpt into experimental-srba-branch