Change the size of the rotation matrix Re 6x6 to 2x2.