Merge pull request #6241 from mikeller/set_yaw_d_default_to_0