Attitude yaw next

This is the commits from #465 (which was reviewed and merged) that can be cherry-picked onto next.  I'll merge as soon as jenkins shows it is clean.