removed usr2 (rerun)
further smoothing and control taking improvements