Attitude yaw next

This is the commits from #465 that can be cherry-picked onto next.  I'll merge as soon as jenkins shows it is clean.