Fixed up rotation matrix stuff (Q6)