Minor algorithm tweaks
Updated README