Fixes error occurs in cv::ppf_match_3d::ICP::registerModelToScene()

* corrected out of range error

* remove unnecessary changes

* fix warning