plugin: imu_pub: Fix attitude store in UAS

Issue #33.
Fix #53.