Changes

Add soften tunable to better controller

This allows the angular velocity to overshoot the target angular
velocity (by about 10%) and still be able to decelerate to hit
the target.

Setting to 1.0 will restore the previous behavior.

Signed-off-by: Lamont Granquist <lamont@scriptkiddie.org>
 (commit: 2ea5399)