cpp alghoritm fix