Add derivative term to roll/pitch stab controllers