Fix maths in Matrix4_FromDualQuaternion
Some minor optimizations