loiter derivative term soft start

Added motors arming in HYBRID (not tested!)