Fix rotation.

Have a look at this. From what I can see the rotation matrix works fine (it's the top-left and top-right, yes?)

The quaternion implementation is broken though ;)