Minor Tweaks

Added Derivative control to yaw.