Small tweaks

Tweaked algorithm, curves out much smoother and proper