Unit test MergeSimilarModels and have MMKFRobotLocalisation ignore empty goal vectors from vision