Fixed discrepency between quat and rotmat