servo smoothing is now working, but only 1 servo