Added reference frames. Also the imu node now shuts down correctly.