Всякие пробелы и тд не комментирую, тут их куча, поправь сам, когда будешь переделывать алгоритм. Кстати, вот годный стайлгайд: http://google-styleguide.googlecode.com/svn/trunk/cppguide.xml