Adds normal weighted full search method that divides the score by the dot product of the prior normal and candidate normal so as to find the best match that is clsoe to the proior normal.