hough.cpp,  fix warning and optimize