Fixed FindCornerPoints

FindCornerPoints is now working as it should. Tho I am pretty sure
FindCornerMidPoints is a bit faster, and should work just as well for
most uses.