added dMIN_ANGLE for smoother servo control

Signed-off-by: bubi <m.bubestinger@gmail.com>