fixed slow down in getRectSubPix (original patch by Markus JR Mueller); removed some unused variables and functions