Adds Quaternion reading support

Modifies the original IMU code to add support for Quaternion reading and
output.