Finally working great, need smoothing and other improvements.