Fixes #44, bug in KeyPoint selection