Adds yaw, pitch, and roll to messages